Elektronický kompas HMC5883L

Autori:	Tomáš Kováč, Vladimír Šimčák
Študijný odbor:	Aplikovaná mechatronika a elektromobilita	1. Ing. (2016)

Zadanie

Implementujte HMC5883L elektronický kompas, vytvorte program a vizualizáciu pre jeho používanie.

• Product page
• Sensor description
• i2c library

• Nájdite si k senzorom datasheet
• Nájdite si schémy zapojenia dosky
• Na základe predošlých vedomostí navrhnite spôsob pripojenia k riadiacej jednotke
• Napíšte základný demonštračný program využívajúci vaše funkcie
• Vymyslite a demonštrujte vhodnú aplikáciu
• Dokumentáciu odovzdajte prostredníctvom tejto wiki stránky.

link title

Literatúra:

• Zoznam použitej literatúry, vrátane katalógových údajov (datasheet), internetových odkazov a pod.

Analýza

Treba popísať ako funguje samotný senzor, ako sa pripojí k mikropočítaču a čo vlastne meria. Vymyslieť vzorovú aplikáciu s vizualizáciou na PC. fotky zapojenia, datasheet, screenshot z datasheetu, co meria - mag pole (str. 9 datasheet)

V tejto časti popíšete ako idete daný problém riešiť. Uvediete sem aj všetky potrebné technické údaje, ktoré sú potrebné na úspešné vyriešenie projektu. Napríklad:

HMC5883L modul je magnetorezistívny obvod pozostávajúci z troch HMC118X senzorov pre tri osi. Integrovaný je 12 bitový AD prevodník pre presnosť kompasu 1 až 2 stupne. Senzor disponuje technoológiou AMR ktorá zaisťuje osovú citlivosť a linearitu. Princíp činnosti modulu spočíva v konverzii Zemského magnetického poľa na diferenciál napätia na troch osiach. Výstup tohto napätia sa dá nasledovne spracovať pre rôzne účely. Senzor sa využíva napríklad pre nízkonákladovú navigáciu alebo magnetometriu.

Špecifikácia senzora:

• Napájanie: 2.7 až 6.5 VDC
• Komunikačné prostredie: I2C (do 400kHz)
• Operačné teploty: -30 až +85 °C
• Rozmery: 1.9 x 1.7 cm

Zapojenie modulu

Senzor HMC5883L využíva na komunikáciu zbernicu I2C, na ktorú sa pripojí ako slave zariadenie pod master zariadením, ako je napríklad mikrokontroler. Podporuje štandardné (100kHz) aj rýchle módy (400kHz).

Na pripojenie senzora k doske sme nepotrebovali externé pull-up rezistory vzhľadom na to, že už sú integrované v samotnom senzore (4k7 na SDA a 2k2 na SCL linke).

HMC5883L dokumentácia

HMC5883L datasheet

Popis riešenia

Sem opíšete ako konkrétne ste problém vyriešili. Začnite popisom pripojenia k procesoru (nezabudnite na schému zapojenia!) a zdôraznite ktoré jeho periférie ste pritom využili.

Z webovej stránky produktu sme stiahli voľne dostupnú dokumentáciu pre náš senzor. Zoznámili sme sa s modulom, zistili jeho vlastnosti a oboznámili sa s jednotlivými pinmi.

Popis pinov:

• GND - uzemnenie
• VIN - napätie zdroja
• DRDY - Data Ready, interrupt - nie je nutný pre náš projekt
• SCL - I2C clock
• SDA - I2C data

Schéma zapojenia snímača

Po naštudovaní dokumentácie sme senzor zapojili na dosku podľa nasledujúcej schémy.

Samotné zapojenie na doske, ktorú sme dostali, vyzerá nasledovne

Overili sme funkčnosť senzora jednoduchým programom pre čítanie dát, ktorý sme ďalej upravili do žiadanej formy (viď nasledujúca kapitola).

Algoritmus a program

Algoritmus pre mikropočítač bol vytvorený v programovom prostredí Arduino. Údaje namerané senzorom sú z registrov prostredníctvom zbernice I2C načítavané do mikropočítača a následne odosielané na rozhranie sériového portu, kde s nimi pracuje vizualizačná aplikácia vytvorená v programovacom jazyku C#, vo vývojovom prostredí Visual Studio 2015.

