No version for distro humble showing jazzy. Known supported distros are highlighted in the buttons above.
Package symbol

sm_cl_px4_mr_test_5 package from SMACC2 repo

smacc2 cl_foundation_pose cl_gcalcli cl_generic_sensor cl_http cl_keyboard cl_lifecycle_node cl_mission_tracker cl_modbus_tcp_relay cl_moveit2z cl_nav2z backward_global_planner backward_local_planner forward_global_planner forward_local_planner nav2z_planners_common pure_spinning_local_planner undo_path_global_planner cl_px4_mr cl_ros2_timer eg_conditional_generator eg_random_generator smacc2_msgs sm_atomic_performance_trace_1 sm_atomic_subscribers_performance_test sm_coretest_action_client_1 sm_coretest_callback_rate_1 sm_coretest_exceptions_1 sm_coretest_features_1 sm_coretest_forced_finish_1 sm_coretest_idle_load_1 sm_coretest_object_churn_1 sm_coretest_poll_shutdown_1 sm_coretest_post_during_exit_1 sm_coretest_reactor_order_1 sm_coretest_signal_key_1 sm_coretest_timer_handoff_1 sm_coretest_transition_speed_1 sm_advanced_recovery_1 sm_atomic sm_atomic_http sm_atomic_lifecycle sm_atomic_mode_states sm_branching sm_cl_gcalcli_test_1 sm_cl_keyboard_unit_test_1 sm_cl_px4_mr_test_1 sm_cl_px4_mr_test_2 sm_cl_px4_mr_test_3 sm_cl_px4_mr_test_4 sm_cl_px4_mr_test_5 sm_cl_ros2_timer_unit_test_1 sm_data_sharing_1 sm_data_sharing_2 sm_modbus_tcp_relay_test_1 sm_mode_state_behavior_1 sm_multi_stage_1 sm_multithread_test_1 sm_nav2_gazebo_test_1 sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_3 sm_nav2_gazebo_test_4 sm_pack_ml sm_panda_cl_moveit2z_cb_inventory sm_panda_cl_moveit2z_cb_inventory_isaacsim sm_retry_logic_1 sm_simple_action_client sm_three_some sr_all_events_go sr_conditional sr_event_countdown

ROS Distro
jazzy

Package Summary

Version 3.1.0
License Apache-2.0
Build type AMENT_CMAKE
Use RECOMMENDED

Repository Summary

Description
Checkout URI https://github.com/robosoft-ai/SMACC2.git
VCS Type git
VCS Version jazzy
Last Updated 2026-11-20
Dev Status DEVELOPED
Released RELEASED
Contributing Help Wanted (-)
Good First Issues (-)
Pull Requests to Review (-)

Package Description

PX4 multirotor cave flight: an x500 with a 3D lidar flies into the DARPA SubT Cave Circuit Practice 01 world and back, the point cloud bridged to ROS 2 and shown in RViz, the flight gated by the lidar (obstacle hold, cloud watchdog)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

State Machine Diagram

sm_cl_px4_mr_test_5

Description

An x500 carrying a spherical 3D lidar explores the DARPA SubT Cave Circuit Practice 01 Gazebo world, retraces the route back and comes back out to the pad. As a finale it laps the base station (the SubT tent at the cave mouth) twice at 6 m, spirals up around it to 15 m (1.5 m per turn), laps it twice more at the top, then returns over the pad and lands. The tunnel centering behavior trims the route against the lidar walls. The lidar cloud is bridged to ROS 2 and shown in RViz live and accumulated, in a TF tree (map -> base_link -> lidar_link) broadcast from PX4’s own estimate by CpTfBroadcaster.

The lidar also gates the flight: a return inside a forward safety cone stops the vehicle (StObstacleHold), and once it clears (or after a bounded wait) the vehicle retraces the traversed part of the route home (StReturnHome); a cloud that stops arriving aborts the same way. All tunables (altitudes, speed, leash, cone, timeouts, spawn point, route) live in config/mission_constants.hpp.

Uses two orthogonals:

  • OrPx4 - cl_px4_mr::ClPx4Mr for all PX4 vehicle control, plus CpTfBroadcaster
  • OrLidar - cl_generic_sensor::ClGenericSensor<sensor_msgs::msg::PointCloud2> on /lidar/points with a 2 s message watchdog, plus CpForwardObstacleGuard

Build Instructions

First, source your ROS 2 installation.

source /opt/ros/jazzy/setup.bash

Then build with colcon build…

colcon build --packages-select cl_px4_mr sm_cl_px4_mr_test_5

One-time Setup

Build PX4 SITL once (this also generates build/px4_sitl_default/rootfs/gz_env.sh):

cd ~/workspaces/PX4-Autopilot
make px4_sitl

Fetch the cave world and its tiles from Gazebo Fuel (~100 MB, Open Robotics, CC-BY-4.0):

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 fetch_cave_world.sh

Operating Instructions

Requires four processes, started in this order. The micro-ROS agent must be running before the state machine starts: StConnectMicroROSAgent waits for the agent’s node and for PX4 to report a healthy position estimate, then StWaitForReady refuses to arm until the EKF heading holds still and matches the parked heading (east): a drifting heading flips the vehicle on takeoff.

Terminal 1 - Gazebo (cave world) + PX4 SITL:

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 start_cave_sitl.sh

Terminal 2 - QGroundControl (GCS heartbeat so PX4 allows arming)

./QGroundControl-x86_64.AppImage

Terminal 3 - micro-ROS agent (XRCE-DDS bridge to PX4):

ros2 run micro_ros_agent micro_ros_agent udp4 -p 8888 2>&1 | tee /tmp/xrce_agent.log

Terminal 4 - bridges, RViz and the State Machine:

source install/setup.bash
ros2 launch sm_cl_px4_mr_test_5 sm_cl_px4_mr_test_5.launch.py

The state machine’s console output is also written to /tmp/sm_cl_px4_mr_test_5_latest.log.

Negative Tests

While the vehicle is flying outbound (Terminal 1’s world must be running):

  • Obstacle in the cone: ros2 run sm_cl_px4_mr_test_5 spawn_test_box.sh 45 0 3 drops a 2 m box on the corridor ahead of the vehicle; expect CpForwardObstacleGuard: OBSTACLE, StObstacleHold, then after ros2 run sm_cl_px4_mr_test_5 remove_test_box.sh StReturnHome and a landing on the spawn point.
  • Cloud loss: pkill -f PointCloudPacked kills only the lidar bridge; expect [CpMessageTimeout] Message timeout occurred within 2 s, then StReturnHome.

Viewer Instructions

If you have the SMACC2 Runtime Analyzer installed then type…

ros2 run smacc2_rta smacc2_rta

File truncated at 100 lines see the full file

CHANGELOG
No CHANGELOG found.

Launch files

No launch files found

Messages

No message files found.

Services

No service files found

Plugins

No plugins found.

Recent questions tagged sm_cl_px4_mr_test_5 at Robotics Stack Exchange

Package symbol

sm_cl_px4_mr_test_5 package from SMACC2 repo

smacc2 cl_foundation_pose cl_gcalcli cl_generic_sensor cl_http cl_keyboard cl_lifecycle_node cl_mission_tracker cl_modbus_tcp_relay cl_moveit2z cl_nav2z backward_global_planner backward_local_planner forward_global_planner forward_local_planner nav2z_planners_common pure_spinning_local_planner undo_path_global_planner cl_px4_mr cl_ros2_timer eg_conditional_generator eg_random_generator smacc2_msgs sm_atomic_performance_trace_1 sm_atomic_subscribers_performance_test sm_coretest_action_client_1 sm_coretest_callback_rate_1 sm_coretest_exceptions_1 sm_coretest_features_1 sm_coretest_forced_finish_1 sm_coretest_idle_load_1 sm_coretest_object_churn_1 sm_coretest_poll_shutdown_1 sm_coretest_post_during_exit_1 sm_coretest_reactor_order_1 sm_coretest_signal_key_1 sm_coretest_timer_handoff_1 sm_coretest_transition_speed_1 sm_advanced_recovery_1 sm_atomic sm_atomic_http sm_atomic_lifecycle sm_atomic_mode_states sm_branching sm_cl_gcalcli_test_1 sm_cl_keyboard_unit_test_1 sm_cl_px4_mr_test_1 sm_cl_px4_mr_test_2 sm_cl_px4_mr_test_3 sm_cl_px4_mr_test_4 sm_cl_px4_mr_test_5 sm_cl_ros2_timer_unit_test_1 sm_data_sharing_1 sm_data_sharing_2 sm_modbus_tcp_relay_test_1 sm_mode_state_behavior_1 sm_multi_stage_1 sm_multithread_test_1 sm_nav2_gazebo_test_1 sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_3 sm_nav2_gazebo_test_4 sm_pack_ml sm_panda_cl_moveit2z_cb_inventory sm_panda_cl_moveit2z_cb_inventory_isaacsim sm_retry_logic_1 sm_simple_action_client sm_three_some sr_all_events_go sr_conditional sr_event_countdown

