diff --git a/canopen_fake_slaves/include/canopen_fake_slaves/cia402_slave.hpp b/canopen_fake_slaves/include/canopen_fake_slaves/cia402_slave.hpp index e0410ef9b..d52eca67d 100644 --- a/canopen_fake_slaves/include/canopen_fake_slaves/cia402_slave.hpp +++ b/canopen_fake_slaves/include/canopen_fake_slaves/cia402_slave.hpp @@ -193,6 +193,9 @@ class CIA402MockSlave : public canopen::BasicSlave { std::this_thread::sleep_for(std::chrono::milliseconds(10)); target_position = static_cast(((int32_t)(*this)[0x607A][0])) / 1000.0; + clear_status_bit(SW_Operation_mode_specific0); + set_status_bit(SW_Voltage_enabled); + set_status_bit(SW_Remote); if (target_position != actual_position) { clear_status_bit(SW_Operation_mode_specific0);