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

sm_nav2_gazebo_test_2 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

Nav2 undo path backwards test state machine for SMACC2 (radial pattern superstate)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

sm_nav2_gazebo_test_2

sm_nav2_gazebo_test_1

SMACC2 state machine that exercises undo path backwards navigation (CbUndoPathBackwards + UndoPathGlobalPlanner + BackwardLocalPlanner) in the Nav2 TurtleBot3 Gazebo simulation.

Mission

Ten undo navigations per mission: 1 curved, 2 chained, 4 radial rays, 3 F rays.

Curved-path undo phase: StNavigateWithCurve navigates from the spawn area to (-2.0, 2.5); the pillar at (-2.0, 1.0) sits directly on the straight line, so the driven (and recorded) trajectory bows around it. StUndoCurve then retraces that curved path exactly backwards with CbUndoPathBackwards — exercising undo on a curve, unlike the straight rays of the radial pattern.

Chained-undo phase (path stack): the robot drives TWO curved legs — back to (-2.0, 2.5) around the first pillar’s east flank, then to (-3.5, -0.5) around its west flank — and undoes them both in sequence. Each navigation pushes the previous trail onto the odom tracker stack; CbUndoPathBackwards pops the stack on success, restoring the earlier leg for the next undo. The first undo of the chain must NOT clear the path on exit (that would destroy the just-popped trail); only the final undo clears.

F pattern phase: SsFPattern1 (ported from nova_carter sm_nav2_test_7) runs a boustrophedon pattern from (0.0, -1.5): 3 east-pointing rays of 1.2 m, each retraced backwards with CbUndoPathBackwards, with 0.4 m north pitches between rows.

SsRadialPattern1 is a superstate that loops 4 times (radial pattern, modeled on sm_nav2_test_7 from the nova_carter_sm_library):

After 4 iterations EvLoopEnd exits the superstate to StFinalState.

The package provides its own config/nav2_params.yaml (stock Jazzy params extended with the SMACC2 planner/controller plugin family and the cl_nav2z goal checkers) and config/default_nav_to_pose_bt.xml (behavior tree with PlannerSelector, ControllerSelector and GoalCheckerSelector nodes). Without these, plugin switching — and therefore undo navigation — cannot work.

Build

source /opt/ros/jazzy/setup.bash
rosdep install --ignore-src --from-paths src -y -r
colcon build --packages-select sm_nav2_gazebo_test_2
source install/setup.bash

Run

ros2 launch sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_2.py

Optional runtime viewer:

ros2 run smacc2_rta smacc2_rta

Debug topics

# recorded forward path (published by CpOdomTracker, consumed by UndoPathGlobalPlanner)
ros2 topic echo /odom_tracker_path --field poses | grep -c position

# undo plan produced by the global planner
ros2 topic echo /undo_path_planner/global_plan

# plugin selection state
ros2 topic echo /planner_selector
ros2 topic echo /controller_selector
ros2 topic echo /goal_checker_selector

# state machine introspection
ros2 topic echo /SmNav2GazeboTest2/smacc/status
ros2 topic echo /SmNav2GazeboTest2/smacc/transition_log

Keyboard: press N in the keyboard server terminal to advance states manually.

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_nav2_gazebo_test_2 at Robotics Stack Exchange

Package symbol

sm_nav2_gazebo_test_2 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

Nav2 undo path backwards test state machine for SMACC2 (radial pattern superstate)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

sm_nav2_gazebo_test_2

sm_nav2_gazebo_test_1

SMACC2 state machine that exercises undo path backwards navigation (CbUndoPathBackwards + UndoPathGlobalPlanner + BackwardLocalPlanner) in the Nav2 TurtleBot3 Gazebo simulation.

Mission

Ten undo navigations per mission: 1 curved, 2 chained, 4 radial rays, 3 F rays.

Curved-path undo phase: StNavigateWithCurve navigates from the spawn area to (-2.0, 2.5); the pillar at (-2.0, 1.0) sits directly on the straight line, so the driven (and recorded) trajectory bows around it. StUndoCurve then retraces that curved path exactly backwards with CbUndoPathBackwards — exercising undo on a curve, unlike the straight rays of the radial pattern.

