Code style formated, updated angle computation in IMU