Algoritmus pre mikropočítač:

#include <Wire.h>       /* knižnica pre prácu so zbernicou I2C*/

void setup(){
  Serial.begin(9600);
  Wire.begin();
  
  Wire.beginTransmission((byte)0x1E);     /*  začiatok komunikácie  */
  Wire.write((byte)0x02);     /*  nastavenie registra*/
  Wire.write((byte)0x00);     /* opakované meranie */
  Wire.endTransmission();
}


void loop(){
  
  int x,y,z;    /*  premenné v ktorých budú uložené namerané súradnice*/
 
  /* Zápis dát do registra */
  Wire.beginTransmission((byte)0x1E);
  Wire.write((byte)0x03);     /* zápis do tretieho registra  */
  Wire.endTransmission();
  
 
 /* Čítanie dát, 6B (2B pre každú súradnicu)*/
  Wire.requestFrom((byte)0x1E, 6);
  if(6<=Wire.available()){
    
    x = Wire.read()<<8; /* Most significant byte pre x*/
    x |= Wire.read();  /* Least significant byte pre x*/

    z = Wire.read()<<8; /* Most significant byte pre z*/
    z |= Wire.read(); /* Least significant byte pre z*/

    y = Wire.read()<<8; /* Most significant byte pre y*/
    y |= Wire.read(); /* Least significant byte pre y*/
  }
  
  // výpis súradníc v správnom formáte
  Serial.print(x);
  Serial.print(",");
  Serial.print(y);
  Serial.print(",");
  Serial.println(z);
 
  delay(500);
}

Vizualizácia riešenia sa skladá z niekoľkých častí, ich podstatné časti sa nachádzajú nižšie.

Vizualizačná aplikácia:

Vývojový diagram pre funkcionalitu aplikácie:

Časť kódu pre inicializáciu aplikácie: (načítanie všetkých dostupných portov v počítači kde beží aplikácia) (načítanie obrázkov)

private void Form1_Load(object sender, EventArgs e)
        {
            foreach (string s in SerialPort.GetPortNames())    /* pre každý nájdený port  */
            {
                comboBox1.Items.Add(s);     /*pridá jeho názov do comboBox-u   */
            }
            try
            {
                Bitmap image = (Bitmap)Image.FromFile("Pics/Kompas.bmp");    /*načítanie obrázku ružice kompasu   */
                pictureBox1.Image = (Bitmap)image.Clone();
                Bitmap image2 = (Bitmap)Image.FromFile("Pics/Smer.bmp");    /*načítanie obrázku šípky pre smer natočenia senzoru*/
                pictureBox2.Image = (Bitmap)image2.Clone();
            }
            catch (Exception ex)
            {
                MessageBox.Show("Nebol nájdený obrázok kompasu. (Cesta: Pics/Kompas.bmp)", "Chýbajúci obrázok", MessageBoxButtons.OK, MessageBoxIcon.Exclamation);
            }
        }

Časť kódu pre parsovanie vstupu zo zvoleného COM portu:

string retazec = textBox1.Text;     /* uloženie načítaných dát zobrazených v textBox-e do premennej  */
string vzorka = ",";     /* kľúčový znak pre rozdelenie regulárneho výrazu  */

string[] vysledok = Regex.Split(retazec, vzorka);     /*  uloženie rozdeleného reťazca do poľa reťazcov  */
double x = Convert.ToDouble(vysledok[0]);   /* konverzia dátového typu a uloženie do premennej x  */
double y = Convert.ToDouble(vysledok[1]);   /* konverzia dátového typu a uloženie do premennej y  */
double z = Convert.ToDouble(vysledok[2]);   /* konverzia dátového typu a uloženie do premennej z  */

Výpočet uhla natočenia obrázku:

double deklinacia = 4.1833;     /* uváženie magnetickej deklinácie na základe polohy (http://www.magnetic-declination.com/)*/
double uhol=Math.Atan2(x,y)*180/Math.PI;    /* výpočet uhla zo súradníc a prepočet z radiánov na stupne */

          
uhol = uhol + deklinacia;   /* pričítanie zistenej magnetickej deklinácie */
  
uhol = Math.Truncate(uhol * 100) / 100;   /* orezanie vypočítanej hodnoty na 2 desatinné miesta */