Chained-undo phase (path stack): the robot drives TWO curved legs — back to (-2.0, 2.5) around the first pillar’s east flank, then to (-3.5, -0.5) around its west flank — and undoes them both in sequence. Each navigation pushes the previous trail onto the odom tracker stack; CbUndoPathBackwards pops the stack on success, restoring the earlier leg for the next undo. The first undo of the chain must NOT clear the path on exit (that would destroy the just-popped trail); only the final undo clears.

F pattern phase: SsFPattern1 (ported from nova_carter sm_nav2_test_7) runs a boustrophedon pattern from (0.0, -1.5): 3 east-pointing rays of 1.2 m, each retraced backwards with CbUndoPathBackwards, with 0.4 m north pitches between rows.

SsRadialPattern1 is a superstate that loops 4 times (radial pattern, modeled on sm_nav2_test_7 from the nova_carter_sm_library):

After 4 iterations EvLoopEnd exits the superstate to StFinalState.

The package provides its own config/nav2_params.yaml (stock Jazzy params extended with the SMACC2 planner/controller plugin family and the cl_nav2z goal checkers) and config/default_nav_to_pose_bt.xml (behavior tree with PlannerSelector, ControllerSelector and GoalCheckerSelector nodes). Without these, plugin switching — and therefore undo navigation — cannot work.

Build

source /opt/ros/jazzy/setup.bash
rosdep install --ignore-src --from-paths src -y -r
colcon build --packages-select sm_nav2_gazebo_test_2
source install/setup.bash

Run

ros2 launch sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_2.py

Optional runtime viewer:

ros2 run smacc2_rta smacc2_rta

Debug topics

# recorded forward path (published by CpOdomTracker, consumed by UndoPathGlobalPlanner)
ros2 topic echo /odom_tracker_path --field poses | grep -c position

# undo plan produced by the global planner
ros2 topic echo /undo_path_planner/global_plan

# plugin selection state
ros2 topic echo /planner_selector
ros2 topic echo /controller_selector
ros2 topic echo /goal_checker_selector

# state machine introspection
ros2 topic echo /SmNav2GazeboTest2/smacc/status
ros2 topic echo /SmNav2GazeboTest2/smacc/transition_log

Keyboard: press N in the keyboard server terminal to advance states manually.

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_nav2_gazebo_test_2 at Robotics Stack Exchange

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

sm_nav2_gazebo_test_2 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

Nav2 undo path backwards test state machine for SMACC2 (radial pattern superstate)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

sm_nav2_gazebo_test_2

sm_nav2_gazebo_test_1

SMACC2 state machine that exercises undo path backwards navigation (CbUndoPathBackwards + UndoPathGlobalPlanner + BackwardLocalPlanner) in the Nav2 TurtleBot3 Gazebo simulation.

Mission

Ten undo navigations per mission: 1 curved, 2 chained, 4 radial rays, 3 F rays.

Curved-path undo phase: StNavigateWithCurve navigates from the spawn area to (-2.0, 2.5); the pillar at (-2.0, 1.0) sits directly on the straight line, so the driven (and recorded) trajectory bows around it. StUndoCurve then retraces that curved path exactly backwards with CbUndoPathBackwards — exercising undo on a curve, unlike the straight rays of the radial pattern.

Chained-undo phase (path stack): the robot drives TWO curved legs — back to (-2.0, 2.5) around the first pillar’s east flank, then to (-3.5, -0.5) around its west flank — and undoes them both in sequence. Each navigation pushes the previous trail onto the odom tracker stack; CbUndoPathBackwards pops the stack on success, restoring the earlier leg for the next undo. The first undo of the chain must NOT clear the path on exit (that would destroy the just-popped trail); only the final undo clears.

F pattern phase: SsFPattern1 (ported from nova_carter sm_nav2_test_7) runs a boustrophedon pattern from (0.0, -1.5): 3 east-pointing rays of 1.2 m, each retraced backwards with CbUndoPathBackwards, with 0.4 m north pitches between rows.

