Figure 3: Motion trajectories of two-phase approach (blue) and three-phase approach (black) compared with the original measured trajectory (red).