Added math function: getMagnitude()
Added yaw calculation from compass
Changed task frequency calculation