Pull in functional drive code from feat_java

[mikeweiss]

Video in Chat.

Ended up needing to do a manual adb uninstall of com.firstinspires.org android package from last year to stop factory reset brick issue. Needed to use onbot to clear last years autons since we added them during camp