修复GM6020电机接收ID计算错误问题

This commit is contained in:
NeoZeng 2022-11-20 17:17:09 +08:00
parent 29877a4b64
commit 62b1783b59
1 changed files with 2 additions and 2 deletions

View File

@ -95,7 +95,7 @@ static void MotorSenderGrouping(can_instance_config_s *config)
motor_grouping = config->can_handle == &hcan1 ? 2 : 5;
}
config->rx_id = 0x204 + motor_id;
config->rx_id = 0x204 + motor_id + 1;
sender_enable_flag[motor_grouping] = 1;
dji_motor_info[idx]->message_num = motor_send_num;
dji_motor_info[idx]->sender_group = motor_grouping;
@ -234,7 +234,7 @@ void DJIMotorControl()
motor_controller->pid_ref = PID_Calculate(&motor_controller->current_PID, motor_measure->given_current, motor_controller->pid_ref);
}
set = (int16_t)motor_controller->pid_ref; // 获取最终输出
set = (int16_t)motor_controller->pid_ref; // 获取最终输出
if (motor_setting->reverse_flag == MOTOR_DIRECTION_REVERSE) // 设置反转
set *= -1;