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

Figure 22

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