FIX COMPASS LAG

Fix the compass lag by inverting the 'Z' axis of the gyro.