SsRadialPattern1 is a superstate that loops 4 times (radial pattern, modeled on sm_nav2_test_7 from the nova_carter_sm_library):

After 4 iterations EvLoopEnd exits the superstate to StFinalState.

The package provides its own config/nav2_params.yaml (stock Jazzy params extended with the SMACC2 planner/controller plugin family and the cl_nav2z goal checkers) and config/default_nav_to_pose_bt.xml (behavior tree with PlannerSelector, ControllerSelector and GoalCheckerSelector nodes). Without these, plugin switching — and therefore undo navigation — cannot work.

Build

source /opt/ros/jazzy/setup.bash
rosdep install --ignore-src --from-paths src -y -r
colcon build --packages-select sm_nav2_gazebo_test_2
source install/setup.bash

Run

ros2 launch sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_2.py

Optional runtime viewer:

ros2 run smacc2_rta smacc2_rta

Debug topics

# recorded forward path (published by CpOdomTracker, consumed by UndoPathGlobalPlanner)
ros2 topic echo /odom_tracker_path --field poses | grep -c position

# undo plan produced by the global planner
ros2 topic echo /undo_path_planner/global_plan

# plugin selection state
ros2 topic echo /planner_selector
ros2 topic echo /controller_selector
ros2 topic echo /goal_checker_selector

# state machine introspection
ros2 topic echo /SmNav2GazeboTest2/smacc/status
ros2 topic echo /SmNav2GazeboTest2/smacc/transition_log

Keyboard: press N in the keyboard server terminal to advance states manually.

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_nav2_gazebo_test_2 at Robotics Stack Exchange

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

sm_nav2_gazebo_test_2 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

Nav2 undo path backwards test state machine for SMACC2 (radial pattern superstate)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

sm_nav2_gazebo_test_2

sm_nav2_gazebo_test_1

SMACC2 state machine that exercises undo path backwards navigation (CbUndoPathBackwards + UndoPathGlobalPlanner + BackwardLocalPlanner) in the Nav2 TurtleBot3 Gazebo simulation.

Mission

Ten undo navigations per mission: 1 curved, 2 chained, 4 radial rays, 3 F rays.

Curved-path undo phase: StNavigateWithCurve navigates from the spawn area to (-2.0, 2.5); the pillar at (-2.0, 1.0) sits directly on the straight line, so the driven (and recorded) trajectory bows around it. StUndoCurve then retraces that curved path exactly backwards with CbUndoPathBackwards — exercising undo on a curve, unlike the straight rays of the radial pattern.

Chained-undo phase (path stack): the robot drives TWO curved legs — back to (-2.0, 2.5) around the first pillar’s east flank, then to (-3.5, -0.5) around its west flank — and undoes them both in sequence. Each navigation pushes the previous trail onto the odom tracker stack; CbUndoPathBackwards pops the stack on success, restoring the earlier leg for the next undo. The first undo of the chain must NOT clear the path on exit (that would destroy the just-popped trail); only the final undo clears.

F pattern phase: SsFPattern1 (ported from nova_carter sm_nav2_test_7) runs a boustrophedon pattern from (0.0, -1.5): 3 east-pointing rays of 1.2 m, each retraced backwards with CbUndoPathBackwards, with 0.4 m north pitches between rows.

SsRadialPattern1 is a superstate that loops 4 times (radial pattern, modeled on sm_nav2_test_7 from the nova_carter_sm_library):

After 4 iterations EvLoopEnd exits the superstate to StFinalState.

The package provides its own config/nav2_params.yaml (stock Jazzy params extended with the SMACC2 planner/controller plugin family and the cl_nav2z goal checkers) and config/default_nav_to_pose_bt.xml (behavior tree with PlannerSelector, ControllerSelector and GoalCheckerSelector nodes). Without these, plugin switching — and therefore undo navigation — cannot work.

Build

source /opt/ros/jazzy/setup.bash
rosdep install --ignore-src --from-paths src -y -r
colcon build --packages-select sm_nav2_gazebo_test_2
source install/setup.bash

Run

ros2 launch sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_2.py

Optional runtime viewer:

