Modified System.cc to not look for a transform from the camera to the imu, but rater the IMU to the world
Changed the IMU integration such that it now takes in differential rotations in the orientation matrix that takes point from earth fixed frame to imu body frame