dynamixel working, cleanup needed
dynamixel working, cleanup needed