ROS Distro
jazzy

Package Summary

Version 3.1.0
License Apache-2.0
Build type AMENT_CMAKE
Use RECOMMENDED

Repository Summary

Description
Checkout URI https://github.com/robosoft-ai/SMACC2.git
VCS Type git
VCS Version jazzy
Last Updated 2026-11-20
Dev Status DEVELOPED
Released RELEASED
Contributing Help Wanted (-)
Good First Issues (-)
Pull Requests to Review (-)

Package Description

PX4 multirotor cave flight: an x500 with a 3D lidar flies into the DARPA SubT Cave Circuit Practice 01 world and back, the point cloud bridged to ROS 2 and shown in RViz, the flight gated by the lidar (obstacle hold, cloud watchdog)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

State Machine Diagram

sm_cl_px4_mr_test_5

Description

An x500 carrying a spherical 3D lidar explores the DARPA SubT Cave Circuit Practice 01 Gazebo world, retraces the route back and comes back out to the pad. As a finale it laps the base station (the SubT tent at the cave mouth) twice at 6 m, spirals up around it to 15 m (1.5 m per turn), laps it twice more at the top, then returns over the pad and lands. The tunnel centering behavior trims the route against the lidar walls. The lidar cloud is bridged to ROS 2 and shown in RViz live and accumulated, in a TF tree (map -> base_link -> lidar_link) broadcast from PX4’s own estimate by CpTfBroadcaster.

The lidar also gates the flight: a return inside a forward safety cone stops the vehicle (StObstacleHold), and once it clears (or after a bounded wait) the vehicle retraces the traversed part of the route home (StReturnHome); a cloud that stops arriving aborts the same way. All tunables (altitudes, speed, leash, cone, timeouts, spawn point, route) live in config/mission_constants.hpp.

Uses two orthogonals:

  • OrPx4 - cl_px4_mr::ClPx4Mr for all PX4 vehicle control, plus CpTfBroadcaster
  • OrLidar - cl_generic_sensor::ClGenericSensor<sensor_msgs::msg::PointCloud2> on /lidar/points with a 2 s message watchdog, plus CpForwardObstacleGuard

Build Instructions

First, source your ROS 2 installation.

source /opt/ros/jazzy/setup.bash

Then build with colcon build…

colcon build --packages-select cl_px4_mr sm_cl_px4_mr_test_5

One-time Setup

Build PX4 SITL once (this also generates build/px4_sitl_default/rootfs/gz_env.sh):

cd ~/workspaces/PX4-Autopilot
make px4_sitl

Fetch the cave world and its tiles from Gazebo Fuel (~100 MB, Open Robotics, CC-BY-4.0):

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 fetch_cave_world.sh

Operating Instructions

Requires four processes, started in this order. The micro-ROS agent must be running before the state machine starts: StConnectMicroROSAgent waits for the agent’s node and for PX4 to report a healthy position estimate, then StWaitForReady refuses to arm until the EKF heading holds still and matches the parked heading (east): a drifting heading flips the vehicle on takeoff.

Terminal 1 - Gazebo (cave world) + PX4 SITL:

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 start_cave_sitl.sh

Terminal 2 - QGroundControl (GCS heartbeat so PX4 allows arming)

./QGroundControl-x86_64.AppImage

Terminal 3 - micro-ROS agent (XRCE-DDS bridge to PX4):

ros2 run micro_ros_agent micro_ros_agent udp4 -p 8888 2>&1 | tee /tmp/xrce_agent.log

Terminal 4 - bridges, RViz and the State Machine:

source install/setup.bash
ros2 launch sm_cl_px4_mr_test_5 sm_cl_px4_mr_test_5.launch.py

The state machine’s console output is also written to /tmp/sm_cl_px4_mr_test_5_latest.log.

Negative Tests

While the vehicle is flying outbound (Terminal 1’s world must be running):

  • Obstacle in the cone: ros2 run sm_cl_px4_mr_test_5 spawn_test_box.sh 45 0 3 drops a 2 m box on the corridor ahead of the vehicle; expect CpForwardObstacleGuard: OBSTACLE, StObstacleHold, then after ros2 run sm_cl_px4_mr_test_5 remove_test_box.sh StReturnHome and a landing on the spawn point.
  • Cloud loss: pkill -f PointCloudPacked kills only the lidar bridge; expect [CpMessageTimeout] Message timeout occurred within 2 s, then StReturnHome.

Viewer Instructions

If you have the SMACC2 Runtime Analyzer installed then type…

ros2 run smacc2_rta smacc2_rta

File truncated at 100 lines see the full file

CHANGELOG
No CHANGELOG found.

Launch files

No launch files found

Messages

No message files found.

Services

No service files found

Plugins

No plugins found.

Recent questions tagged sm_cl_px4_mr_test_5 at Robotics Stack Exchange

No version for distro kilted showing jazzy. Known supported distros are highlighted in the buttons above.
Package symbol

sm_cl_px4_mr_test_5 package from SMACC2 repo

smacc2 cl_foundation_pose cl_gcalcli cl_generic_sensor cl_http cl_keyboard cl_lifecycle_node cl_mission_tracker cl_modbus_tcp_relay cl_moveit2z cl_nav2z backward_global_planner backward_local_planner forward_global_planner forward_local_planner nav2z_planners_common pure_spinning_local_planner undo_path_global_planner cl_px4_mr cl_ros2_timer eg_conditional_generator eg_random_generator smacc2_msgs sm_atomic_performance_trace_1 sm_atomic_subscribers_performance_test sm_coretest_action_client_1 sm_coretest_callback_rate_1 sm_coretest_exceptions_1 sm_coretest_features_1 sm_coretest_forced_finish_1 sm_coretest_idle_load_1 sm_coretest_object_churn_1 sm_coretest_poll_shutdown_1 sm_coretest_post_during_exit_1 sm_coretest_reactor_order_1 sm_coretest_signal_key_1 sm_coretest_timer_handoff_1 sm_coretest_transition_speed_1 sm_advanced_recovery_1 sm_atomic sm_atomic_http sm_atomic_lifecycle sm_atomic_mode_states sm_branching sm_cl_gcalcli_test_1 sm_cl_keyboard_unit_test_1 sm_cl_px4_mr_test_1 sm_cl_px4_mr_test_2 sm_cl_px4_mr_test_3 sm_cl_px4_mr_test_4 sm_cl_px4_mr_test_5 sm_cl_ros2_timer_unit_test_1 sm_data_sharing_1 sm_data_sharing_2 sm_modbus_tcp_relay_test_1 sm_mode_state_behavior_1 sm_multi_stage_1 sm_multithread_test_1 sm_nav2_gazebo_test_1 sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_3 sm_nav2_gazebo_test_4 sm_pack_ml sm_panda_cl_moveit2z_cb_inventory sm_panda_cl_moveit2z_cb_inventory_isaacsim sm_retry_logic_1 sm_simple_action_client sm_three_some sr_all_events_go sr_conditional sr_event_countdown

ROS Distro
jazzy

Package Summary

Version 3.1.0
License Apache-2.0
Build type AMENT_CMAKE
Use RECOMMENDED

Repository Summary

Description
Checkout URI https://github.com/robosoft-ai/SMACC2.git
VCS Type git
VCS Version jazzy
Last Updated 2026-11-20
Dev Status DEVELOPED
Released RELEASED
Contributing Help Wanted (-)
Good First Issues (-)
Pull Requests to Review (-)

Package Description

PX4 multirotor cave flight: an x500 with a 3D lidar flies into the DARPA SubT Cave Circuit Practice 01 world and back, the point cloud bridged to ROS 2 and shown in RViz, the flight gated by the lidar (obstacle hold, cloud watchdog)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

State Machine Diagram

sm_cl_px4_mr_test_5

Description

An x500 carrying a spherical 3D lidar explores the DARPA SubT Cave Circuit Practice 01 Gazebo world, retraces the route back and comes back out to the pad. As a finale it laps the base station (the SubT tent at the cave mouth) twice at 6 m, spirals up around it to 15 m (1.5 m per turn), laps it twice more at the top, then returns over the pad and lands. The tunnel centering behavior trims the route against the lidar walls. The lidar cloud is bridged to ROS 2 and shown in RViz live and accumulated, in a TF tree (map -> base_link -> lidar_link) broadcast from PX4’s own estimate by CpTfBroadcaster.

