Add Motor and Servo support