ros2 run smacc2_rta smacc2_rta

Debug topics

# recorded forward path (published by CpOdomTracker, consumed by UndoPathGlobalPlanner)
ros2 topic echo /odom_tracker_path --field poses | grep -c position

# undo plan produced by the global planner
ros2 topic echo /undo_path_planner/global_plan

# plugin selection state
ros2 topic echo /planner_selector
ros2 topic echo /controller_selector
ros2 topic echo /goal_checker_selector

# state machine introspection
ros2 topic echo /SmNav2GazeboTest2/smacc/status
ros2 topic echo /SmNav2GazeboTest2/smacc/transition_log

Keyboard: press N in the keyboard server terminal to advance states manually.

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_nav2_gazebo_test_2 at Robotics Stack Exchange

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

sm_nav2_gazebo_test_2 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

Nav2 undo path backwards test state machine for SMACC2 (radial pattern superstate)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

sm_nav2_gazebo_test_2

sm_nav2_gazebo_test_1

SMACC2 state machine that exercises undo path backwards navigation (CbUndoPathBackwards + UndoPathGlobalPlanner + BackwardLocalPlanner) in the Nav2 TurtleBot3 Gazebo simulation.

Mission

Ten undo navigations per mission: 1 curved, 2 chained, 4 radial rays, 3 F rays.

Curved-path undo phase: StNavigateWithCurve navigates from the spawn area to (-2.0, 2.5); the pillar at (-2.0, 1.0) sits directly on the straight line, so the driven (and recorded) trajectory bows around it. StUndoCurve then retraces that curved path exactly backwards with CbUndoPathBackwards — exercising undo on a curve, unlike the straight rays of the radial pattern.

Chained-undo phase (path stack): the robot drives TWO curved legs — back to (-2.0, 2.5) around the first pillar’s east flank, then to (-3.5, -0.5) around its west flank — and undoes them both in sequence. Each navigation pushes the previous trail onto the odom tracker stack; CbUndoPathBackwards pops the stack on success, restoring the earlier leg for the next undo. The first undo of the chain must NOT clear the path on exit (that would destroy the just-popped trail); only the final undo clears.

F pattern phase: SsFPattern1 (ported from nova_carter sm_nav2_test_7) runs a boustrophedon pattern from (0.0, -1.5): 3 east-pointing rays of 1.2 m, each retraced backwards with CbUndoPathBackwards, with 0.4 m north pitches between rows.

SsRadialPattern1 is a superstate that loops 4 times (radial pattern, modeled on sm_nav2_test_7 from the nova_carter_sm_library):

After 4 iterations EvLoopEnd exits the superstate to StFinalState.

The package provides its own config/nav2_params.yaml (stock Jazzy params extended with the SMACC2 planner/controller plugin family and the cl_nav2z goal checkers) and config/default_nav_to_pose_bt.xml (behavior tree with PlannerSelector, ControllerSelector and GoalCheckerSelector nodes). Without these, plugin switching — and therefore undo navigation — cannot work.

Build

source /opt/ros/jazzy/setup.bash
rosdep install --ignore-src --from-paths src -y -r
colcon build --packages-select sm_nav2_gazebo_test_2
source install/setup.bash

Run

ros2 launch sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_2.py

Optional runtime viewer:

ros2 run smacc2_rta smacc2_rta

Debug topics

# recorded forward path (published by CpOdomTracker, consumed by UndoPathGlobalPlanner)
ros2 topic echo /odom_tracker_path --field poses | grep -c position

# undo plan produced by the global planner
ros2 topic echo /undo_path_planner/global_plan

# plugin selection state
ros2 topic echo /planner_selector
ros2 topic echo /controller_selector
ros2 topic echo /goal_checker_selector

# state machine introspection
ros2 topic echo /SmNav2GazeboTest2/smacc/status
ros2 topic echo /SmNav2GazeboTest2/smacc/transition_log

Keyboard: press N in the keyboard server terminal to advance states manually.

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_nav2_gazebo_test_2 at Robotics Stack Exchange

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

sm_nav2_gazebo_test_2 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

