Rotate axes of accelerometer and magnetometer
Add moving average to pitch and roll
Add moving average for yaw