The lidar also gates the flight: a return inside a forward safety cone stops the vehicle (StObstacleHold), and once it clears (or after a bounded wait) the vehicle retraces the traversed part of the route home (StReturnHome); a cloud that stops arriving aborts the same way. All tunables (altitudes, speed, leash, cone, timeouts, spawn point, route) live in config/mission_constants.hpp.

Uses two orthogonals:

  • OrPx4 - cl_px4_mr::ClPx4Mr for all PX4 vehicle control, plus CpTfBroadcaster
  • OrLidar - cl_generic_sensor::ClGenericSensor<sensor_msgs::msg::PointCloud2> on /lidar/points with a 2 s message watchdog, plus CpForwardObstacleGuard

Build Instructions

First, source your ROS 2 installation.

source /opt/ros/jazzy/setup.bash

Then build with colcon build…

colcon build --packages-select cl_px4_mr sm_cl_px4_mr_test_5

One-time Setup

Build PX4 SITL once (this also generates build/px4_sitl_default/rootfs/gz_env.sh):

cd ~/workspaces/PX4-Autopilot
make px4_sitl

Fetch the cave world and its tiles from Gazebo Fuel (~100 MB, Open Robotics, CC-BY-4.0):

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 fetch_cave_world.sh

Operating Instructions

Requires four processes, started in this order. The micro-ROS agent must be running before the state machine starts: StConnectMicroROSAgent waits for the agent’s node and for PX4 to report a healthy position estimate, then StWaitForReady refuses to arm until the EKF heading holds still and matches the parked heading (east): a drifting heading flips the vehicle on takeoff.

Terminal 1 - Gazebo (cave world) + PX4 SITL:

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 start_cave_sitl.sh

Terminal 2 - QGroundControl (GCS heartbeat so PX4 allows arming)

./QGroundControl-x86_64.AppImage

Terminal 3 - micro-ROS agent (XRCE-DDS bridge to PX4):

ros2 run micro_ros_agent micro_ros_agent udp4 -p 8888 2>&1 | tee /tmp/xrce_agent.log

Terminal 4 - bridges, RViz and the State Machine:

source install/setup.bash
ros2 launch sm_cl_px4_mr_test_5 sm_cl_px4_mr_test_5.launch.py

The state machine’s console output is also written to /tmp/sm_cl_px4_mr_test_5_latest.log.

Negative Tests

While the vehicle is flying outbound (Terminal 1’s world must be running):

  • Obstacle in the cone: ros2 run sm_cl_px4_mr_test_5 spawn_test_box.sh 45 0 3 drops a 2 m box on the corridor ahead of the vehicle; expect CpForwardObstacleGuard: OBSTACLE, StObstacleHold, then after ros2 run sm_cl_px4_mr_test_5 remove_test_box.sh StReturnHome and a landing on the spawn point.
  • Cloud loss: pkill -f PointCloudPacked kills only the lidar bridge; expect [CpMessageTimeout] Message timeout occurred within 2 s, then StReturnHome.

Viewer Instructions

If you have the SMACC2 Runtime Analyzer installed then type…

ros2 run smacc2_rta smacc2_rta

File truncated at 100 lines see the full file

CHANGELOG
No CHANGELOG found.

Launch files

No launch files found

Messages

No message files found.

Services

No service files found

Plugins

No plugins found.

Recent questions tagged sm_cl_px4_mr_test_5 at Robotics Stack Exchange

No version for distro lyrical showing jazzy. Known supported distros are highlighted in the buttons above.
Package symbol

sm_cl_px4_mr_test_5 package from SMACC2 repo

smacc2 cl_foundation_pose cl_gcalcli cl_generic_sensor cl_http cl_keyboard cl_lifecycle_node cl_mission_tracker cl_modbus_tcp_relay cl_moveit2z cl_nav2z backward_global_planner backward_local_planner forward_global_planner forward_local_planner nav2z_planners_common pure_spinning_local_planner undo_path_global_planner cl_px4_mr cl_ros2_timer eg_conditional_generator eg_random_generator smacc2_msgs sm_atomic_performance_trace_1 sm_atomic_subscribers_performance_test sm_coretest_action_client_1 sm_coretest_callback_rate_1 sm_coretest_exceptions_1 sm_coretest_features_1 sm_coretest_forced_finish_1 sm_coretest_idle_load_1 sm_coretest_object_churn_1 sm_coretest_poll_shutdown_1 sm_coretest_post_during_exit_1 sm_coretest_reactor_order_1 sm_coretest_signal_key_1 sm_coretest_timer_handoff_1 sm_coretest_transition_speed_1 sm_advanced_recovery_1 sm_atomic sm_atomic_http sm_atomic_lifecycle sm_atomic_mode_states sm_branching sm_cl_gcalcli_test_1 sm_cl_keyboard_unit_test_1 sm_cl_px4_mr_test_1 sm_cl_px4_mr_test_2 sm_cl_px4_mr_test_3 sm_cl_px4_mr_test_4 sm_cl_px4_mr_test_5 sm_cl_ros2_timer_unit_test_1 sm_data_sharing_1 sm_data_sharing_2 sm_modbus_tcp_relay_test_1 sm_mode_state_behavior_1 sm_multi_stage_1 sm_multithread_test_1 sm_nav2_gazebo_test_1 sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_3 sm_nav2_gazebo_test_4 sm_pack_ml sm_panda_cl_moveit2z_cb_inventory sm_panda_cl_moveit2z_cb_inventory_isaacsim sm_retry_logic_1 sm_simple_action_client sm_three_some sr_all_events_go sr_conditional sr_event_countdown

ROS Distro
jazzy

Package Summary

Version 3.1.0
License Apache-2.0
Build type AMENT_CMAKE
Use RECOMMENDED

Repository Summary

Description
Checkout URI https://github.com/robosoft-ai/SMACC2.git
VCS Type git
VCS Version jazzy
Last Updated 2026-11-20
Dev Status DEVELOPED
Released RELEASED
Contributing Help Wanted (-)
Good First Issues (-)
Pull Requests to Review (-)

Package Description

PX4 multirotor cave flight: an x500 with a 3D lidar flies into the DARPA SubT Cave Circuit Practice 01 world and back, the point cloud bridged to ROS 2 and shown in RViz, the flight gated by the lidar (obstacle hold, cloud watchdog)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

State Machine Diagram

sm_cl_px4_mr_test_5

Description

An x500 carrying a spherical 3D lidar explores the DARPA SubT Cave Circuit Practice 01 Gazebo world, retraces the route back and comes back out to the pad. As a finale it laps the base station (the SubT tent at the cave mouth) twice at 6 m, spirals up around it to 15 m (1.5 m per turn), laps it twice more at the top, then returns over the pad and lands. The tunnel centering behavior trims the route against the lidar walls. The lidar cloud is bridged to ROS 2 and shown in RViz live and accumulated, in a TF tree (map -> base_link -> lidar_link) broadcast from PX4’s own estimate by CpTfBroadcaster.

The lidar also gates the flight: a return inside a forward safety cone stops the vehicle (StObstacleHold), and once it clears (or after a bounded wait) the vehicle retraces the traversed part of the route home (StReturnHome); a cloud that stops arriving aborts the same way. All tunables (altitudes, speed, leash, cone, timeouts, spawn point, route) live in config/mission_constants.hpp.

Uses two orthogonals:

  • OrPx4 - cl_px4_mr::ClPx4Mr for all PX4 vehicle control, plus CpTfBroadcaster
  • OrLidar - cl_generic_sensor::ClGenericSensor<sensor_msgs::msg::PointCloud2> on /lidar/points with a 2 s message watchdog, plus CpForwardObstacleGuard

Build Instructions

First, source your ROS 2 installation.

source /opt/ros/jazzy/setup.bash

Then build with colcon build…

colcon build --packages-select cl_px4_mr sm_cl_px4_mr_test_5

One-time Setup

Build PX4 SITL once (this also generates build/px4_sitl_default/rootfs/gz_env.sh):

cd ~/workspaces/PX4-Autopilot
make px4_sitl

Fetch the cave world and its tiles from Gazebo Fuel (~100 MB, Open Robotics, CC-BY-4.0):

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 fetch_cave_world.sh

Operating Instructions

Requires four processes, started in this order. The micro-ROS agent must be running before the state machine starts: StConnectMicroROSAgent waits for the agent’s node and for PX4 to report a healthy position estimate, then StWaitForReady refuses to arm until the EKF heading holds still and matches the parked heading (east): a drifting heading flips the vehicle on takeoff.

Terminal 1 - Gazebo (cave world) + PX4 SITL:

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 start_cave_sitl.sh

