Added IMU reader stub
Minor code refactoring