Navigations error in multi-vehicles scenario
For single-vehicle scenario, the navigation of car can work correctly.
For multi-vehicles scenario, the navigation of cars can not work correctly. The cars drive irregularly and out of the (road)path.
Attach is an error example, which shows a simple 2-vehicles scenario, and the cars should drive in opposite directions, but irregularly.
[vehicle_1]
[vehicle_2]
Attempting solution: debug the pathfinding algorithm in the multi-vehicles situation.