diff --git a/src/modelec_strat/src/action/down_action.cpp b/src/modelec_strat/src/action/down_action.cpp index 13b7ec5..a40667b 100644 --- a/src/modelec_strat/src/action/down_action.cpp +++ b/src/modelec_strat/src/action/down_action.cpp @@ -45,15 +45,15 @@ void Modelec::DownAction::Next() msg.items[1].end_angle = front_ ? 1.9 : 0; msg.items[1].duration_s = 1; - msg.items[1].id = front_ ? 2 : 10; - msg.items[1].start_angle = front_ ? 0.3 : 0; - msg.items[1].end_angle = front_ ? 0 : 0; - msg.items[1].duration_s = 1; + msg.items[2].id = front_ ? 2 : 10; + msg.items[2].start_angle = front_ ? 0.3 : 0; + msg.items[2].end_angle = front_ ? 0 : 0; + msg.items[2].duration_s = 1; - msg.items[1].id = front_ ? 3 : 11; - msg.items[1].start_angle = front_ ? 2.7 : 0; - msg.items[1].end_angle = front_ ? 3 : 0; - msg.items[1].duration_s = 1; + msg.items[3].id = front_ ? 3 : 11; + msg.items[3].start_angle = front_ ? 2.7 : 0; + msg.items[3].end_angle = front_ ? 3 : 0; + msg.items[3].duration_s = 1; action_executor_->MoveServoTimed(msg); } diff --git a/src/modelec_strat/src/action/up_action.cpp b/src/modelec_strat/src/action/up_action.cpp index 7e48400..3a37974 100644 --- a/src/modelec_strat/src/action/up_action.cpp +++ b/src/modelec_strat/src/action/up_action.cpp @@ -45,15 +45,15 @@ void Modelec::UPAction::Next() msg.items[1].end_angle = front_ ? 1.9 : 0; msg.items[1].duration_s = 1; - msg.items[1].id = front_ ? 2 : 10; - msg.items[1].start_angle = front_ ? 0 : 0; - msg.items[1].end_angle = front_ ? 0.3 : 0; - msg.items[1].duration_s = 1; + msg.items[2].id = front_ ? 2 : 10; + msg.items[2].start_angle = front_ ? 0 : 0; + msg.items[2].end_angle = front_ ? 0.3 : 0; + msg.items[2].duration_s = 1; - msg.items[1].id = front_ ? 3 : 11; - msg.items[1].start_angle = front_ ? 3 : 0; - msg.items[1].end_angle = front_ ? 2.7 : 0; - msg.items[1].duration_s = 1; + msg.items[3].id = front_ ? 3 : 11; + msg.items[3].start_angle = front_ ? 3 : 0; + msg.items[3].end_angle = front_ ? 2.7 : 0; + msg.items[3].duration_s = 1; action_executor_->MoveServoTimed(msg); }