started servos, and small fixes to motors