void OnSetLed()
{
Serial.println("OnTemperure");
double temp = cmdMessenger.readDoubleArg();
setLed(temp);
Serial.print("temperature : ");
Serial.println(temp);
}
void OnSetFingers()
{
MYSERIAL.println("OnSetFingers");
int i;
for(i = 0; i < NUM_FINGERS; ++i)
{
double pos = cmdMessenger.readDoubleArg();
pos = min(1, max(0, pos)) * (MAX_POS-MIN_POS) + MIN_POS;
double speed = cmdMessenger.readDoubleArg();
speed = min(1, max(0, speed)) * (MAX_SPEED-MIN_SETSPEED) + MIN_SETSPEED;
MYSERIAL.print("finger: ");
MYSERIAL.println(i);
MYSERIAL.print("pos: ");
MYSERIAL.println(pos);
MYSERIAL.print("speed: ");
MYSERIAL.println(speed);
finger[i].writeSpeed(speed);
finger[i].writePos(pos);
states[i] = kWaitMoveState;
}
}
void onDataSetQueryInt()
{
sysDataPushInterval = (uint32_t)cmdMessenger.readDoubleArg();
onDataReturnQueryInt();
}