Filter readings from accelerometer, magnetometer and gyro with Kalman Filter to determine attitude