Added IMU path plotter