mirror of
https://gitee.com/dlmu-cone/bf_original_balance_chassis
synced 2026-07-24 19:47:44 +08:00
修复GM6020电机接收ID计算错误问题
This commit is contained in:
@@ -95,7 +95,7 @@ static void MotorSenderGrouping(can_instance_config_s *config)
|
|||||||
motor_grouping = config->can_handle == &hcan1 ? 2 : 5;
|
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;
|
sender_enable_flag[motor_grouping] = 1;
|
||||||
dji_motor_info[idx]->message_num = motor_send_num;
|
dji_motor_info[idx]->message_num = motor_send_num;
|
||||||
dji_motor_info[idx]->sender_group = motor_grouping;
|
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);
|
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) // 设置反转
|
if (motor_setting->reverse_flag == MOTOR_DIRECTION_REVERSE) // 设置反转
|
||||||
set *= -1;
|
set *= -1;
|
||||||
|
|
||||||
|
|||||||
Reference in New Issue
Block a user