服务器config设置park导致的问题
需求期望机器人在完成任务处于空闲状态下自动回到初始点。
但是在服务端配置文件把nothing改成park之后，出现了bug：服务端在下发pickup任务给机器人R之后，马上生成了一个loop任务，这个loop任务的起点与pickup任务的终点A一致，终点则是机器人A的初始点。如图所示：
这就导致，在pickup完成之后，机器人先执行后序的dropoff任务，执行完成dropoff到达了B点，然后自动执行loop任务，先到达A点后，才回到初始点。
需求期望机器人在完成任务处于空闲状态下自动回到初始点。
但是在服务端配置文件把nothing改成park之后，出现了bug：服务端在下发pickup任务给机器人R之后，马上生成了一个loop任务，这个loop任务的起点与pickup任务的终点A一致，终点则是机器人A的初始点。如图所示：
这就导致，在pickup完成之后，机器人先执行后序的dropoff任务，执行完成dropoff到达了B点，然后自动执行loop任务，先到达A点后，才回到初始点。