A New Real-Time Path Planning Method Based on the Belief Space

Figure 24

The simulation of the path in situation B for distance detecting.