Added code to process IMU data
Added IMU firmware