start from home in mock

kroshu · Oct 17, 2023 · def2e89 · def2e89
1 parent 2645925
commit def2e89
Showing 1 changed file with 5 additions and 0 deletions.
diff --git a/kuka_rox_hardware_interface/src/rox_hardware_interface.cpp b/kuka_rox_hardware_interface/src/rox_hardware_interface.cpp
@@ -69,6 +69,11 @@ CallbackReturn KukaRoXHardwareInterface::on_init(const hardware_interface::Hardw
     RCLCPP_ERROR(rclcpp::get_logger("KukaRoXHardwareInterface"), "Could not setup udp replier");
     return CallbackReturn::FAILURE;
   }
+#else
+// Start from home position in mock mode
+  hw_position_commands_[1] = -90 * (M_PI / 180);
+  hw_position_commands_[2] = 90 * (M_PI / 180);
+  hw_position_commands_[4] = 90 * (M_PI / 180);
 #endif
 
   RCLCPP_INFO(rclcpp::get_logger("KukaRoXHardwareInterface"), "Init successful");