Changes

Summary

1. refactor:优化关路禁停 (details)
2. fix: add wbca cost and time_consuming. (details)
3. fix: add lateral acc cost. (details)
4. feat:添加根据定位值的倒车防护，防治对准时，跟着桥走. (details)
5. fix: wbca bd expanding. (details)
6. feat:调整搜索终点位置 (details)
7. feat:堆高机作业关路重叠时，合并 (details)
8. feat:park lock下 不校验地图 (details)
9. feat:调整出堆场口的约束创建 (details)
10. fix:修复因为距离阈值，带来场景识别错误的bug (details)
11. fix:修复终点距离计算的bug (details)
12. fix:修复海润进弯道后第一个停车位停不正的bug (details)
13. fix:修复误触发open space的bug (details)
14. refactor:优化动态搜索限速 (details)

Commit db34608a50a96a3b765d3406a955ccc71bdb97cd by wuyanjun110 refactor:优化关路禁停
	data/obstacle/block.hpp
	tasks/deciders/long_decider/constrain_decider.cpp
	data/constrain/disable_stop_range.cpp
	data/obstacle/block.cpp
	data/constrain/temporary_stop_data.cpp
	data/constrain/disable_stop_range.hpp
	hmi/widget/distance.cpp
	hmi/draw/draw_blocks.hpp
	common/util/hdmap_wrapper.cpp
	data/constrain/block_data.cpp
	data/constrain/block_data.hpp
Commit cddefcea61b2b710fcf223bcc9c374fa54c13a86 by 5081703.cr fix: add wbca cost and time_consuming.
	algorithm/wbca/wbca_manager.cpp
	algorithm/wbca/imv_wbca_manager.cpp
	data/wbca/wbca_data.hpp
Commit 52d4eff1db1a0f22867f43d3caa133ac53e05a07 by 5081703.cr fix: add lateral acc cost.
	algorithm/wbca/path_optimization/path_optimization.cpp
	algorithm/wbca/path_optimization/car_path_optimization.cpp
	algorithm/wbca/path_optimization/truck_path_optimization.cpp
Commit 764457e161b26f99e4429ee95910810707655019 by wuyanjun110 feat:添加根据定位值的倒车防护，防治对准时，跟着桥走.
	data/app/fsm/task_fsm/task_align_fsm/task_align_fsm.cpp
	data/app/fsm/task_fsm/task_align_fsm/task_align_fsm.hpp
	data/app/cmd/cmd_align.cpp
Commit 393ff4b1567e26e1f160662e1dd0d3745b23f499 by 5081703.cr fix: wbca bd expanding.
	algorithm/wbca/occupancy_grid_map/data_render.cpp
Commit c0482707461266a3e3a894eb153bd2a8d4dfda99 by wuyanjun110 feat:调整搜索终点位置
	data/ssep/out_yard_junction_ec.cpp
Commit 3769459fde93fb52325f104384f270dc718a7a29 by wuyanjun110 feat:堆高机作业关路重叠时，合并
	data/constrain/block_data.cpp
	math/util/algebra.cpp
	data/constrain/temporary_stop_data.cpp
	math/util/algebra.hpp
Commit dec0413981b3ec63e201c15eefb6441fe6ea2c0a by wuyanjun110 feat:park lock下 不校验地图
	data/vehicle/request_routing_data.cpp
Commit 30c9ab2346df388fb00035aac7f1740f709407a4 by wuyanjun110 feat:调整出堆场口的约束创建
	data/ssep/out_yard_junction_ec.cpp
Commit 544b9dc994076be0386adbcb3b95b8622df06579 by wuyanjun110 fix:修复因为距离阈值，带来场景识别错误的bug
	data/map/pnc_map/routing_extension/routing_data.cpp
Commit 06bfc6322b63aaf658ee8bb0828a873833bba909 by wuyanjun110 fix:修复终点距离计算的bug
	data/map/pnc_map/routing_extension/routing_data.cpp
Commit 5c80f07840fa07c76ae26c093ee585cb0d1aa9a3 by wuyanjun110 fix:修复海润进弯道后第一个停车位停不正的bug
	data/plan/switch_data.cpp
	tasks/deciders/long_decider/constrain_decider.cpp
Commit e4b53590f63add07d6ac719a8faa70eafb610f6c by wuyanjun110 fix:修复误触发open space的bug
	data/map/pnc_map/routing_extension/routing_data.cpp
Commit 96a8d6212cb59118851ff31273dabc6fc64a63fe by wuyanjun110 refactor:优化动态搜索限速
	data/plan/guide_line.cpp
	tasks/deciders/long_decider/constrain_decider.cpp