Lots of logic fixes to motor control code. Not entirely confident that they are right. At all.
Fixed some motor checking constants
More motor constant fixes
Improved motor tests. All logic tests pass. Crazy. This can't be right.