Arduino İle Dijital Pusula Yapımı

Bu projemizde MHC5883L 3 eksenli dijital pusula kullanarak arduino ile kendi pusulamızı yapacağız.

Malzemeler:

1. Arduino
2. HMC5883L 3 eksenli dijital pusula
3. Nokia 5110 ekran (pcb versiyon)
4. 2x Buton
5. 1x Açma / kapama anahtarı

Projeyi Satın Al

Kütüphane Dosyalarını İndir

Elektronik Devre Şeması:

Pusula sensörü scl sda ve enerji pinlerini arduino karta takıyoruz.Uno ve nano kullanıyorsanız scl analog 5, sda analog 4. pine takınız.Megada pinler üzerinde yazıyor.Nokia ekran pinlerini de şekildeki gibi soldan sağa 5v , gnd , 7,6,5,4,,3 nolu pinlere takıyoruz.

Yazılım Kısmı:

#include <SPI.h>
#include <Wire.h>
#include <Button.h>
#include <Adafruit_GFX.h>
#include <Adafruit_PCD8544.h>
#include <Adafruit_HMC5883_U.h>
#include <Adafruit_Sensor.h>

//Init Display (SCLK, DIN, D/C, CS, RST)
Adafruit_PCD8544 display = Adafruit_PCD8544(7, 6, 5, 4, 3);
//Init HMC5883L sensor
Adafruit_HMC5883_Unified compass = Adafruit_HMC5883_Unified(12345);

//Constants
const int lcdLight = 13; //BL pin of LCD to arduino pin 13 (BL = Back Light)
Button buttonA = Button(2,PULLUP); //Button to turn on/off display light
Button buttonB = Button(8,PULLUP); //Button for changing display mode
// For 1st display mode:
static unsigned char Leters[] = { 'N' , 'E' , 'S' , 'W' };
const static unsigned char PROGMEM arrow_bmp[] =
{B00100000, B00100000, B01110000, B01110000, B11111000};
// For 2nd display mode:
int r = 24; // radius of compass rose
int x0= 60; // x-origin
int y0= 24; // y-origin

//Variables
int flag=0;
int i=1;

void setup() {
pinMode(lcdLight, OUTPUT); // lcd led
compass.begin();
Wire.begin();
display.begin();
display.setContrast(60);
//Print a welcome message in startup for 6sec.//////////
digitalWrite(lcdLight,HIGH);
display.clearDisplay(); // clears the screen and buffer
display.setTextColor(BLACK);
display.setCursor(0,2);
display.print(" ARDUMOTIVE ");
display.setCursor(0,13);
display.print(" ArduinoBased ");
display.setCursor(0,23);
display.print(" compassn.Compass ");
display.setCursor(0,33);
display.print(" Michalis Vas.");
display.display(); // show splashscreen
digitalWrite(lcdLight,LOW);
delay(6000);
display.clearDisplay(); // clears the screen and buffer
}

void loop() {

//if buttonB is pressed, 'flag' will change between 0 and 1
if(buttonB.isPressed()){
delay(100);//small delay
if(flag==0){ flag=1; }
else{ flag=0; }
}
//if buttonA is pressed, 'i' will change between 0 and 1
if(buttonA.isPressed()){
if(i==0){ i=1; }
else{ i=0; }
}
if (i==0){
digitalWrite(lcdLight,HIGH);}
else{
digitalWrite(lcdLight,LOW);
}
sensors_event_t event;
compass.getEvent(&event);
float heading = atan2(event.magnetic.y, event.magnetic.x);

float declinationAngle = 0.22; // heading += declinationAngle;
if(heading < 0) heading += 2*PI; if(heading > 2*PI)heading -= 2*PI;
float headingDegrees = heading * 180/M_PI;
//Convert float to int
int angle=(int)headingDegrees;
display.clearDisplay();

if (flag==0){
DrawRow(angle);
display.drawBitmap(40, 24, arrow_bmp, 5, 5, 1);
display.drawLine(42, 0, 42, 24, BLACK);
display.setCursor(32,34);
display.print(angle);
display.setTextSize(1);
display.print("o");
display.display();
delay(500);
}
if (flag==1){
DrawCircle(angle);
display.setTextSize(2);
display.setTextColor(BLACK);
display.setCursor(0,0);
display.println(angle);

display.setTextSize(1);
display.setTextColor(BLACK);
display.setCursor(x0-2,0);
display.println("N");

display.setTextSize(1);
display.setTextColor(BLACK);
display.setCursor((x0+r)-5,y0-3);
display.println("E");

display.setTextSize(1);
display.setTextColor(BLACK);
display.setCursor(x0-2,y0+r-8);
display.println("S");

display.setTextSize(1);
display.setTextColor(BLACK);
display.setCursor((x0-r)+5,y0-3);
display.println("W");

// Triangle for direction
display.drawTriangle(0, 46, 20, 46, 10, 18, BLACK);
display.fillTriangle (0, 46, 20, 46, 10, 18, BLACK);
display.display();
delay(500); //print new value every 0.5sec
}
}/// end of program

