根据障碍物调整位姿(新版本)