Work in Progress

Changes to motor control. There is a problem with arm control code.
Speeds are inadequately driving motors