Terminal 2 - QGroundControl (GCS heartbeat so PX4 allows arming)

./QGroundControl-x86_64.AppImage

Terminal 3 - micro-ROS agent (XRCE-DDS bridge to PX4):

ros2 run micro_ros_agent micro_ros_agent udp4 -p 8888 2>&1 | tee /tmp/xrce_agent.log

Terminal 4 - bridges, RViz and the State Machine:

source install/setup.bash
ros2 launch sm_cl_px4_mr_test_5 sm_cl_px4_mr_test_5.launch.py

The state machine’s console output is also written to /tmp/sm_cl_px4_mr_test_5_latest.log.

Negative Tests

While the vehicle is flying outbound (Terminal 1’s world must be running):

  • Obstacle in the cone: ros2 run sm_cl_px4_mr_test_5 spawn_test_box.sh 45 0 3 drops a 2 m box on the corridor ahead of the vehicle; expect CpForwardObstacleGuard: OBSTACLE, StObstacleHold, then after ros2 run sm_cl_px4_mr_test_5 remove_test_box.sh StReturnHome and a landing on the spawn point.
  • Cloud loss: pkill -f PointCloudPacked kills only the lidar bridge; expect [CpMessageTimeout] Message timeout occurred within 2 s, then StReturnHome.

Viewer Instructions

If you have the SMACC2 Runtime Analyzer installed then type…

ros2 run smacc2_rta smacc2_rta

File truncated at 100 lines see the full file

CHANGELOG
No CHANGELOG found.

Launch files

No launch files found

Messages

No message files found.

Services

No service files found

Plugins

No plugins found.

Recent questions tagged sm_cl_px4_mr_test_5 at Robotics Stack Exchange

No version for distro rolling showing jazzy. Known supported distros are highlighted in the buttons above.
Package symbol

sm_cl_px4_mr_test_5 package from SMACC2 repo

smacc2 cl_foundation_pose cl_gcalcli cl_generic_sensor cl_http cl_keyboard cl_lifecycle_node cl_mission_tracker cl_modbus_tcp_relay cl_moveit2z cl_nav2z backward_global_planner backward_local_planner forward_global_planner forward_local_planner nav2z_planners_common pure_spinning_local_planner undo_path_global_planner cl_px4_mr cl_ros2_timer eg_conditional_generator eg_random_generator smacc2_msgs sm_atomic_performance_trace_1 sm_atomic_subscribers_performance_test sm_coretest_action_client_1 sm_coretest_callback_rate_1 sm_coretest_exceptions_1 sm_coretest_features_1 sm_coretest_forced_finish_1 sm_coretest_idle_load_1 sm_coretest_object_churn_1 sm_coretest_poll_shutdown_1 sm_coretest_post_during_exit_1 sm_coretest_reactor_order_1 sm_coretest_signal_key_1 sm_coretest_timer_handoff_1 sm_coretest_transition_speed_1 sm_advanced_recovery_1 sm_atomic sm_atomic_http sm_atomic_lifecycle sm_atomic_mode_states sm_branching sm_cl_gcalcli_test_1 sm_cl_keyboard_unit_test_1 sm_cl_px4_mr_test_1 sm_cl_px4_mr_test_2 sm_cl_px4_mr_test_3 sm_cl_px4_mr_test_4 sm_cl_px4_mr_test_5 sm_cl_ros2_timer_unit_test_1 sm_data_sharing_1 sm_data_sharing_2 sm_modbus_tcp_relay_test_1 sm_mode_state_behavior_1 sm_multi_stage_1 sm_multithread_test_1 sm_nav2_gazebo_test_1 sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_3 sm_nav2_gazebo_test_4 sm_pack_ml sm_panda_cl_moveit2z_cb_inventory sm_panda_cl_moveit2z_cb_inventory_isaacsim sm_retry_logic_1 sm_simple_action_client sm_three_some sr_all_events_go sr_conditional sr_event_countdown

ROS Distro
jazzy

Package Summary

Version 3.1.0
License Apache-2.0
Build type AMENT_CMAKE
Use RECOMMENDED

Repository Summary

Description
Checkout URI https://github.com/robosoft-ai/SMACC2.git
VCS Type git
VCS Version jazzy
Last Updated 2026-11-20
Dev Status DEVELOPED
Released RELEASED
Contributing Help Wanted (-)
Good First Issues (-)
Pull Requests to Review (-)

Package Description

PX4 multirotor cave flight: an x500 with a 3D lidar flies into the DARPA SubT Cave Circuit Practice 01 world and back, the point cloud bridged to ROS 2 and shown in RViz, the flight gated by the lidar (obstacle hold, cloud watchdog)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

State Machine Diagram

sm_cl_px4_mr_test_5

Description

An x500 carrying a spherical 3D lidar explores the DARPA SubT Cave Circuit Practice 01 Gazebo world, retraces the route back and comes back out to the pad. As a finale it laps the base station (the SubT tent at the cave mouth) twice at 6 m, spirals up around it to 15 m (1.5 m per turn), laps it twice more at the top, then returns over the pad and lands. The tunnel centering behavior trims the route against the lidar walls. The lidar cloud is bridged to ROS 2 and shown in RViz live and accumulated, in a TF tree (map -> base_link -> lidar_link) broadcast from PX4’s own estimate by CpTfBroadcaster.

The lidar also gates the flight: a return inside a forward safety cone stops the vehicle (StObstacleHold), and once it clears (or after a bounded wait) the vehicle retraces the traversed part of the route home (StReturnHome); a cloud that stops arriving aborts the same way. All tunables (altitudes, speed, leash, cone, timeouts, spawn point, route) live in config/mission_constants.hpp.

Uses two orthogonals:

  • OrPx4 - cl_px4_mr::ClPx4Mr for all PX4 vehicle control, plus CpTfBroadcaster
  • OrLidar - cl_generic_sensor::ClGenericSensor<sensor_msgs::msg::PointCloud2> on /lidar/points with a 2 s message watchdog, plus CpForwardObstacleGuard

Build Instructions

First, source your ROS 2 installation.

source /opt/ros/jazzy/setup.bash

Then build with colcon build…

colcon build --packages-select cl_px4_mr sm_cl_px4_mr_test_5

One-time Setup

Build PX4 SITL once (this also generates build/px4_sitl_default/rootfs/gz_env.sh):

cd ~/workspaces/PX4-Autopilot
make px4_sitl

Fetch the cave world and its tiles from Gazebo Fuel (~100 MB, Open Robotics, CC-BY-4.0):

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 fetch_cave_world.sh

Operating Instructions

Requires four processes, started in this order. The micro-ROS agent must be running before the state machine starts: StConnectMicroROSAgent waits for the agent’s node and for PX4 to report a healthy position estimate, then StWaitForReady refuses to arm until the EKF heading holds still and matches the parked heading (east): a drifting heading flips the vehicle on takeoff.

Terminal 1 - Gazebo (cave world) + PX4 SITL:

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 start_cave_sitl.sh

Terminal 2 - QGroundControl (GCS heartbeat so PX4 allows arming)

./QGroundControl-x86_64.AppImage

Terminal 3 - micro-ROS agent (XRCE-DDS bridge to PX4):

ros2 run micro_ros_agent micro_ros_agent udp4 -p 8888 2>&1 | tee /tmp/xrce_agent.log

Terminal 4 - bridges, RViz and the State Machine:

source install/setup.bash
ros2 launch sm_cl_px4_mr_test_5 sm_cl_px4_mr_test_5.launch.py

The state machine’s console output is also written to /tmp/sm_cl_px4_mr_test_5_latest.log.

Negative Tests

While the vehicle is flying outbound (Terminal 1’s world must be running):

  • Obstacle in the cone: ros2 run sm_cl_px4_mr_test_5 spawn_test_box.sh 45 0 3 drops a 2 m box on the corridor ahead of the vehicle; expect CpForwardObstacleGuard: OBSTACLE, StObstacleHold, then after ros2 run sm_cl_px4_mr_test_5 remove_test_box.sh StReturnHome and a landing on the spawn point.
  • Cloud loss: pkill -f PointCloudPacked kills only the lidar bridge; expect [CpMessageTimeout] Message timeout occurred within 2 s, then StReturnHome.

Viewer Instructions

If you have the SMACC2 Runtime Analyzer installed then type…

ros2 run smacc2_rta smacc2_rta

File truncated at 100 lines see the full file

CHANGELOG
No CHANGELOG found.

Launch files

No launch files found

Messages

No message files found.

Services

No service files found

Plugins

No plugins found.

Recent questions tagged sm_cl_px4_mr_test_5 at Robotics Stack Exchange

No version for distro github showing jazzy. Known supported distros are highlighted in the buttons above.
Package symbol

