#include <Wire.h>
#include <MechaQMC5883.h>
#include <math.h>

MechaQMC5883 capteur;

int mx, my, mz; // déclaration des variables sur les axes x, y, z
float angle;


void setup() {
  Wire.begin();
  Serial.begin(9600);
  capteur.init();
  //capteur.setMode(Mode_Continuous,ODR_200Hz,RNG_2G,OSR_256);
}

void loop() {
  capteur.read(&mx, &my, &mz);

  // affichage des données
  Serial.println("-------------");
  Serial.print("mag:\t");
  Serial.print(mx);
  Serial.print("\t");
  Serial.print(my);
  Serial.print("\t");
  Serial.print(mz);
  Serial.println("\t");

  // calcul et affichage de l'angle en degrés par rapport au nord
  angle = atan2((double)mx, (double)my);
  Serial.print("angle:\t");
  Serial.println(angle * 180 / PI);
  delay(1000);

}