Individální projekty MPOA

Tato stránka je pouze pro čtení. Můžete si pouze prohlédnout zdrojový kód, ale ne ho měnit. Zeptejte se správce, pokud si myslíte, že něco není v pořádku.

====== Výpočet náklonu z akcelerometru ======

===== Zadanie =====
Na vývojové desce STM32F4DISCOVERY s akcelerometrem LIS302DL/LIS3DSH realizujte výpočet příčného a podélného náklonu (roll, pitch). Uvažujte libovolnou polohu akcelerometru vůči základně, tj. implementujte derotaci vstupního datového vektoru dle postupu v [[https://www.st.com/resource/en/design_tip/dm00358510.pdf|DT0076]].
----

===== Úvod =====

Cieľom tohto projektu je:

   * realizovať výpočet priečneho a pozdĺžneho náklonu(angl. roll a pitch)
   * kompenzovať náklon pomocou derotačnej matice pre ľubovoľnú polohu akcelerometru voči referenčnej rovine

Derotačná matica bude počítaná pomocou Matlabu, pretože obsahuje goniometrické funkcie. Program bude možno ovládať cez UART konzolu (vložiť derotačnú maticu, kompenzovať výpočet náklonu).

{{https://www.novatel.com/assets/Web-Phase-2-2012/Solution-Pages/AttitudePlane.png }}



===== Hardware =====
K realizácii projektu bola použitá vývojová deska [[https://www.st.com/en/evaluation-tools/stm32f4discovery.html|STM32F4DISCOVERY]] od firmy STMicroelectronics, súčasťou ktorej je 3-osový MEMS akcelerometer LIS302DL/LIS3DSH. Taktiež obsahuje ST-Link/V2 programátor/debugger. Je založená na jadre ARM Cortex-M4, ktorý je taktovaný 16MHz kryštálom, má 1MB Flash pamäť a 192kB RAM. 

{{2018:accel-roll-pitch:sur_system-na-doske.png?400 }}

===== Software =====

<code c>
float get_degree_tilt(float val, int16_t max_val)
{
    float deg_tilt;
    /* constrain values */
    if(val > max_val) {
      val = max_val;
    }
    else if(val < -max_val) {
      val = -max_val;
    }

   /*map values to range -90° - 90° */
   deg_tilt = (90*val) / max_val;

   return deg_tilt;
}
</code>


----
====== Záver ======

[[https://drive.google.com/open?id=1P0V9NppeeiWWQ49n4yWtXbpKTopOQkus|zdrojové súbory]]

[[https://drive.google.com/open?id=17qJpzuhK15dT8O1v8BeUGPA5j-lbc9JG|videoukážka]]
----
====== Zdroje ======
DT0076- Compensating for accelerometer installation error: zeroing pitch and roll for a reference orientation: [[https://www.st.com/resource/en/design_tip/dm00358510.pdf]]

[[https://www.zive.cz/clanky/pojdme-programovat-elektroniku-jak-vlastne-funguje-akcelerometr-a-gyroskop-nejen-ve-vasem-telefonu/sc-3-a-194858/default.aspx#articleStart]]

Rotation matrix for rotations around x-axis: https://www.mathworks.com/help/phased/ref/rotx.html

Individální projekty MPOA

Uživatelské nástroje

Nástroje pro tento web

Nástroje pro stránku