Figure 4.1: Tracking results of the position and yaw.