Changes

Summary

1. fix:修复搜索失败的bug (details)
2. refctor:优化对准逻辑 (details)
3. fix:优化对准的逻辑 (details)
4. feat:添加变道状态机状态 (details)

Commit 637bcb3a4d6338d67668b38c729b42d4953e675c by wuyanjun110 fix:修复搜索失败的bug
	data/ssep/into_yard_junction_ec.cpp
Commit 24717aefab0e40e88eba9cc9a443f628d50a7bea by wuyanjun110 refctor:优化对准逻辑
	data/app/fsm/task_fsm/task_align_fsm/task_align_fsm.cpp
	data/vehicle/vehicle_destination.cpp
	plan/prepare/prepare_status.cpp
	data/app/cmd/cmd_align.cpp
Commit d237d88bf056df82956de38cd36a41644b0fb362 by wuyanjun110 fix:优化对准的逻辑
	data/app/cmd/cmd_align.cpp
	data/app/fsm/task_fsm/task_fsm.cpp
	plan/prepare/prepare_status.cpp
	data/app/fsm/task_fsm/task_align_fsm/task_align_fsm.cpp
Commit 8dbaf1a364a4fef14b0dadc347126d38d1e20e72 by wuyanjun110 feat:添加变道状态机状态
	sink/ros_sink_ads_hfsm_state.cpp