Core updates

Roughly finished Motor.c, Servo.c, and Joystick.c.