Added dynamixel stuff