diff --git a/src/modelec_com/include/modelec_com/pcb_action_interface.hpp b/src/modelec_com/include/modelec_com/pcb_action_interface.hpp index 5e2a937..e50eb97 100644 --- a/src/modelec_com/include/modelec_com/pcb_action_interface.hpp +++ b/src/modelec_com/include/modelec_com/pcb_action_interface.hpp @@ -31,7 +31,7 @@ namespace Modelec std::map asc_value_mapper_; std::map> servo_pos_mapper_; - ASCState asc_state_; + ASCState asc_state_ = LOW; std::map servo_value_; std::map relay_value_; diff --git a/src/modelec_com/src/pcb_action_interface.cpp b/src/modelec_com/src/pcb_action_interface.cpp index 2e72f93..035cbb2 100644 --- a/src/modelec_com/src/pcb_action_interface.cpp +++ b/src/modelec_com/src/pcb_action_interface.cpp @@ -153,46 +153,6 @@ namespace Modelec relay_move_res_pub_ = this->create_publisher( "action/relay/move/res", 10); - - asc_value_mapper_ = { - {LOW, 0}, - {HIGH, 0} - }; - SendOrder("ASC", {"LOW", std::to_string(0)}); - SendOrder("ASC", {"HIGH", std::to_string(200)}); - - servo_pos_mapper_ = { - {0, {{0, 0}, {1, 0}}}, - {1, {{0, 0}, {1, 0}}}, - {2, {{0, 0}, {1, 0}}} - }; - SendOrder("SERVO0", {"POS0", std::to_string(0)}); - SendOrder("SERVO0", {"POS1", std::to_string(PI)}); - SendOrder("SERVO1", {"POS0", std::to_string(0)}); - SendOrder("SERVO1", {"POS1", std::to_string(PI)}); - SendOrder("SERVO2", {"POS0", std::to_string(0)}); - SendOrder("SERVO2", {"POS1", std::to_string(PI)}); - - asc_state_ = LOW; - SendMove("ASC", {"LOW"}); - - servo_value_ = { - {0, 0}, - {1, 0}, - {2, 0} - }; - SendMove("SERVO0", {"POS0"}); - SendMove("SERVO1", {"POS0"}); - SendMove("SERVO2", {"POS0"}); - - relay_value_ = { - {0, false}, - {1, false}, - {2, false}, - }; - SendMove("RELAY0", {"0"}); - SendMove("RELAY1", {"0"}); - SendMove("RELAY2", {"0"}); } PCBActionInterface::~PCBActionInterface()