sm_cl_px4_mr_test_5 package from SMACC2 repo

smacc2 cl_foundation_pose cl_gcalcli cl_generic_sensor cl_http cl_keyboard cl_lifecycle_node cl_mission_tracker cl_modbus_tcp_relay cl_moveit2z cl_nav2z backward_global_planner backward_local_planner forward_global_planner forward_local_planner nav2z_planners_common pure_spinning_local_planner undo_path_global_planner cl_px4_mr cl_ros2_timer eg_conditional_generator eg_random_generator smacc2_msgs sm_atomic_performance_trace_1 sm_atomic_subscribers_performance_test sm_coretest_action_client_1 sm_coretest_callback_rate_1 sm_coretest_exceptions_1 sm_coretest_features_1 sm_coretest_forced_finish_1 sm_coretest_idle_load_1 sm_coretest_object_churn_1 sm_coretest_poll_shutdown_1 sm_coretest_post_during_exit_1 sm_coretest_reactor_order_1 sm_coretest_signal_key_1 sm_coretest_timer_handoff_1 sm_coretest_transition_speed_1 sm_advanced_recovery_1 sm_atomic sm_atomic_http sm_atomic_lifecycle sm_atomic_mode_states sm_branching sm_cl_gcalcli_test_1 sm_cl_keyboard_unit_test_1 sm_cl_px4_mr_test_1 sm_cl_px4_mr_test_2 sm_cl_px4_mr_test_3 sm_cl_px4_mr_test_4 sm_cl_px4_mr_test_5 sm_cl_ros2_timer_unit_test_1 sm_data_sharing_1 sm_data_sharing_2 sm_modbus_tcp_relay_test_1 sm_mode_state_behavior_1 sm_multi_stage_1 sm_multithread_test_1 sm_nav2_gazebo_test_1 sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_3 sm_nav2_gazebo_test_4 sm_pack_ml sm_panda_cl_moveit2z_cb_inventory sm_panda_cl_moveit2z_cb_inventory_isaacsim sm_retry_logic_1 sm_simple_action_client sm_three_some sr_all_events_go sr_conditional sr_event_countdown

ROS Distro
jazzy

Package Summary

Version 3.1.0
License Apache-2.0
Build type AMENT_CMAKE
Use RECOMMENDED

Repository Summary

Description
Checkout URI https://github.com/robosoft-ai/SMACC2.git
VCS Type git
VCS Version jazzy
Last Updated 2026-11-20
Dev Status DEVELOPED
Released RELEASED
Contributing Help Wanted (-)
Good First Issues (-)
Pull Requests to Review (-)

Package Description

PX4 multirotor cave flight: an x500 with a 3D lidar flies into the DARPA SubT Cave Circuit Practice 01 world and back, the point cloud bridged to ROS 2 and shown in RViz, the flight gated by the lidar (obstacle hold, cloud watchdog)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

State Machine Diagram

sm_cl_px4_mr_test_5

Description

An x500 carrying a spherical 3D lidar explores the DARPA SubT Cave Circuit Practice 01 Gazebo world, retraces the route back and comes back out to the pad. As a finale it laps the base station (the SubT tent at the cave mouth) twice at 6 m, spirals up around it to 15 m (1.5 m per turn), laps it twice more at the top, then returns over the pad and lands. The tunnel centering behavior trims the route against the lidar walls. The lidar cloud is bridged to ROS 2 and shown in RViz live and accumulated, in a TF tree (map -> base_link -> lidar_link) broadcast from PX4’s own estimate by CpTfBroadcaster.

The lidar also gates the flight: a return inside a forward safety cone stops the vehicle (StObstacleHold), and once it clears (or after a bounded wait) the vehicle retraces the traversed part of the route home (StReturnHome); a cloud that stops arriving aborts the same way. All tunables (altitudes, speed, leash, cone, timeouts, spawn point, route) live in config/mission_constants.hpp.

Uses two orthogonals:

  • OrPx4 - cl_px4_mr::ClPx4Mr for all PX4 vehicle control, plus CpTfBroadcaster
  • OrLidar - cl_generic_sensor::ClGenericSensor<sensor_msgs::msg::PointCloud2> on /lidar/points with a 2 s message watchdog, plus CpForwardObstacleGuard

Build Instructions

First, source your ROS 2 installation.

source /opt/ros/jazzy/setup.bash

Then build with colcon build…

colcon build --packages-select cl_px4_mr sm_cl_px4_mr_test_5

One-time Setup

Build PX4 SITL once (this also generates build/px4_sitl_default/rootfs/gz_env.sh):

cd ~/workspaces/PX4-Autopilot
make px4_sitl

Fetch the cave world and its tiles from Gazebo Fuel (~100 MB, Open Robotics, CC-BY-4.0):

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 fetch_cave_world.sh

Operating Instructions

Requires four processes, started in this order. The micro-ROS agent must be running before the state machine starts: StConnectMicroROSAgent waits for the agent’s node and for PX4 to report a healthy position estimate, then StWaitForReady refuses to arm until the EKF heading holds still and matches the parked heading (east): a drifting heading flips the vehicle on takeoff.

Terminal 1 - Gazebo (cave world) + PX4 SITL:

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 start_cave_sitl.sh

Terminal 2 - QGroundControl (GCS heartbeat so PX4 allows arming)

./QGroundControl-x86_64.AppImage

Terminal 3 - micro-ROS agent (XRCE-DDS bridge to PX4):

ros2 run micro_ros_agent micro_ros_agent udp4 -p 8888 2>&1 | tee /tmp/xrce_agent.log

Terminal 4 - bridges, RViz and the State Machine:

source install/setup.bash
ros2 launch sm_cl_px4_mr_test_5 sm_cl_px4_mr_test_5.launch.py

The state machine’s console output is also written to /tmp/sm_cl_px4_mr_test_5_latest.log.

Negative Tests

While the vehicle is flying outbound (Terminal 1’s world must be running):

  • Obstacle in the cone: ros2 run sm_cl_px4_mr_test_5 spawn_test_box.sh 45 0 3 drops a 2 m box on the corridor ahead of the vehicle; expect CpForwardObstacleGuard: OBSTACLE, StObstacleHold, then after ros2 run sm_cl_px4_mr_test_5 remove_test_box.sh StReturnHome and a landing on the spawn point.
  • Cloud loss: pkill -f PointCloudPacked kills only the lidar bridge; expect [CpMessageTimeout] Message timeout occurred within 2 s, then StReturnHome.

Viewer Instructions

If you have the SMACC2 Runtime Analyzer installed then type…

ros2 run smacc2_rta smacc2_rta

File truncated at 100 lines see the full file

CHANGELOG
No CHANGELOG found.

Launch files

No launch files found

Messages

No message files found.

Services

No service files found

Plugins

No plugins found.

Recent questions tagged sm_cl_px4_mr_test_5 at Robotics Stack Exchange

No version for distro galactic showing jazzy. Known supported distros are highlighted in the buttons above.
Package symbol

sm_cl_px4_mr_test_5 package from SMACC2 repo

smacc2 cl_foundation_pose cl_gcalcli cl_generic_sensor cl_http cl_keyboard cl_lifecycle_node cl_mission_tracker cl_modbus_tcp_relay cl_moveit2z cl_nav2z backward_global_planner backward_local_planner forward_global_planner forward_local_planner nav2z_planners_common pure_spinning_local_planner undo_path_global_planner cl_px4_mr cl_ros2_timer eg_conditional_generator eg_random_generator smacc2_msgs sm_atomic_performance_trace_1 sm_atomic_subscribers_performance_test sm_coretest_action_client_1 sm_coretest_callback_rate_1 sm_coretest_exceptions_1 sm_coretest_features_1 sm_coretest_forced_finish_1 sm_coretest_idle_load_1 sm_coretest_object_churn_1 sm_coretest_poll_shutdown_1 sm_coretest_post_during_exit_1 sm_coretest_reactor_order_1 sm_coretest_signal_key_1 sm_coretest_timer_handoff_1 sm_coretest_transition_speed_1 sm_advanced_recovery_1 sm_atomic sm_atomic_http sm_atomic_lifecycle sm_atomic_mode_states sm_branching sm_cl_gcalcli_test_1 sm_cl_keyboard_unit_test_1 sm_cl_px4_mr_test_1 sm_cl_px4_mr_test_2 sm_cl_px4_mr_test_3 sm_cl_px4_mr_test_4 sm_cl_px4_mr_test_5 sm_cl_ros2_timer_unit_test_1 sm_data_sharing_1 sm_data_sharing_2 sm_modbus_tcp_relay_test_1 sm_mode_state_behavior_1 sm_multi_stage_1 sm_multithread_test_1 sm_nav2_gazebo_test_1 sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_3 sm_nav2_gazebo_test_4 sm_pack_ml sm_panda_cl_moveit2z_cb_inventory sm_panda_cl_moveit2z_cb_inventory_isaacsim sm_retry_logic_1 sm_simple_action_client sm_three_some sr_all_events_go sr_conditional sr_event_countdown

