/// <summary>
/// Changes the servo led color
/// </summary>
/// <param name="ID">Servo ID</param>
/// <param name="color">Led color</param>
public void SetLedColor(byte ID, HerkulexDescription.LedColor color)
{
if (Servos.ContainsKey(ID))
{
Servos[ID].SetLedColor(color);
_SetLedColor(ID, color);
}
else
{
throw new Exception("The servo ID is not in the dictionnary");
}
}
/// <summary>
/// Sets the specified servo led color
/// </summary>
/// <param name="pID">Servo ID</param>
/// <param name="color">Led color (LedColor enum)</param>
private void _SetLedColor(byte pID, HerkulexDescription.LedColor color)
{
RAM_WRITE(pID, HerkulexDescription.RAM_ADDR.LED_Control, 1, (ushort)color);
}
public void SetLedColor(HerkulexDescription.LedColor color)
{
LEDState = color;
}