dynamixel controller adjusted, needs to be tested on robot