Nav2 undo path backwards test state machine for SMACC2 (radial pattern superstate)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

sm_nav2_gazebo_test_2

sm_nav2_gazebo_test_1

SMACC2 state machine that exercises undo path backwards navigation (CbUndoPathBackwards + UndoPathGlobalPlanner + BackwardLocalPlanner) in the Nav2 TurtleBot3 Gazebo simulation.

Mission

Ten undo navigations per mission: 1 curved, 2 chained, 4 radial rays, 3 F rays.

Curved-path undo phase: StNavigateWithCurve navigates from the spawn area to (-2.0, 2.5); the pillar at (-2.0, 1.0) sits directly on the straight line, so the driven (and recorded) trajectory bows around it. StUndoCurve then retraces that curved path exactly backwards with CbUndoPathBackwards — exercising undo on a curve, unlike the straight rays of the radial pattern.

Chained-undo phase (path stack): the robot drives TWO curved legs — back to (-2.0, 2.5) around the first pillar’s east flank, then to (-3.5, -0.5) around its west flank — and undoes them both in sequence. Each navigation pushes the previous trail onto the odom tracker stack; CbUndoPathBackwards pops the stack on success, restoring the earlier leg for the next undo. The first undo of the chain must NOT clear the path on exit (that would destroy the just-popped trail); only the final undo clears.

F pattern phase: SsFPattern1 (ported from nova_carter sm_nav2_test_7) runs a boustrophedon pattern from (0.0, -1.5): 3 east-pointing rays of 1.2 m, each retraced backwards with CbUndoPathBackwards, with 0.4 m north pitches between rows.

SsRadialPattern1 is a superstate that loops 4 times (radial pattern, modeled on sm_nav2_test_7 from the nova_carter_sm_library):

After 4 iterations EvLoopEnd exits the superstate to StFinalState.

The package provides its own config/nav2_params.yaml (stock Jazzy params extended with the SMACC2 planner/controller plugin family and the cl_nav2z goal checkers) and config/default_nav_to_pose_bt.xml (behavior tree with PlannerSelector, ControllerSelector and GoalCheckerSelector nodes). Without these, plugin switching — and therefore undo navigation — cannot work.

Build

source /opt/ros/jazzy/setup.bash
rosdep install --ignore-src --from-paths src -y -r
colcon build --packages-select sm_nav2_gazebo_test_2
source install/setup.bash

Run

ros2 launch sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_2.py

Optional runtime viewer:

ros2 run smacc2_rta smacc2_rta

Debug topics

# recorded forward path (published by CpOdomTracker, consumed by UndoPathGlobalPlanner)
ros2 topic echo /odom_tracker_path --field poses | grep -c position

# undo plan produced by the global planner
ros2 topic echo /undo_path_planner/global_plan

# plugin selection state
ros2 topic echo /planner_selector
ros2 topic echo /controller_selector
ros2 topic echo /goal_checker_selector

# state machine introspection
ros2 topic echo /SmNav2GazeboTest2/smacc/status
ros2 topic echo /SmNav2GazeboTest2/smacc/transition_log

Keyboard: press N in the keyboard server terminal to advance states manually.

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_nav2_gazebo_test_2 at Robotics Stack Exchange

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

sm_nav2_gazebo_test_2 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

Nav2 undo path backwards test state machine for SMACC2 (radial pattern superstate)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

sm_nav2_gazebo_test_2

sm_nav2_gazebo_test_1

SMACC2 state machine that exercises undo path backwards navigation (CbUndoPathBackwards + UndoPathGlobalPlanner + BackwardLocalPlanner) in the Nav2 TurtleBot3 Gazebo simulation.

Mission

Ten undo navigations per mission: 1 curved, 2 chained, 4 radial rays, 3 F rays.

Curved-path undo phase: StNavigateWithCurve navigates from the spawn area to (-2.0, 2.5); the pillar at (-2.0, 1.0) sits directly on the straight line, so the driven (and recorded) trajectory bows around it. StUndoCurve then retraces that curved path exactly backwards with CbUndoPathBackwards — exercising undo on a curve, unlike the straight rays of the radial pattern.