ROS Distro
jazzy

Package Summary

Version 3.1.0
License Apache-2.0
Build type AMENT_CMAKE
Use RECOMMENDED

Repository Summary

Description
Checkout URI https://github.com/robosoft-ai/SMACC2.git
VCS Type git
VCS Version jazzy
Last Updated 2026-11-20
Dev Status DEVELOPED
Released RELEASED
Contributing Help Wanted (-)
Good First Issues (-)
Pull Requests to Review (-)

Package Description

PX4 multirotor cave flight: an x500 with a 3D lidar flies into the DARPA SubT Cave Circuit Practice 01 world and back, the point cloud bridged to ROS 2 and shown in RViz, the flight gated by the lidar (obstacle hold, cloud watchdog)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

State Machine Diagram

sm_cl_px4_mr_test_5

Description

An x500 carrying a spherical 3D lidar explores the DARPA SubT Cave Circuit Practice 01 Gazebo world, retraces the route back and comes back out to the pad. As a finale it laps the base station (the SubT tent at the cave mouth) twice at 6 m, spirals up around it to 15 m (1.5 m per turn), laps it twice more at the top, then returns over the pad and lands. The tunnel centering behavior trims the route against the lidar walls. The lidar cloud is bridged to ROS 2 and shown in RViz live and accumulated, in a TF tree (map -> base_link -> lidar_link) broadcast from PX4’s own estimate by CpTfBroadcaster.

The lidar also gates the flight: a return inside a forward safety cone stops the vehicle (StObstacleHold), and once it clears (or after a bounded wait) the vehicle retraces the traversed part of the route home (StReturnHome); a cloud that stops arriving aborts the same way. All tunables (altitudes, speed, leash, cone, timeouts, spawn point, route) live in config/mission_constants.hpp.

Uses two orthogonals:

  • OrPx4 - cl_px4_mr::ClPx4Mr for all PX4 vehicle control, plus CpTfBroadcaster
  • OrLidar - cl_generic_sensor::ClGenericSensor<sensor_msgs::msg::PointCloud2> on /lidar/points with a 2 s message watchdog, plus CpForwardObstacleGuard

Build Instructions

First, source your ROS 2 installation.

source /opt/ros/jazzy/setup.bash

Then build with colcon build…

colcon build --packages-select cl_px4_mr sm_cl_px4_mr_test_5

One-time Setup

Build PX4 SITL once (this also generates build/px4_sitl_default/rootfs/gz_env.sh):

cd ~/workspaces/PX4-Autopilot
make px4_sitl

Fetch the cave world and its tiles from Gazebo Fuel (~100 MB, Open Robotics, CC-BY-4.0):

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 fetch_cave_world.sh

Operating Instructions

Requires four processes, started in this order. The micro-ROS agent must be running before the state machine starts: StConnectMicroROSAgent waits for the agent’s node and for PX4 to report a healthy position estimate, then StWaitForReady refuses to arm until the EKF heading holds still and matches the parked heading (east): a drifting heading flips the vehicle on takeoff.

Terminal 1 - Gazebo (cave world) + PX4 SITL:

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 start_cave_sitl.sh

Terminal 2 - QGroundControl (GCS heartbeat so PX4 allows arming)

./QGroundControl-x86_64.AppImage

Terminal 3 - micro-ROS agent (XRCE-DDS bridge to PX4):

ros2 run micro_ros_agent micro_ros_agent udp4 -p 8888 2>&1 | tee /tmp/xrce_agent.log

Terminal 4 - bridges, RViz and the State Machine:

source install/setup.bash
ros2 launch sm_cl_px4_mr_test_5 sm_cl_px4_mr_test_5.launch.py

The state machine’s console output is also written to /tmp/sm_cl_px4_mr_test_5_latest.log.

Negative Tests

While the vehicle is flying outbound (Terminal 1’s world must be running):

  • Obstacle in the cone: ros2 run sm_cl_px4_mr_test_5 spawn_test_box.sh 45 0 3 drops a 2 m box on the corridor ahead of the vehicle; expect CpForwardObstacleGuard: OBSTACLE, StObstacleHold, then after ros2 run sm_cl_px4_mr_test_5 remove_test_box.sh StReturnHome and a landing on the spawn point.
  • Cloud loss: pkill -f PointCloudPacked kills only the lidar bridge; expect [CpMessageTimeout] Message timeout occurred within 2 s, then StReturnHome.

Viewer Instructions

If you have the SMACC2 Runtime Analyzer installed then type…

ros2 run smacc2_rta smacc2_rta

File truncated at 100 lines see the full file

CHANGELOG
No CHANGELOG found.

Launch files

No launch files found

Messages

No message files found.

Services

No service files found

Plugins

No plugins found.

Recent questions tagged sm_cl_px4_mr_test_5 at Robotics Stack Exchange

No version for distro iron showing jazzy. Known supported distros are highlighted in the buttons above.
Package symbol

sm_cl_px4_mr_test_5 package from SMACC2 repo

smacc2 cl_foundation_pose cl_gcalcli cl_generic_sensor cl_http cl_keyboard cl_lifecycle_node cl_mission_tracker cl_modbus_tcp_relay cl_moveit2z cl_nav2z backward_global_planner backward_local_planner forward_global_planner forward_local_planner nav2z_planners_common pure_spinning_local_planner undo_path_global_planner cl_px4_mr cl_ros2_timer eg_conditional_generator eg_random_generator smacc2_msgs sm_atomic_performance_trace_1 sm_atomic_subscribers_performance_test sm_coretest_action_client_1 sm_coretest_callback_rate_1 sm_coretest_exceptions_1 sm_coretest_features_1 sm_coretest_forced_finish_1 sm_coretest_idle_load_1 sm_coretest_object_churn_1 sm_coretest_poll_shutdown_1 sm_coretest_post_during_exit_1 sm_coretest_reactor_order_1 sm_coretest_signal_key_1 sm_coretest_timer_handoff_1 sm_coretest_transition_speed_1 sm_advanced_recovery_1 sm_atomic sm_atomic_http sm_atomic_lifecycle sm_atomic_mode_states sm_branching sm_cl_gcalcli_test_1 sm_cl_keyboard_unit_test_1 sm_cl_px4_mr_test_1 sm_cl_px4_mr_test_2 sm_cl_px4_mr_test_3 sm_cl_px4_mr_test_4 sm_cl_px4_mr_test_5 sm_cl_ros2_timer_unit_test_1 sm_data_sharing_1 sm_data_sharing_2 sm_modbus_tcp_relay_test_1 sm_mode_state_behavior_1 sm_multi_stage_1 sm_multithread_test_1 sm_nav2_gazebo_test_1 sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_3 sm_nav2_gazebo_test_4 sm_pack_ml sm_panda_cl_moveit2z_cb_inventory sm_panda_cl_moveit2z_cb_inventory_isaacsim sm_retry_logic_1 sm_simple_action_client sm_three_some sr_all_events_go sr_conditional sr_event_countdown

ROS Distro
jazzy

Package Summary

Version 3.1.0
License Apache-2.0
Build type AMENT_CMAKE
Use RECOMMENDED

Repository Summary

Description
Checkout URI https://github.com/robosoft-ai/SMACC2.git
VCS Type git
VCS Version jazzy
Last Updated 2026-11-20
Dev Status DEVELOPED
Released RELEASED
Contributing Help Wanted (-)
Good First Issues (-)
Pull Requests to Review (-)

Package Description

PX4 multirotor cave flight: an x500 with a 3D lidar flies into the DARPA SubT Cave Circuit Practice 01 world and back, the point cloud bridged to ROS 2 and shown in RViz, the flight gated by the lidar (obstacle hold, cloud watchdog)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

State Machine Diagram

sm_cl_px4_mr_test_5

Description

An x500 carrying a spherical 3D lidar explores the DARPA SubT Cave Circuit Practice 01 Gazebo world, retraces the route back and comes back out to the pad. As a finale it laps the base station (the SubT tent at the cave mouth) twice at 6 m, spirals up around it to 15 m (1.5 m per turn), laps it twice more at the top, then returns over the pad and lands. The tunnel centering behavior trims the route against the lidar walls. The lidar cloud is bridged to ROS 2 and shown in RViz live and accumulated, in a TF tree (map -> base_link -> lidar_link) broadcast from PX4’s own estimate by CpTfBroadcaster.

