|
|
@ -426,22 +426,24 @@ void regfn() { |
|
|
|
cmdScheduler.registerCmd("mini_servo_set_zero", [](int argc, char** argv, CmdScheduler::CmdProcessContext* context) { |
|
|
|
CHECK_ARGC(1); |
|
|
|
int id = atoi(argv[1]); |
|
|
|
ZLOGI(TAG, "mini_servo_set_zero %d", id); |
|
|
|
g_feiteservomotor.reCalibration(id, 0); |
|
|
|
ZLOGI(TAG, "mini_servo_set_zero %d done", id); |
|
|
|
}); |
|
|
|
cmdScheduler.registerCmd("mini_servo_set_4095", [](int argc, char** argv, CmdScheduler::CmdProcessContext* context) { |
|
|
|
CHECK_ARGC(1); |
|
|
|
int id = atoi(argv[1]); |
|
|
|
ZLOGI(TAG, "mini_servo_set_4095 %d", id); |
|
|
|
g_feiteservomotor.reCalibration(id, 4095); |
|
|
|
ZLOGI(TAG, "mini_servo_set_4095 %d done", id); |
|
|
|
}); |
|
|
|
cmdScheduler.registerCmd("move_to", [](int argc, char** argv, CmdScheduler::CmdProcessContext* context) { |
|
|
|
cmdScheduler.registerCmd("mini_servo_move_to", [](int argc, char** argv, CmdScheduler::CmdProcessContext* context) { |
|
|
|
CHECK_ARGC(3); |
|
|
|
int id = atoi(argv[1]); |
|
|
|
int pos = atoi(argv[2]); |
|
|
|
int v = atoi(argv[3]); |
|
|
|
|
|
|
|
// bool moveTo(uint8_t id, int16_t pos, int16_t speed, uint16_t torque);
|
|
|
|
|
|
|
|
g_feiteservomotor.moveTo(id, pos, v,0); |
|
|
|
ZLOGI(TAG, "mini_servo_move_to %d %d %d", id, pos, v); |
|
|
|
g_feiteservomotor.moveTo(id, pos, v, 0); |
|
|
|
}); |
|
|
|
|
|
|
|
#if 0
|
|
|
|