Adding scaling for accel and gyro.
Adding time delta calculations.
Adding comments and some calculations.