Ongoing improvements to IMU code

Added temperature logging.
Now determining accel/gyro scale factor.
GPS now updates at 5Hz instead of 1Hz.