(a)
(b)
Figure 16:
Estimated trajectory comparison of path 1.