The lidar also gates the flight: a return inside a forward safety cone stops the vehicle (StObstacleHold), and once it clears (or after a bounded wait) the vehicle retraces the traversed part of the route home (StReturnHome); a cloud that stops arriving aborts the same way. All tunables (altitudes, speed, leash, cone, timeouts, spawn point, route) live in config/mission_constants.hpp.

Uses two orthogonals:

  • OrPx4 - cl_px4_mr::ClPx4Mr for all PX4 vehicle control, plus CpTfBroadcaster
  • OrLidar - cl_generic_sensor::ClGenericSensor<sensor_msgs::msg::PointCloud2> on /lidar/points with a 2 s message watchdog, plus CpForwardObstacleGuard

Build Instructions

First, source your ROS 2 installation.

source /opt/ros/jazzy/setup.bash

Then build with colcon build…

colcon build --packages-select cl_px4_mr sm_cl_px4_mr_test_5

One-time Setup

Build PX4 SITL once (this also generates build/px4_sitl_default/rootfs/gz_env.sh):

cd ~/workspaces/PX4-Autopilot
make px4_sitl

Fetch the cave world and its tiles from Gazebo Fuel (~100 MB, Open Robotics, CC-BY-4.0):

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 fetch_cave_world.sh

Operating Instructions

Requires four processes, started in this order. The micro-ROS agent must be running before the state machine starts: StConnectMicroROSAgent waits for the agent’s node and for PX4 to report a healthy position estimate, then StWaitForReady refuses to arm until the EKF heading holds still and matches the parked heading (east): a drifting heading flips the vehicle on takeoff.

Terminal 1 - Gazebo (cave world) + PX4 SITL:

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 start_cave_sitl.sh

Terminal 2 - QGroundControl (GCS heartbeat so PX4 allows arming)

./QGroundControl-x86_64.AppImage

Terminal 3 - micro-ROS agent (XRCE-DDS bridge to PX4):

ros2 run micro_ros_agent micro_ros_agent udp4 -p 8888 2>&1 | tee /tmp/xrce_agent.log

Terminal 4 - bridges, RViz and the State Machine:

source install/setup.bash
ros2 launch sm_cl_px4_mr_test_5 sm_cl_px4_mr_test_5.launch.py

The state machine’s console output is also written to /tmp/sm_cl_px4_mr_test_5_latest.log.

Negative Tests

While the vehicle is flying outbound (Terminal 1’s world must be running):

  • Obstacle in the cone: ros2 run sm_cl_px4_mr_test_5 spawn_test_box.sh 45 0 3 drops a 2 m box on the corridor ahead of the vehicle; expect CpForwardObstacleGuard: OBSTACLE, StObstacleHold, then after ros2 run sm_cl_px4_mr_test_5 remove_test_box.sh StReturnHome and a landing on the spawn point.
  • Cloud loss: pkill -f PointCloudPacked kills only the lidar bridge; expect [CpMessageTimeout] Message timeout occurred within 2 s, then StReturnHome.

Viewer Instructions

If you have the SMACC2 Runtime Analyzer installed then type…

ros2 run smacc2_rta smacc2_rta

File truncated at 100 lines see the full file

CHANGELOG
No CHANGELOG found.

Launch files

No launch files found

Messages

No message files found.

Services

No service files found

Plugins

No plugins found.

Recent questions tagged sm_cl_px4_mr_test_5 at Robotics Stack Exchange

No version for distro melodic showing jazzy. Known supported distros are highlighted in the buttons above.
Package symbol

sm_cl_px4_mr_test_5 package from SMACC2 repo

smacc2 cl_foundation_pose cl_gcalcli cl_generic_sensor cl_http cl_keyboard cl_lifecycle_node cl_mission_tracker cl_modbus_tcp_relay cl_moveit2z cl_nav2z backward_global_planner backward_local_planner forward_global_planner forward_local_planner nav2z_planners_common pure_spinning_local_planner undo_path_global_planner cl_px4_mr cl_ros2_timer eg_conditional_generator eg_random_generator smacc2_msgs sm_atomic_performance_trace_1 sm_atomic_subscribers_performance_test sm_coretest_action_client_1 sm_coretest_callback_rate_1 sm_coretest_exceptions_1 sm_coretest_features_1 sm_coretest_forced_finish_1 sm_coretest_idle_load_1 sm_coretest_object_churn_1 sm_coretest_poll_shutdown_1 sm_coretest_post_during_exit_1 sm_coretest_reactor_order_1 sm_coretest_signal_key_1 sm_coretest_timer_handoff_1 sm_coretest_transition_speed_1 sm_advanced_recovery_1 sm_atomic sm_atomic_http sm_atomic_lifecycle sm_atomic_mode_states sm_branching sm_cl_gcalcli_test_1 sm_cl_keyboard_unit_test_1 sm_cl_px4_mr_test_1 sm_cl_px4_mr_test_2 sm_cl_px4_mr_test_3 sm_cl_px4_mr_test_4 sm_cl_px4_mr_test_5 sm_cl_ros2_timer_unit_test_1 sm_data_sharing_1 sm_data_sharing_2 sm_modbus_tcp_relay_test_1 sm_mode_state_behavior_1 sm_multi_stage_1 sm_multithread_test_1 sm_nav2_gazebo_test_1 sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_3 sm_nav2_gazebo_test_4 sm_pack_ml sm_panda_cl_moveit2z_cb_inventory sm_panda_cl_moveit2z_cb_inventory_isaacsim sm_retry_logic_1 sm_simple_action_client sm_three_some sr_all_events_go sr_conditional sr_event_countdown

ROS Distro
jazzy

Package Summary

Version 3.1.0
License Apache-2.0
Build type AMENT_CMAKE
Use RECOMMENDED

Repository Summary

Description
Checkout URI https://github.com/robosoft-ai/SMACC2.git
VCS Type git
VCS Version jazzy
Last Updated 2026-11-20
Dev Status DEVELOPED
Released RELEASED
Contributing Help Wanted (-)
Good First Issues (-)
Pull Requests to Review (-)

Package Description

PX4 multirotor cave flight: an x500 with a 3D lidar flies into the DARPA SubT Cave Circuit Practice 01 world and back, the point cloud bridged to ROS 2 and shown in RViz, the flight gated by the lidar (obstacle hold, cloud watchdog)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

State Machine Diagram

sm_cl_px4_mr_test_5

Description

An x500 carrying a spherical 3D lidar explores the DARPA SubT Cave Circuit Practice 01 Gazebo world, retraces the route back and comes back out to the pad. As a finale it laps the base station (the SubT tent at the cave mouth) twice at 6 m, spirals up around it to 15 m (1.5 m per turn), laps it twice more at the top, then returns over the pad and lands. The tunnel centering behavior trims the route against the lidar walls. The lidar cloud is bridged to ROS 2 and shown in RViz live and accumulated, in a TF tree (map -> base_link -> lidar_link) broadcast from PX4’s own estimate by CpTfBroadcaster.

The lidar also gates the flight: a return inside a forward safety cone stops the vehicle (StObstacleHold), and once it clears (or after a bounded wait) the vehicle retraces the traversed part of the route home (StReturnHome); a cloud that stops arriving aborts the same way. All tunables (altitudes, speed, leash, cone, timeouts, spawn point, route) live in config/mission_constants.hpp.

Uses two orthogonals:

  • OrPx4 - cl_px4_mr::ClPx4Mr for all PX4 vehicle control, plus CpTfBroadcaster
  • OrLidar - cl_generic_sensor::ClGenericSensor<sensor_msgs::msg::PointCloud2> on /lidar/points with a 2 s message watchdog, plus CpForwardObstacleGuard

Build Instructions

First, source your ROS 2 installation.

source /opt/ros/jazzy/setup.bash

Then build with colcon build…

colcon build --packages-select cl_px4_mr sm_cl_px4_mr_test_5

One-time Setup

Build PX4 SITL once (this also generates build/px4_sitl_default/rootfs/gz_env.sh):

cd ~/workspaces/PX4-Autopilot
make px4_sitl

Fetch the cave world and its tiles from Gazebo Fuel (~100 MB, Open Robotics, CC-BY-4.0):

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 fetch_cave_world.sh

Operating Instructions

Requires four processes, started in this order. The micro-ROS agent must be running before the state machine starts: StConnectMicroROSAgent waits for the agent’s node and for PX4 to report a healthy position estimate, then StWaitForReady refuses to arm until the EKF heading holds still and matches the parked heading (east): a drifting heading flips the vehicle on takeoff.

Terminal 1 - Gazebo (cave world) + PX4 SITL:

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 start_cave_sitl.sh