uhol = 2*(uhol - 100)+25;    /* linearizácia vypočítaného uhla pre aproximovaný uhol natočenia obrázku */

            if (uhol < 0)
                uhol += 360;     /* úprava uhla na rozmedzie 0-360° */

            if (uhol > 360)
                uhol -= 360;

label1.Text = "Uhol: " + uhol.ToString() + "°";    /* pomocný výpis vypočítaného celkového uhla natočenia */

Otočenie obrázku o príslušný uhol:

/* otočenie obrázku okolo bodu o príslušný uhol pomocou funkcie*/
public Bitmap RotateImage(Image image, PointF offset, float angle)
        {
            if (image == null)
                throw new ArgumentNullException("image");     /* výnimka pre nenačítaný obrázok*/

            //nový prázdny obrázok do ktorého sa vloží otočený
            Bitmap rotatedBmp = new Bitmap(image.Width, image.Height);
            rotatedBmp.SetResolution(image.HorizontalResolution, image.VerticalResolution);

            //vytvorenie objektu graphics z prázdneho obrázku
            Graphics g = Graphics.FromImage(rotatedBmp);

            //presun bodu rotácie do stredu obrázku
            g.TranslateTransform(offset.X, offset.Y);

            //samotné otočenie
            g.RotateTransform(angle);

            //presun obrázku späť
            g.TranslateTransform(-offset.X, -offset.Y);

            //vkreslenie otoceného obrázk do prázdneho objektu graphics
            g.DrawImage(image, new PointF(0, 0));

            return rotatedBmp;   /* vráť otočený obrázok*/
        }

try
   {             
   Bitmap image = (Bitmap)Image.FromFile("Pics/Kompas.bmp");
   pictureBox1.Image = RotateImage(image, new PointF(200, 200), (float)uhol); 
   }
catch (Exception ex)
   {
    MessageBox.Show("Nebol nájdený obrázok kompasu. (Cesta: Pics/Kompas.bmp)", "Chýbajúci obrázok", MessageBoxButtons.OK, MessageBoxIcon.Exclamation);
   }

Zvyšná časť programu sa nachádza v priložených súboroch.

Zdrojový kód: serial.h a main.c

program.c

Overenie a používateľská príručka

Vytvorená aplikácia pracuje ako elektronický kompas, ktorý ukazuje aktuálnu polohu natočenia senzoru. Namerané dáta sa zo senzoru pripojeného k mikropočítaču prostredníctvom zbernice I2C čítajú do programového prostredia vytvoreného v prostredí Arduino aktuálne nahratého do mikropočítača. Výsledné namerané dáta sú následne odosielané na príslušný sériový port vo forme súradníc (x,y,z). S nimi potom pracuje vizualizačná aplikácia, ktorá bola vytvorená v programovacom jazyku C#.

Natívne prostredie aplikácie umožňuje jednoduchý spôsob jej ovládania ako aj takmer okamžité zobrazenie výsledného natočenia senzoru. Po spustení aplikácie sa užívateľovi zobrazí možnosť výberu jedného z aktuálne dostupných sériových COM portov. Tu je nutné aby užívateľ aplikácie správne zvolil port, na ktorý mikropočítač odosiela namerané dáta. V prípade zvolenia jedného s príslušných portov a jeho úspešnom otvorení aplikácia začne okamžite z daného portu čítať dáta. V našom prípade je nevyhnutné aby na zvolený sériový port boli odosielané dáta v správnom tvare súradníc (x,y,z), ktoré zaručí program nahraný v mikropočítači. Načítané súradnice sú pri správnom načítaní zobrazené v príslušnom textovom poli. Aplikácia z nich následne vypočíta uhol natočenia senzora a aproximuje k nemu natočenie "kompasu" reprezentovaného obrázkom ružice kompasu. Červená šípka v aplikácii ukazuje aktuálne natočenie senzora. Teda napríklad ak šípka ukazujúca smer natočenia senzora a smer "W" (west - západ) ležia na jednej priamke prechádzajúcej stredom ružice znamená to, že senzor ja aktuálne natočený na príslušnú svetovú stranu - západ.

Ukážka funkcionality aplikácie:

Kľúčové slová 'Category', ktoré sú na konci stránky nemeňte.