void print_servo_mounts(int IXL_svmt[ ], int IXR_svmt[ ], int id3_svmt[ ])
Teensy等での起動メッセージを表示します.
引数1 : L系列のサーボマウント配列
引数2 : R系列のサーボマウント配列
引数3 : 3系列のサーボマウント配列
/**
* @brief Print mounted servomotor's id.
*
* @param[in] IXL_svmt Left side servos arrey.
* @param[in] IXR_svmt Right side servos arrey.
* @param[in] id3_svmt 3rd side servos arrey.
*/
void Meridian::print_servo_mounts(int IXL_svmt[], int IXR_svmt[], int id3_svmt[]))
{
Serial.print("Left side Servos mounted: ");
for (int i = 0; i < 15; i++)
{
if (IXL_svmt[i])
{
Serial.print(i);
Serial.print(" ");
}
}
Serial.println();
Serial.print("Right side Servos mounted: ");
for (int i = 0; i < 15; i++)
{
if (IXR_svmt[i])
{
Serial.print(i);
Serial.print(" ");
}
}
Serial.println();
int _x = 0;
for (int i = 0; i < 15; i++)
{
_x = _x + id3_svmt[i];
}
if (_x){
Serial.print("3rd side Servos mounted: ");
for (int i = 0; i < 15; i++)
{
if (id3_svmt[i])
{
Serial.print(i);
Serial.print(" ");
}
}
Serial.println();
}
}