Changes

Summary

1. fix:修复搜索失败的bug (details)
2. refctor:优化对准逻辑 (details)
3. fix:优化对准的逻辑 (details)
4. feat:添加变道状态机状态 (details)
5. feat:变道延迟时间参数化 (details)
6. fix:修复变道过程中，当前车道突变的bug (details)
7. feat:进出堆场约束的调整 (details)

Commit 637bcb3a4d6338d67668b38c729b42d4953e675c by wuyanjun110 fix:修复搜索失败的bug
	data/ssep/into_yard_junction_ec.cpp
Commit 24717aefab0e40e88eba9cc9a443f628d50a7bea by wuyanjun110 refctor:优化对准逻辑
	plan/prepare/prepare_status.cpp
	data/app/cmd/cmd_align.cpp
	data/vehicle/vehicle_destination.cpp
	data/app/fsm/task_fsm/task_align_fsm/task_align_fsm.cpp
Commit d237d88bf056df82956de38cd36a41644b0fb362 by wuyanjun110 fix:优化对准的逻辑
	plan/prepare/prepare_status.cpp
	data/app/fsm/task_fsm/task_align_fsm/task_align_fsm.cpp
	data/app/cmd/cmd_align.cpp
	data/app/fsm/task_fsm/task_fsm.cpp
Commit 8dbaf1a364a4fef14b0dadc347126d38d1e20e72 by wuyanjun110 feat:添加变道状态机状态
	sink/ros_sink_ads_hfsm_state.cpp
Commit 0ac3b949ee3d5e6b6c1b89752e1eefc8097e4080 by wuyanjun110 feat:变道延迟时间参数化
	data/plan/switch_data.cpp
	data/config/cfg_env_const.cpp
	data/config/cfg_env_const.hpp
Commit 3ac7a00fd4d7aa9ad6bae7ef0b69e68f3fb63b55 by wuyanjun110 fix:修复变道过程中，当前车道突变的bug
	data/plan/switch_data.cpp
Commit f84a8f89a64e6a6825d7ff3d21dc46e917e77a48 by wuyanjun110 feat:进出堆场约束的调整
	data/ssep/out_yard_junction_ec.cpp
	data/ssep/into_yard_junction_ec.cpp