根据障碍物调整位姿