|
|
@@ -262,7 +262,7 @@ static void process_foc_command(foc_cmd_body_t *command) {
|
|
|
pid_conf_t pid;
|
|
|
u8 id = decode_u8((u8 *)command->data);
|
|
|
memcpy((char *)&pid, (char *)command->data + 1, sizeof(pid_conf_t));
|
|
|
- sys_debug("id = %d, kp = %f, ki = %f, kb = %f\n", id, pid.kp, pid.ki, pid.kb);
|
|
|
+ sys_debug("set id = %d, kp = %f, ki = %f, kb = %f\n", id, pid.kp, pid.ki, pid.kb);
|
|
|
PMSM_FOC_SetPid(id, pid.kp, pid.ki, pid.kb);
|
|
|
nv_set_pid(id, &pid);
|
|
|
break;
|
|
|
@@ -276,7 +276,7 @@ static void process_foc_command(foc_cmd_body_t *command) {
|
|
|
erroCode = id;
|
|
|
memcpy(response+3, &pid, sizeof(pid));
|
|
|
len = sizeof(pid) + 3;
|
|
|
- sys_debug("id = %d, kp = %f, ki = %f, kb = %f\n", id, pid.kp, pid.ki, pid.kb);
|
|
|
+ sys_debug("get id = %d, kp = %f, ki = %f, kb = %f\n", id, pid.kp, pid.ki, pid.kb);
|
|
|
}else {
|
|
|
erroCode = 1;
|
|
|
len = 3;
|