Add plotting scripts for IMU debugging