Changes

Summary

  1. Add reverse alignment recovery for straddle carrier parking (details)
  2. Make SC reverse alignment recovery configurable (details)
  3. Record SC pickup targets, ego poses, and MPC paths to CSV (details)
  4. Keep the tracking path aligned during straddle carrier turns (details)
  5. Prevent premature straddle carrier rotation during deadlock stops (details)
  6. Gate SC reverse alignment on a configuration flag (details)
Commit 96243389e10ddd3dacaff9318fb08fec8584cca5 by chenran
Add reverse alignment recovery for straddle carrier parking

Use the SC target deviation stop line to initiate a short reverse maneuver before resuming forward MPC tracking. Skip legacy alignment replans during the destination approach so SSEP can reuse its initial search.
The file was modifieddata/plan/path_direction_data.cpp
The file was modifiedtasks/plan/sc_mpc_path_task.cpp
The file was modifieddata/vehicle/vehicle_destination.cpp
The file was modifiedplan/prepare/prepare_state.cpp
The file was modifiedtasks/other_tasks/stitch_path_data_to_path.cpp
The file was modifieddata/plan/guide_line.cpp
The file was modifieddata/plan/mpc_path_data.hpp
The file was modifieddata/vehicle/deviation_status.cpp
The file was modifiedtasks/deciders/long_decider/constrain_decider.cpp
Commit 44e6e39fe2eb78991d2ca85d5d642582eb4629d5 by chenran
Make SC reverse alignment recovery configurable
The file was modifieddata/config/cfg_env_const.hpp
The file was modifiedtasks/deciders/long_decider/constrain_decider.cpp
The file was modifieddata/config/cfg_env_const.cpp
The file was modifieddata/plan/mpc_path_data.hpp
Commit 31e6c4e99fc7dde0587664048e6dfb055223f64a by chenran
Record SC pickup targets, ego poses, and MPC paths to CSV
The file was modifiedscripts/sc_target_accuracy/README.md
The file was addedio/sc_pickup_recorder.cpp
The file was modifiedCMakeLists.txt
The file was modifiedcore/snapshot_async.cpp
The file was addedio/sc_pickup_recorder.hpp
The file was modifiedcore/snapshot_async.hpp
Commit 3c5ac5098ccf52710789d04f5d0776a7bca96d57 by chenran
Keep the tracking path aligned during straddle carrier turns
The file was modifiedsink/ros_sink_path.cpp
The file was modifiedsink/ros_sink_ctrl_reference.cpp
The file was modifiedTesting/sc_rotation_publish_replay.cpp
The file was modifiedTesting/sc_rotation_entry_test.cpp
The file was modifiedsink/ros_sink_trajectory.cpp
Commit e7d97b11541ef12b9c07eaea48e382433117d162 by chenran
Prevent premature straddle carrier rotation during deadlock stops
The file was modifieddata/ssep/open_space_ec.cpp
The file was modifiedssep/scenarios/straddle_carrier_pick_vehicle_planner.h
The file was modifiedTesting/sc_end_only_planner_test.cpp
The file was modifieddata/vehicle/sc_turn_in_place_mode.cpp
Commit 881d152961846e036bd0824aeafddeb70d1474ee by chenran
Gate SC reverse alignment on a configuration flag
The file was modifiedtasks/deciders/long_decider/constrain_decider.cpp
The file was modifieddata/config/cfg_env_const.cpp
The file was modifieddata/config/cfg_env_const.hpp