Chained-undo phase (path stack): the robot drives TWO curved legs — back to (-2.0, 2.5) around the first pillar’s east flank, then to (-3.5, -0.5) around its west flank — and undoes them both in sequence. Each navigation pushes the previous trail onto the odom tracker stack; CbUndoPathBackwards pops the stack on success, restoring the earlier leg for the next undo. The first undo of the chain must NOT clear the path on exit (that would destroy the just-popped trail); only the final undo clears.

F pattern phase: SsFPattern1 (ported from nova_carter sm_nav2_test_7) runs a boustrophedon pattern from (0.0, -1.5): 3 east-pointing rays of 1.2 m, each retraced backwards with CbUndoPathBackwards, with 0.4 m north pitches between rows.

SsRadialPattern1 is a superstate that loops 4 times (radial pattern, modeled on sm_nav2_test_7 from the nova_carter_sm_library):

After 4 iterations EvLoopEnd exits the superstate to StFinalState.

The package provides its own config/nav2_params.yaml (stock Jazzy params extended with the SMACC2 planner/controller plugin family and the cl_nav2z goal checkers) and config/default_nav_to_pose_bt.xml (behavior tree with PlannerSelector, ControllerSelector and GoalCheckerSelector nodes). Without these, plugin switching — and therefore undo navigation — cannot work.

Build

source /opt/ros/jazzy/setup.bash
rosdep install --ignore-src --from-paths src -y -r
colcon build --packages-select sm_nav2_gazebo_test_2
source install/setup.bash

Run

ros2 launch sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_2.py

Optional runtime viewer:

ros2 run smacc2_rta smacc2_rta

Debug topics

# recorded forward path (published by CpOdomTracker, consumed by UndoPathGlobalPlanner)
ros2 topic echo /odom_tracker_path --field poses | grep -c position

# undo plan produced by the global planner
ros2 topic echo /undo_path_planner/global_plan

# plugin selection state
ros2 topic echo /planner_selector
ros2 topic echo /controller_selector
ros2 topic echo /goal_checker_selector

# state machine introspection
ros2 topic echo /SmNav2GazeboTest2/smacc/status
ros2 topic echo /SmNav2GazeboTest2/smacc/transition_log

Keyboard: press N in the keyboard server terminal to advance states manually.

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_nav2_gazebo_test_2 at Robotics Stack Exchange

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

sm_nav2_gazebo_test_2 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

Nav2 undo path backwards test state machine for SMACC2 (radial pattern superstate)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

sm_nav2_gazebo_test_2

sm_nav2_gazebo_test_1

SMACC2 state machine that exercises undo path backwards navigation (CbUndoPathBackwards + UndoPathGlobalPlanner + BackwardLocalPlanner) in the Nav2 TurtleBot3 Gazebo simulation.

Mission

Ten undo navigations per mission: 1 curved, 2 chained, 4 radial rays, 3 F rays.

Curved-path undo phase: StNavigateWithCurve navigates from the spawn area to (-2.0, 2.5); the pillar at (-2.0, 1.0) sits directly on the straight line, so the driven (and recorded) trajectory bows around it. StUndoCurve then retraces that curved path exactly backwards with CbUndoPathBackwards — exercising undo on a curve, unlike the straight rays of the radial pattern.

Chained-undo phase (path stack): the robot drives TWO curved legs — back to (-2.0, 2.5) around the first pillar’s east flank, then to (-3.5, -0.5) around its west flank — and undoes them both in sequence. Each navigation pushes the previous trail onto the odom tracker stack; CbUndoPathBackwards pops the stack on success, restoring the earlier leg for the next undo. The first undo of the chain must NOT clear the path on exit (that would destroy the just-popped trail); only the final undo clears.

F pattern phase: SsFPattern1 (ported from nova_carter sm_nav2_test_7) runs a boustrophedon pattern from (0.0, -1.5): 3 east-pointing rays of 1.2 m, each retraced backwards with CbUndoPathBackwards, with 0.4 m north pitches between rows.

SsRadialPattern1 is a superstate that loops 4 times (radial pattern, modeled on sm_nav2_test_7 from the nova_carter_sm_library):