Terminal 2 - QGroundControl (GCS heartbeat so PX4 allows arming)

./QGroundControl-x86_64.AppImage

Terminal 3 - micro-ROS agent (XRCE-DDS bridge to PX4):

ros2 run micro_ros_agent micro_ros_agent udp4 -p 8888 2>&1 | tee /tmp/xrce_agent.log

Terminal 4 - bridges, RViz and the State Machine:

source install/setup.bash
ros2 launch sm_cl_px4_mr_test_5 sm_cl_px4_mr_test_5.launch.py

The state machine’s console output is also written to /tmp/sm_cl_px4_mr_test_5_latest.log.

Negative Tests

While the vehicle is flying outbound (Terminal 1’s world must be running):

  • Obstacle in the cone: ros2 run sm_cl_px4_mr_test_5 spawn_test_box.sh 45 0 3 drops a 2 m box on the corridor ahead of the vehicle; expect CpForwardObstacleGuard: OBSTACLE, StObstacleHold, then after ros2 run sm_cl_px4_mr_test_5 remove_test_box.sh StReturnHome and a landing on the spawn point.
  • Cloud loss: pkill -f PointCloudPacked kills only the lidar bridge; expect [CpMessageTimeout] Message timeout occurred within 2 s, then StReturnHome.

Viewer Instructions

If you have the SMACC2 Runtime Analyzer installed then type…

ros2 run smacc2_rta smacc2_rta

File truncated at 100 lines see the full file

CHANGELOG
No CHANGELOG found.

Launch files

No launch files found

Messages

No message files found.

Services

No service files found

Plugins

No plugins found.

Recent questions tagged sm_cl_px4_mr_test_5 at Robotics Stack Exchange

No version for distro noetic showing jazzy. Known supported distros are highlighted in the buttons above.
Package symbol

sm_cl_px4_mr_test_5 package from SMACC2 repo

smacc2 cl_foundation_pose cl_gcalcli cl_generic_sensor cl_http cl_keyboard cl_lifecycle_node cl_mission_tracker cl_modbus_tcp_relay cl_moveit2z cl_nav2z backward_global_planner backward_local_planner forward_global_planner forward_local_planner nav2z_planners_common pure_spinning_local_planner undo_path_global_planner cl_px4_mr cl_ros2_timer eg_conditional_generator eg_random_generator smacc2_msgs sm_atomic_performance_trace_1 sm_atomic_subscribers_performance_test sm_coretest_action_client_1 sm_coretest_callback_rate_1 sm_coretest_exceptions_1 sm_coretest_features_1 sm_coretest_forced_finish_1 sm_coretest_idle_load_1 sm_coretest_object_churn_1 sm_coretest_poll_shutdown_1 sm_coretest_post_during_exit_1 sm_coretest_reactor_order_1 sm_coretest_signal_key_1 sm_coretest_timer_handoff_1 sm_coretest_transition_speed_1 sm_advanced_recovery_1 sm_atomic sm_atomic_http sm_atomic_lifecycle sm_atomic_mode_states sm_branching sm_cl_gcalcli_test_1 sm_cl_keyboard_unit_test_1 sm_cl_px4_mr_test_1 sm_cl_px4_mr_test_2 sm_cl_px4_mr_test_3 sm_cl_px4_mr_test_4 sm_cl_px4_mr_test_5 sm_cl_ros2_timer_unit_test_1 sm_data_sharing_1 sm_data_sharing_2 sm_modbus_tcp_relay_test_1 sm_mode_state_behavior_1 sm_multi_stage_1 sm_multithread_test_1 sm_nav2_gazebo_test_1 sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_3 sm_nav2_gazebo_test_4 sm_pack_ml sm_panda_cl_moveit2z_cb_inventory sm_panda_cl_moveit2z_cb_inventory_isaacsim sm_retry_logic_1 sm_simple_action_client sm_three_some sr_all_events_go sr_conditional sr_event_countdown

ROS Distro
jazzy

Package Summary

Version 3.1.0
License Apache-2.0
Build type AMENT_CMAKE
Use RECOMMENDED

Repository Summary

Description
Checkout URI https://github.com/robosoft-ai/SMACC2.git
VCS Type git
VCS Version jazzy
Last Updated 2026-11-20
Dev Status DEVELOPED
Released RELEASED
Contributing Help Wanted (-)
Good First Issues (-)
Pull Requests to Review (-)

Package Description

PX4 multirotor cave flight: an x500 with a 3D lidar flies into the DARPA SubT Cave Circuit Practice 01 world and back, the point cloud bridged to ROS 2 and shown in RViz, the flight gated by the lidar (obstacle hold, cloud watchdog)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

State Machine Diagram

sm_cl_px4_mr_test_5

Description

An x500 carrying a spherical 3D lidar explores the DARPA SubT Cave Circuit Practice 01 Gazebo world, retraces the route back and comes back out to the pad. As a finale it laps the base station (the SubT tent at the cave mouth) twice at 6 m, spirals up around it to 15 m (1.5 m per turn), laps it twice more at the top, then returns over the pad and lands. The tunnel centering behavior trims the route against the lidar walls. The lidar cloud is bridged to ROS 2 and shown in RViz live and accumulated, in a TF tree (map -> base_link -> lidar_link) broadcast from PX4’s own estimate by CpTfBroadcaster.

The lidar also gates the flight: a return inside a forward safety cone stops the vehicle (StObstacleHold), and once it clears (or after a bounded wait) the vehicle retraces the traversed part of the route home (StReturnHome); a cloud that stops arriving aborts the same way. All tunables (altitudes, speed, leash, cone, timeouts, spawn point, route) live in config/mission_constants.hpp.

Uses two orthogonals:

  • OrPx4 - cl_px4_mr::ClPx4Mr for all PX4 vehicle control, plus CpTfBroadcaster
  • OrLidar - cl_generic_sensor::ClGenericSensor<sensor_msgs::msg::PointCloud2> on /lidar/points with a 2 s message watchdog, plus CpForwardObstacleGuard

Build Instructions

First, source your ROS 2 installation.

source /opt/ros/jazzy/setup.bash

Then build with colcon build…

colcon build --packages-select cl_px4_mr sm_cl_px4_mr_test_5

One-time Setup

Build PX4 SITL once (this also generates build/px4_sitl_default/rootfs/gz_env.sh):

cd ~/workspaces/PX4-Autopilot
make px4_sitl

Fetch the cave world and its tiles from Gazebo Fuel (~100 MB, Open Robotics, CC-BY-4.0):

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 fetch_cave_world.sh

Operating Instructions

Requires four processes, started in this order. The micro-ROS agent must be running before the state machine starts: StConnectMicroROSAgent waits for the agent’s node and for PX4 to report a healthy position estimate, then StWaitForReady refuses to arm until the EKF heading holds still and matches the parked heading (east): a drifting heading flips the vehicle on takeoff.

Terminal 1 - Gazebo (cave world) + PX4 SITL:

source install/setup.bash
ros2 run sm_cl_px4_mr_test_5 start_cave_sitl.sh

Terminal 2 - QGroundControl (GCS heartbeat so PX4 allows arming)

./QGroundControl-x86_64.AppImage

Terminal 3 - micro-ROS agent (XRCE-DDS bridge to PX4):

ros2 run micro_ros_agent micro_ros_agent udp4 -p 8888 2>&1 | tee /tmp/xrce_agent.log

Terminal 4 - bridges, RViz and the State Machine:

source install/setup.bash
ros2 launch sm_cl_px4_mr_test_5 sm_cl_px4_mr_test_5.launch.py

The state machine’s console output is also written to /tmp/sm_cl_px4_mr_test_5_latest.log.

Negative Tests

While the vehicle is flying outbound (Terminal 1’s world must be running):

  • Obstacle in the cone: ros2 run sm_cl_px4_mr_test_5 spawn_test_box.sh 45 0 3 drops a 2 m box on the corridor ahead of the vehicle; expect CpForwardObstacleGuard: OBSTACLE, StObstacleHold, then after ros2 run sm_cl_px4_mr_test_5 remove_test_box.sh StReturnHome and a landing on the spawn point.
  • Cloud loss: pkill -f PointCloudPacked kills only the lidar bridge; expect [CpMessageTimeout] Message timeout occurred within 2 s, then StReturnHome.

Viewer Instructions

If you have the SMACC2 Runtime Analyzer installed then type…

ros2 run smacc2_rta smacc2_rta

File truncated at 100 lines see the full file

CHANGELOG
No CHANGELOG found.

Launch files

No launch files found

Messages

No message files found.

Services

No service files found

Plugins

No plugins found.

Recent questions tagged sm_cl_px4_mr_test_5 at Robotics Stack Exchange