private void I_JOG(Servo servo)
{
byte[] dataToSend = new byte[5];
dataToSend[0] = (byte)(servo.GetTargetAbsolutePosition() >> 0);
dataToSend[1] = (byte)(servo.GetTargetAbsolutePosition() >> 8);
dataToSend[2] = servo.GetSETByte();
dataToSend[3] = servo.GetID();
dataToSend[4] = servo.GetPlaytime();
EncodeAndSendPacket(serialPort, servo.GetID(), (byte)HerkulexDescription.CommandSet.I_JOG, dataToSend);
}
/// <summary>
/// Recovers the servo from error state
/// </summary>
/// <param name="servo">Servo instance</param>
public void RecoverErrors(Servo servo)
{
ClearAllErrors(servo.GetID());
SetTorqueMode(servo.GetID(), HerkulexDescription.TorqueControl.TorqueOn);
}