After 4 iterations EvLoopEnd exits the superstate to StFinalState.

The package provides its own config/nav2_params.yaml (stock Jazzy params extended with the SMACC2 planner/controller plugin family and the cl_nav2z goal checkers) and config/default_nav_to_pose_bt.xml (behavior tree with PlannerSelector, ControllerSelector and GoalCheckerSelector nodes). Without these, plugin switching — and therefore undo navigation — cannot work.

Build

source /opt/ros/jazzy/setup.bash
rosdep install --ignore-src --from-paths src -y -r
colcon build --packages-select sm_nav2_gazebo_test_2
source install/setup.bash

Run

ros2 launch sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_2.py

Optional runtime viewer:

ros2 run smacc2_rta smacc2_rta

Debug topics

# recorded forward path (published by CpOdomTracker, consumed by UndoPathGlobalPlanner)
ros2 topic echo /odom_tracker_path --field poses | grep -c position

# undo plan produced by the global planner
ros2 topic echo /undo_path_planner/global_plan

# plugin selection state
ros2 topic echo /planner_selector
ros2 topic echo /controller_selector
ros2 topic echo /goal_checker_selector

# state machine introspection
ros2 topic echo /SmNav2GazeboTest2/smacc/status
ros2 topic echo /SmNav2GazeboTest2/smacc/transition_log

Keyboard: press N in the keyboard server terminal to advance states manually.

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_nav2_gazebo_test_2 at Robotics Stack Exchange

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

sm_nav2_gazebo_test_2 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

Nav2 undo path backwards test state machine for SMACC2 (radial pattern superstate)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

sm_nav2_gazebo_test_2

sm_nav2_gazebo_test_1

SMACC2 state machine that exercises undo path backwards navigation (CbUndoPathBackwards + UndoPathGlobalPlanner + BackwardLocalPlanner) in the Nav2 TurtleBot3 Gazebo simulation.

Mission

Ten undo navigations per mission: 1 curved, 2 chained, 4 radial rays, 3 F rays.

Curved-path undo phase: StNavigateWithCurve navigates from the spawn area to (-2.0, 2.5); the pillar at (-2.0, 1.0) sits directly on the straight line, so the driven (and recorded) trajectory bows around it. StUndoCurve then retraces that curved path exactly backwards with CbUndoPathBackwards — exercising undo on a curve, unlike the straight rays of the radial pattern.

Chained-undo phase (path stack): the robot drives TWO curved legs — back to (-2.0, 2.5) around the first pillar’s east flank, then to (-3.5, -0.5) around its west flank — and undoes them both in sequence. Each navigation pushes the previous trail onto the odom tracker stack; CbUndoPathBackwards pops the stack on success, restoring the earlier leg for the next undo. The first undo of the chain must NOT clear the path on exit (that would destroy the just-popped trail); only the final undo clears.

F pattern phase: SsFPattern1 (ported from nova_carter sm_nav2_test_7) runs a boustrophedon pattern from (0.0, -1.5): 3 east-pointing rays of 1.2 m, each retraced backwards with CbUndoPathBackwards, with 0.4 m north pitches between rows.

SsRadialPattern1 is a superstate that loops 4 times (radial pattern, modeled on sm_nav2_test_7 from the nova_carter_sm_library):

After 4 iterations EvLoopEnd exits the superstate to StFinalState.

The package provides its own config/nav2_params.yaml (stock Jazzy params extended with the SMACC2 planner/controller plugin family and the cl_nav2z goal checkers) and config/default_nav_to_pose_bt.xml (behavior tree with PlannerSelector, ControllerSelector and GoalCheckerSelector nodes). Without these, plugin switching — and therefore undo navigation — cannot work.

Build

source /opt/ros/jazzy/setup.bash
rosdep install --ignore-src --from-paths src -y -r
colcon build --packages-select sm_nav2_gazebo_test_2
source install/setup.bash

Run

ros2 launch sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_2.py

Optional runtime viewer:

ros2 run smacc2_rta smacc2_rta

Debug topics

