Added the servo libraries because the arduino ide sucks
Added the motor controller servo control