Implementacija fuzije inercijskih senzora na ugradbenom računalnom sustavu

Cilj ovog diplomskog rada je implementirati Madgwickov filtar za određivanje orijentacije predmeta u prostoru na mikrokontroleru STM32F4. Filtru je potrebno davati informacije o akceleraciji tijela, kutnoj brzini te orijentaciji u odnosu na sjever što se postiže MARG sustavom. Za mjerenje ovih podat...

Full description

Bibliographic Details
Main Author: Dominić, Ivan
Other Authors: Cifrek, Mario
Format: Master Thesis
Language:Croatian
Published: Sveučilište u Zagrebu. Fakultet elektrotehnike i računarstva. 2021
Subjects:
IMU
Online Access:https://zir.nsk.hr/islandora/object/fer:7785
https://urn.nsk.hr/urn:nbn:hr:168:092497
https://repozitorij.unizg.hr/islandora/object/fer:7785
https://repozitorij.unizg.hr/islandora/object/fer:7785/datastream/PDF
Description
Summary:Cilj ovog diplomskog rada je implementirati Madgwickov filtar za određivanje orijentacije predmeta u prostoru na mikrokontroleru STM32F4. Filtru je potrebno davati informacije o akceleraciji tijela, kutnoj brzini te orijentaciji u odnosu na sjever što se postiže MARG sustavom. Za mjerenje ovih podataka su se koristili akcelerometar i žiroskop unutar sustava ICM-20948, te magnetometar AK09116 koji zajedno čine MARG. Filtar se implementira pomoću kvaterniona jer njihova aritmetika uvelike oslabljuje zahtjeve na snagu procesora koji su visoki u aritmetici sa rotacijskim matricama zbog kompleksnosti računanja trigonometrijskih funkcija koje koriste ostali filteri. Ovaj filtar također uspješno eliminira i klizanje žiroskopa te grešku deklinacije Zemljinog magnetskog polja. Za kalibraciju smetnji iz soft i hard iron izvora kod magnetometra, razvijena je vlastita metoda također temeljena na aritmetici s kvaternionima. This thesis reviews implementation of Madgwick filter for determination of the orientation of given objects in space using STM32F4 microcontroller. The filter should be fed with information on body acceleration, angular velocity and orientation in relation to the north pole, which is achieved through the MARG system. An accelerometer and gyroscope within the ICM-20948 system and an AK09116 magnetometer, which together form MARG, were used to measure this data. The filter is implemented using quaternions because their arithmetic greatly reduces the computational power requirements of processors that are high in, for example, rotational matrix arithmetic due to the complexity of computing trigonometric functions which are used in other filters. This filter also successfully eliminates the gyro drift errors and declination errors of the Earth's magnetic field. To calibrate interference from soft and hard iron sources in a magnetometer, proprietary method has also been developed based on quaternion arithmetic.