|
|
|
@ -46,7 +46,7 @@ static void motor_control_task(void *pvParameters) {
|
|
|
|
for (int m_id = 0; m_id < 3; m_id++) {
|
|
|
|
for (int m_id = 0; m_id < 3; m_id++) {
|
|
|
|
// Get the latest motor settings and parameters
|
|
|
|
// Get the latest motor settings and parameters
|
|
|
|
xQueuePeek(motor_settings_queue[m_id], &m_set, 0);
|
|
|
|
xQueuePeek(motor_settings_queue[m_id], &m_set, 0);
|
|
|
|
xQueuePeek(motor_settings_queue[m_id], &m_param, 0);
|
|
|
|
xQueuePeek(motor_parameters_queue[m_id], &m_param, 0);
|
|
|
|
|
|
|
|
|
|
|
|
if (m_set.enabled) {
|
|
|
|
if (m_set.enabled) {
|
|
|
|
|
|
|
|
|
|
|
|
|