Lab 1 Compass Module HMC5883 L

Arduino IDE Code

#include <Wire.h>

#include <MechaQMC5883.h>

#include <Wire.h>

#include <SPI.h>

#include <Adafruit_GFX.h>

#include <Adafruit_SSD1306.h>

Adafruit_SSD1306 OLED(-1);

MechaQMC5883 qmc;

void setup() {

  OLED.begin(SSD1306_SWITCHCAPVCC, 0x3C); // กำหนดแอดเดรสของพอร์ตจอเป็น 0x3C (for the 128x64)

  Wire.begin();

  qmc.init();    //qmc.setMode(Mode_Continuous,ODR_200Hz,RNG_2G,OSR_256);

  Serial.begin(115200);

}

void loop() {

  int x, y, z, azimuth;

  //qmc.read(&x, &y, &z);

  qmc.read(&x, &y, &z, &azimuth);

  Serial.print("x: ");

  Serial.print(x);

  Serial.print(" y: ");

  Serial.print(y);

  Serial.print(" z: ");

  Serial.print(z);

  Serial.println();

  OLED.clearDisplay();

  OLED.setTextColor(WHITE, BLACK);

  OLED.setCursor(0, 0);

  OLED.setTextSize(2);

  OLED.print(" x = "); OLED.println(x);

  OLED.print(" y = "); OLED.println(y);

  OLED.print(" z = "); OLED.println(z);

  OLED.print("Azi= "); OLED.println(azimuth);

  OLED.display();

  delay(50);

}