Added mode_of_operation_display_ when setting up slave, to have the s…

…ame value as mode_of_operation from parameters. If 0x6061 isn't read, the rest still works as intended.
ICube-Robotics · Jun 25, 2024 · 1fbab7f · 1fbab7f
1 parent 52be2c2
commit 1fbab7f
Showing 1 changed file with 1 addition and 0 deletions.
diff --git a/ethercat_generic_plugins/ethercat_generic_cia402_drive/src/generic_ec_cia402_drive.cpp b/ethercat_generic_plugins/ethercat_generic_cia402_drive/src/generic_ec_cia402_drive.cpp
@@ -129,6 +129,7 @@ bool EcCiA402Drive::setupSlave(
 
   if (paramters_.find("mode_of_operation") != paramters_.end()) {
     mode_of_operation_ = std::stod(paramters_["mode_of_operation"]);
+    mode_of_operation_display_ = std::stod(paramters_["mode_of_operation"]);
   }
 
   if (paramters_.find("command_interface/reset_fault") != paramters_.end()) {