Changes

Summary

  1. fix: lane.length checking bug. (details)
  2. feat:调整wcba 优化路径的长度 (details)
  3. fix: echo stop position. (details)
  4. feat: 掉头入库-1. 根据途经点位置自动计算角度。2. 方向切换时向前延长轨迹 (details)
  5. fix: plan from cur_pt when ssep search succeed. (details)
  6. feat: 增加conditional filter防止轨迹画圈 (details)
Commit 2565d2c6a43204dd373bc3e6edbb2ef5616acc9d by 5081703.cr
fix: lane.length checking bug.

The file was modifieddata/map/pnc_map/routing_extension/routing_data.cpp
Commit 2632d09a428da5a46a04b621f4f6f72632646542 by wuyanjun110
feat:调整wcba 优化路径的长度

The file was modifiedalgorithm/wbca/wbca_manager.cpp
Commit 322c66c20e119b3333a5749de8ce363165c7385f by 5081703.cr
fix: echo stop position.

The file was modifieddata/app/fsm/motion_fsm/motion_fsm.cpp
The file was modifieddata/app/fsm/motion_fsm/motion_fsm.hpp
Commit 80f60495e07c5f6e339ec9ebf5793d25e3cf6e4a by tangwenqing
feat: 掉头入库-1. 根据途经点位置自动计算角度。2. 方向切换时向前延长轨迹

The file was modifiedssep/tools/tractor_trailer_shortest_path_heuristic_generator/shortest_path_expander.cc
The file was addedssep/coarse_search/geometric_searcher/motion_primitive_sampler/dir_change_path_extention_decorator.h
The file was modifiedssep/coarse_search/geometric_searcher/searcher_builders/u_turn_insertion_maneuver_searcher_builder.h
The file was modifiedssep/coarse_search/geometric_searcher/geometric_search_visualizer.cc
The file was modifiedssep/coarse_search/geometric_searcher/motion_primitive.h
The file was modified.gitignore
The file was addedssep/coarse_search/geometric_searcher/motion_primitive_sampler/trailer_heading_motion_primitive_decorator.h
The file was modifiedssep/coarse_search/geometric_searcher/searcher_builders/u_turn_insertion_maneuver_searcher_builder.cc
The file was modifiedssep/coarse_search/geometric_searcher/geometric_search_visualizer.h
The file was modifiedssep/coarse_search/geometric_searcher/motion_primitive_sampler/motion_primitive_sampler.h
The file was modifiedssep/tools/tractor_trailer_shortest_path_heuristic_generator/generate_shortest_path_heur_cli.cc
The file was modifiedssep/coarse_search/hybrid_a_star.hpp
The file was modifiedssep/coarse_search/geometric_searcher/bulk_yard_geometric_searcher.cc
The file was addedssep/coarse_search/geometric_searcher/motion_primitive_sampler/arc_path_motion_primitive_sampler.cc
The file was modifiedssep/coarse_search/geometric_searcher/searcher_builders/back_insertion_maneuver_searcher_builder.cc
The file was addedssep/coarse_search/geometric_searcher/motion_primitive_sampler/arc_path_motion_primitive_sampler.h
The file was modifiedssep/main_test/main_ssep_input.cc
The file was modifiedssep/coarse_search/geometric_searcher/evaluator/trailer_collision_cost_computer.h
Commit 9a2fda85407c5c362b53a27fa619ff20172cdeb8 by 5081703.cr
fix: plan from cur_pt when ssep search succeed.

The file was modifieddata/plan/start_point_data.cpp
Commit 3140280a4bad8e5a0d0ccd83425ce995b43004e6 by tangwenqing
feat: 增加conditional filter防止轨迹画圈

The file was modifiedssep/coarse_search/geometric_searcher/evaluator/cost_feature_computer.h
The file was modifiedssep/ssep_planner.cc
The file was addedssep/coarse_search/geometric_searcher/evaluator/conditional_filter_cost_computer.h
The file was modifiedssep/coarse_search/geometric_searcher/motion_primitive_sampler/ilqr_motion_primitive_sampler.cc
The file was modifiedssep/coarse_search/geometric_searcher/searcher_builders/back_insertion_maneuver_searcher_builder.cc
The file was modifiedssep/coarse_search/geometric_searcher/evaluator/evaluator.h