添加航点模式下避障
跟随模式下避障头强制向前