added missing fucction prototypes.
Adjusting PI loops for better perfomrance.  Not able to balence, need to look at sampling rates.
PID modification.  Integrate old (from step response data collection) PID loops, the new ones were not working. Add joystick sensitivity reducer.  Uncomment the low pass filter for future D term work.