Abstracted control messages from host
Modularized motor ctrl functions
Continued polishing motor control structures
Added a bounding function for motors/servos
Added some fuzzy-logic elements to motor control