void xlMotor::jointMove(int position, int speed) { Dxl.jointMode(myID); delayMicroseconds(100); Dxl.setPosition(myID,position,speed); delayMicroseconds(1); }
void xlMotor::jointMove(int position) { Dxl.jointMode(myID); delayMicroseconds(1); Dxl.setPosition(myID,position,512); delayMicroseconds(1); }