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).

• popis komunikačnej zbernice (i2c, 1-wire, RS-232 a pod.)(i2c z wikipedie)
• obrázok zapojenia vývodov použitej súčiastky(fotky, screeny z datasheetu)
• odkaz na katalógový list
• priebehy dôležitých signálov(datasheet?)
• este jedna polozka

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.

Schéma zapojenia snímača

Súbor:Example.jpg

Pozn.: Názov obrázku musí byť jedinečný, uvedomte si, že Obr1.jpg už pred vami skúsilo nahrať už aspoň 10 študentov.

Algoritmus a program

Uveďte stručný popis algoritmu, v akom jazyku a verzii vývojového prostredia ste ho vytvorili. Je vhodné nakresliť aspoň hrubú štruktúru programu napríklad vo forme vývojového diagramu. Rozsiahly program pre lepšiu prehľadnosť rozdeľte do viacerých súborov.

Vyberte podstatné časti zdrojového kódu, použite na to prostredie source:

/* A nezabudnite zdroják hojne komentovať  */

int main(void) {
    
    printf("Hello, World!\n");  
    return(0);  
}

Nezabudnite však nahrať aj kompletné zdrojové kódy vášho programu!

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č:

/* A nezabudnite zdroják hojne komentovať  */

int main(void) {
    
    printf("Tuto je ten kod!\n");  
    return(0);  
}

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 o príslušný uhol pomocou funkcie*/

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

Nezabudnite napísať čosi ako užívateľský návod. Z neho by malo byť jasné čo program robí, ako sa prejavuje a aké má užívateľské rozhranie (čo treba stlačiť, čo sa kde zobrazuje). Ak ste namerali nejaké signály, sem s nimi. Ak je výsledkom nejaký údaj na displeji, odfotografujte ho.

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.