Figure 16: plane close to TDP for the dynamic condition, showing simulated robot trajectory (dashed), simulated and processed external measurements from depth sensor and IMU models () and Kalman Filter estimates (clearer dots).