Have working code. Haven't test in high detail but quick looks works.

The arduino reads the sensors and outputs data. Outputs value from the
motor and gets joystick commands. Now it's time to see if it all will
work together.