Servo and Sensor Configs

Servo reset 0, and reset 1 are not functional due to faulty
understanding, need editing/review. Servo.c is functional, just need
optimal control mappings to joysticks.