//////////// Functions ////////////

//Draw rows and print letters to display - 1st Display Mode
void DrawRow(int angle) {

display.drawLine(0, 0, 84, 0, BLACK);
display.drawLine(0, 1, 84, 1, BLACK);

display.drawLine(0, 22, 91, 22, BLACK);
display.drawLine(0, 23, 95, 23, BLACK);

display.setTextSize(2);
display.setTextColor(BLACK);

int start = 42 - angle / 3 ;
if (start > 120) start += -120 ;

int x = 0 ;
int y = 18 ;
for (int i=0; i<4; i++) { x = start + (i*30) -1; if (x>119) x += -120;
display.drawPixel(x+1, y-2, 1);
display.drawPixel(x, y, 1);
display.drawPixel(x+1, y, 1);
display.drawPixel(x+2, y, 1);
display.drawPixel(x, y-1, 1);
display.drawPixel(x+1, y-1, 1);
display.drawPixel(x+2, y-1, 1);
display.setCursor((x-4),(y-16));
display.write(Leters[i]);
}
for (int i=0; i<24; i++) { x = start + (i*5) -1; if (x>119) x += -120;
display.drawPixel(x+1, y+1, 1);
display.drawPixel(x, y+2, 1);
display.drawPixel(x+1, y+2, 1);
display.drawPixel(x+2, y+2, 1);
display.drawPixel(x, y+3, 1);
display.drawPixel(x+1, y+3, 1);
display.drawPixel(x+2, y+3, 1);
};

for (int i=0; i<8; i++) { x = start + (i*15)-1; if (x>119) x += -120;
display.drawPixel(x+1, y-1, 1);

display.drawPixel(x, y, 1);
display.drawPixel(x+1, y, 1);
display.drawPixel(x+2, y, 1);
display.drawPixel(x, y+1, 1);
display.drawPixel(x+1, y+1, 1);
display.drawPixel(x+2, y+1, 1);

};
}

////Draw circle and print letters to display - 1st Display Mode
void DrawCircle(int angle) {
if (angle >= 0 && angle <=45) { int angle = angle/2; display.drawLine(x0, y0, x0+angle, y0-r, BLACK); } else if (angle >45 && angle <=90) { int angle = (angle-44)/2 ; display.drawLine(x0, y0, x0+r, (y0-r)+angle, BLACK); } else if (angle >90 && angle <=135) { int angle = (angle-90)/2; display.drawLine(x0, y0, x0+r, y0+angle, BLACK); } else if (angle >135 && angle <=180){ int angle = (angle-134)/2; display.drawLine(x0, y0, (x0+r)-angle, y0+r, BLACK); } else if (angle >180 && angle <=225){ int angle = (angle-178)/2; display.drawLine(x0, y0, x0-angle, y0+r, BLACK); } else if (angle >225 && angle <=270){ int angle = (angle-222)/2; display.drawLine(x0, y0, x0-r, (y0+r)-angle, BLACK); } else if (angle >270 && angle <=315){ int angle = (angle-270)/2; display.drawLine(x0, y0, x0-r, y0-angle, BLACK); } else if (angle >315 && angle <=360){
int angle = (angle-312)/2;
display.drawLine(x0, y0, (x0-r)+angle, y0-r, BLACK);
}
}