# recorded forward path (published by CpOdomTracker, consumed by UndoPathGlobalPlanner)
ros2 topic echo /odom_tracker_path --field poses | grep -c position

# undo plan produced by the global planner
ros2 topic echo /undo_path_planner/global_plan

# plugin selection state
ros2 topic echo /planner_selector
ros2 topic echo /controller_selector
ros2 topic echo /goal_checker_selector

# state machine introspection
ros2 topic echo /SmNav2GazeboTest2/smacc/status
ros2 topic echo /SmNav2GazeboTest2/smacc/transition_log

Keyboard: press N in the keyboard server terminal to advance states manually.

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_nav2_gazebo_test_2 at Robotics Stack Exchange

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

sm_nav2_gazebo_test_2 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

Nav2 undo path backwards test state machine for SMACC2 (radial pattern superstate)

Maintainers

  • Brett Aldrich

Authors

No additional authors.

sm_nav2_gazebo_test_2

sm_nav2_gazebo_test_1

SMACC2 state machine that exercises undo path backwards navigation (CbUndoPathBackwards + UndoPathGlobalPlanner + BackwardLocalPlanner) in the Nav2 TurtleBot3 Gazebo simulation.

Mission

Ten undo navigations per mission: 1 curved, 2 chained, 4 radial rays, 3 F rays.

Curved-path undo phase: StNavigateWithCurve navigates from the spawn area to (-2.0, 2.5); the pillar at (-2.0, 1.0) sits directly on the straight line, so the driven (and recorded) trajectory bows around it. StUndoCurve then retraces that curved path exactly backwards with CbUndoPathBackwards — exercising undo on a curve, unlike the straight rays of the radial pattern.

Chained-undo phase (path stack): the robot drives TWO curved legs — back to (-2.0, 2.5) around the first pillar’s east flank, then to (-3.5, -0.5) around its west flank — and undoes them both in sequence. Each navigation pushes the previous trail onto the odom tracker stack; CbUndoPathBackwards pops the stack on success, restoring the earlier leg for the next undo. The first undo of the chain must NOT clear the path on exit (that would destroy the just-popped trail); only the final undo clears.

F pattern phase: SsFPattern1 (ported from nova_carter sm_nav2_test_7) runs a boustrophedon pattern from (0.0, -1.5): 3 east-pointing rays of 1.2 m, each retraced backwards with CbUndoPathBackwards, with 0.4 m north pitches between rows.

SsRadialPattern1 is a superstate that loops 4 times (radial pattern, modeled on sm_nav2_test_7 from the nova_carter_sm_library):

After 4 iterations EvLoopEnd exits the superstate to StFinalState.

The package provides its own config/nav2_params.yaml (stock Jazzy params extended with the SMACC2 planner/controller plugin family and the cl_nav2z goal checkers) and config/default_nav_to_pose_bt.xml (behavior tree with PlannerSelector, ControllerSelector and GoalCheckerSelector nodes). Without these, plugin switching — and therefore undo navigation — cannot work.

Build

source /opt/ros/jazzy/setup.bash
rosdep install --ignore-src --from-paths src -y -r
colcon build --packages-select sm_nav2_gazebo_test_2
source install/setup.bash

Run

ros2 launch sm_nav2_gazebo_test_2 sm_nav2_gazebo_test_2.py

Optional runtime viewer:

ros2 run smacc2_rta smacc2_rta

Debug topics

# recorded forward path (published by CpOdomTracker, consumed by UndoPathGlobalPlanner)
ros2 topic echo /odom_tracker_path --field poses | grep -c position

# undo plan produced by the global planner
ros2 topic echo /undo_path_planner/global_plan

# plugin selection state
ros2 topic echo /planner_selector
ros2 topic echo /controller_selector
ros2 topic echo /goal_checker_selector

# state machine introspection
ros2 topic echo /SmNav2GazeboTest2/smacc/status
ros2 topic echo /SmNav2GazeboTest2/smacc/transition_log

Keyboard: press N in the keyboard server terminal to advance states manually.

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_nav2_gazebo_test_2 at Robotics Stack Exchange