#include <Wire.h>
#include <RCSwitch.h>
#include <HMC5883L.h>

HMC5883L compass;

RCSwitch mySwitch = RCSwitch();

#define Addr 0x1E               // 7-bit address of HMC5883 compass

const unsigned long activation = 111269; // Radiateur
const unsigned long idRad=5883;
const unsigned long desactivation = 962111; // Fin radiateur
const unsigned int delai = 11;

#define DEBUG 

void setup() {
  #ifdef DEBUG   
  Serial.begin(9600);
  Serial.println("\nCompas radio");
  #endif
  
  pinMode(13, OUTPUT);
  
  mySwitch.enableTransmit(9);  
  //mySwitch.setRepeatTransmit(3);
  delay(100);                   // Power up delay
//  Wire.begin();
//  
//  // Set operating mode to continuous
//  Wire.beginTransmission(Addr); 
//  Wire.write(byte(0x02));
//  Wire.write(byte(0x00));
//  Wire.endTransmission();
  
   // Initialize Initialize HMC5883L
  while (!compass.begin())
  {
    delay(3000);
    for (int i = 1; i<10; i++) {
    digitalWrite(13, HIGH);   // turn the LED on (HIGH is the voltage level)
    delay(20);              // wait for a second
    digitalWrite(13, LOW);    // turn the LED off by making the voltage LOW
    delay(20);
    }
  }
  
  // Set measurement range
  compass.setRange(HMC5883L_RANGE_1_3GA);

  // Set measurement mode
  compass.setMeasurementMode(HMC5883L_CONTINOUS);

  // Set data rate
  compass.setDataRate(HMC5883L_DATARATE_30HZ);
}

void loop() {
  int x, y, z;

//  // Initiate communications with compass
//  Wire.beginTransmission(Addr);
//  Wire.write(byte(0x03));       // Send request to X MSB register
//  Wire.endTransmission();
//qxc
//  Wire.requestFrom(Addr, 6);    // Request 6 bytes; 2 bytes per axis
//  if(Wire.available() <=6) {    // If 6 bytes available
//    x = Wire.read() << 8 | Wire.read();
//    z = Wire.read() << 8 | Wire.read();
//    y = Wire.read() << 8 | Wire.read();
//  }
  
   Vector mag = compass.readRaw();
   
   // Ranges
//-539:506 / 1045 / 522.5 / OFF : 16.5
//-645:464 / 1109 / 554.5 / OFF : -90.5
//-470:499 / 969  / 484.5 / OFF : 14.5

  x = ((mag.XAxis + 16.5) + 522.5) / 10.45;
  y = ((mag.YAxis -90.5) + 554.5) / 11.09; 
  z = ((mag.ZAxis +14.5) + 484.5) / 9.69;

  #ifdef DEBUG   

  // Print raw values
  Serial.print("X=");
  Serial.print(x);
  Serial.print(", Y=");
  Serial.print(y);
  Serial.print(", Z=");
  Serial.println(z);

  #endif  
   // Serial.println(z);
   
  //  mySwitch.send(activation, 24);  
  //delay(delai); //delayMicroseconds
  
  
  myMessageSend(idRad,1000 + x);
  myMessageSend(idRad,2000 + y);
  myMessageSend(idRad,3000 + z);
  //mySwitch.send(desactivation, 24);
  //delay(delai);
  
  
//  digitalWrite(13, HIGH);   // turn the LED on (HIGH is the voltage level)
//  delay(100);              // wait for a second
//  digitalWrite(13, LOW);    // turn the LED off by making the voltage LOW
    digitalWrite(13, HIGH);   // turn the LED on (HIGH is the voltage level)
    delay(10);              // wait for a second
    digitalWrite(13, LOW);    // turn the LED off by making the voltage LOW
    delay(10);
 //delay(1000);      
}
void myMessageSend(long id, long value) {
  
  #ifdef DEBUG  
  Serial.print("Send id="); Serial.print(id);
  Serial.print(" value="); Serial.println(value);
  #endif
  
 // mySwitch.send(id, 24); //"000000000001010100010001");
  //delay(delai);
  mySwitch.send(value, 24); //"000000000001010100010001");
  delay(delai);

  //delay(5000);
  //delayMicroseconds(TWOTIME*8);
}