Operácie

Akcelerometre: Rozdiel medzi revíziami

Zo stránky SensorWiki

Balogh (diskusia | príspevky)
Bez shrnutí editace
Balogh (diskusia | príspevky)
Bez shrnutí editace
 
(19 medziľahlých úprav od rovnakého používateľa nie je zobrazených.)
Riadok 4: Riadok 4:
'''Úloha:'''
'''Úloha:'''
Akcelerometre ktoré máte v mobile, alebo ako samostatný senzor, použijeme na ovládanie 3D modelu v prostredí Processing.
Akcelerometre ktoré máte v mobile, alebo ako samostatný senzor, použijeme na ovládanie 3D modelu v prostredí Processing.
Pozrite si [https://drive.google.com/file/d/1ce0D3W6obaAZDErZumvAJEj3vSSjfKJe/view?usp=sharing ukážku].
<!-- [https://drive.google.com/file/d/1UaRiMR1ZsW4bQJJLNZUkVYxNOaL64g6Q/view?usp=sharing ukážku]. -->




'''Postup:'''
'''Postup:'''


1. Údaje z akcelerometrov v mobile prenesiete cez Bluetooth alebo cez WiFi pomocou niektorej z aplikácií, ktoré poznáte
# Údaje z akcelerometrov v mobile prenesiete cez Bluetooth alebo cez WiFi pomocou niektorej z aplikácií, ktoré poznáte z predošlých cvičení. Kontrola: v programe Terminal.exe alebo podobnom skontrolujete, či prijímate správne údaje.
z predošlých cvičení. Kontrola: v programe Terminal.exe alebo podobnom skontrolujete, či prijímate správne údaje.
# Údaje prijmete v aplikácii, ktorú máte ako vzor uvedenú nižšie. Treba len:
## rozparsovať prijímané dáta na tri súradnice ax, ay a az.
## prepočítať zrýchlenia na natočenia roll, yaw a pitch.
## na základe výpočtu pohybovať objektom v okne
# Okrem vzorovej kocky, ktorú máte vo vzorovej aplikácii, vytvorte alebo stiahnite z internetu iný 3D model vo formáte .obj a demonštrujte na krátkom videu, že ním viete otáčať.  


2. Údaje prijmete v aplikácii, ktorú máte ako vzor uvedenú nižšie. Treba len:
a) rozparsovať prijímané dáta na tri súradnice ax, ay a az.
b) prepočítať zrýchlenia na natočenia roll, yaw a pitch.
c) na základe výpočtu pohybovať objektom v okne
3. Okrem vzorovej kocky, ktorú máte vo vzorovej aplikácii, vytvorte alebo stiahnite z internetu iný 3D model vo
formáte .obj a demonštrujte na krátkom videu, že ním viete otáčať.


'''Odovzdať treba:'''  
'''Odovzdať treba:'''  
Riadok 42: Riadok 41:


   // myObject = loadShape("tinker.obj");  // objekt, ktorym chcem hybat
   // myObject = loadShape("tinker.obj");  // objekt, ktorym chcem hybat
 
  // myObject.scale(2.0);                // ak je prilis maly alebo velky, zmente mu velkost
   /* Toto je niekolko prikladov, ako si vybrat seriovy port, nie je aktivne
   /* Toto je niekolko prikladov, ako si vybrat seriovy port, nie je aktivne
     ani jedno, musite si niektoru moznost odkomentovat                    */
     ani jedno, musite si niektoru moznost odkomentovat                    */
Riadok 67: Riadok 67:
   translate(width/2, height/2); // pociatok suradnic bude v strede okna
   translate(width/2, height/2); // pociatok suradnic bude v strede okna


     rotateX(radians(roll));
     rotateX(radians(roll));     // argument je v radianoch <0,pi/2> co nam zabezpeci funkcia radians()
     rotateY(radians(-pitch));
     rotateY(radians(-pitch));
     rotateZ(radians(yaw));
     rotateZ(radians(yaw));
Riadok 74: Riadok 74:
     // shape(myObject); // zobrazime 3D model .obj
     // shape(myObject); // zobrazime 3D model .obj


  popMatrix(); // end of object


   // Ziskane hodnoty si pre istotu vypiseme aj do konzoly
   // Ziskane hodnoty si pre istotu vypiseme aj do konzoly
Riadok 104: Riadok 103:
         /* Vasa uloha je namiesto pevnej hodnoty vlozit vypocet                    */
         /* Vasa uloha je namiesto pevnej hodnoty vlozit vypocet                    */


         yaw=45;
         yaw=45;   // tu predpokladame, ze hodnoty nam chodia v stupnoch, ale vase senzory mozno davaju radiany alebo nasobky g
         pitch=-45;
         pitch=-45;
         roll=45;         
         roll=45;         
Riadok 129: Riadok 128:
* Ak k vyexportovanému objektu pridáte aj .mtl súbor, objekt bude farebný
* Ak k vyexportovanému objektu pridáte aj .mtl súbor, objekt bude farebný
* Tento demo program v Processingu otáča objektom pomocou myšky ([http://senzor.robotika.sk/mems/OrientationDemo.zip OrientationDemo.zip])
* Tento demo program v Processingu otáča objektom pomocou myšky ([http://senzor.robotika.sk/mems/OrientationDemo.zip OrientationDemo.zip])
* Prevod natočenia z akcelerometrov na yaw, pitch a roll je popísaný v týchto troch článkoch:
** Mark Pedley: ''[https://www.nxp.com/docs/en/application-note/AN3461.pdf Tilt Sensing Using a Three-Axis Accelerometer]''. Application Note AN3461. Freescale Semiconductor,  2013.
** Talat  Ozyagcilar: ''[https://www.nxp.com/docs/en/application-note/AN4248.pdf Implementing a Tilt-Compensated eCompass using Accelerometer and Magnetometer Sensors]'' Application Note AN4248. Freescale Semiconductor,  2012.
** Talat  Ozyagcilar: ''[https://www.nxp.com/docs/en/application-note/AN4249.pdf Accuracy of Angle Estimation in eCompass and 3D Pointer Applications]'' Application Note AN4249. Freescale Semiconductor,  2015.
Ale predpokladám, že vám bude stačiť toto, kde G sú jednotlivé zrýchlenia a ϕ = roll and θ = pitch:
<math>
\tan \phi_{xyz} = \frac{G_{py}}{G_{pz}}
</math>
<math>
\tan \theta_{xyz} = \frac{-G_{px}}{G_{py}\sin \phi + G_{pz}\cos \phi} = \frac{-G_{px}}{\sqrt{G_{py}^2 + G_{pz}^2}}
</math>
Implementácia by mohla vyzerať napríklad takto (atan2 dáva výsledky v radiánoch)
<source lang="cpp">
roll = atan2(accelerationY, accelerationZ);
pitch = atan2(-accelerationX, sqrt(accelerationY*accelerationY + accelerationZ*accelerationZ));
yaw =  atan2(accelerationZ, sqrt(accelerationX*accelerationX + accelerationZ*accelerationZ));
</source>
 
* Ak vám nefunguje on-line prenos dát, môžete toto zadanie spraviť tiež aj off-line, teda zo záznamu.  Najprv nafilmujete ruku s mobilom, ktorou spravíte niekoľko jasne definovaných pohybov, potom doplníte video o ukážku, že objekt sa pohybuje v súlade s pohybom ruky, hoci aj nahraným v inom čase.
** Na načítanie údajov zo súboru v programe Processing použite [https://processing.org/reference/createReader_.html createReader()] - pozrite si príklad a bude to jasné.
** Pri načítaní dát zo súboru však musíte program trocha spomaliť, pretože zo súboru tie data dokážete čítať oveľa rýchlejšie ako ste ich zozbierali. Preto je vhodné po výpočte natočenia program zastaviť a "počkať" na ďalšiu vzorku, napríklad pomocou funkcie [https://processing.org/reference/delay_.html delay();].
* Ak je objekt ktorý kreslíte príliš malý alebo veľký, zmeňte mu veľkosť príkazom <code>myObject.scale(2.0);</code> hneď po nahraní, za príkazom <code>loadShape()</code>
[[Súbor:logoMatlab.png|80px|left]] Ak vám to nepôjde ani jedným z uvedených spôsobov, skúste to ešte pomocou aplikácie [https://play.google.com/store/apps/details?id=com.mathworks.matlabmobile&hl=en&gl=US MATLAB Mobile].<BR>
Ukážkový program na spracovanie dát a zobrazenie 3D objektu v Matlabe nájdete na [https://senzor.robotika.sk/mems/LiveAccelerometerData.html samostatnej stránke tu].








<BR>
<BR>
<BR>


[[MEMS inteligentné senzory a aktuátory#Cvi.C4.8Denia|Návrat na zoznam cvičení...]]
[[MEMS inteligentné senzory a aktuátory#Cvi.C4.8Denia|Návrat na zoznam cvičení...]]


[[Category:MEMS]]
[[Category:MEMS]]

Aktuálna revízia z 07:28, 9. apríl 2022

Modifikované cvičenie na DOMA:


Úloha: Akcelerometre ktoré máte v mobile, alebo ako samostatný senzor, použijeme na ovládanie 3D modelu v prostredí Processing. Pozrite si ukážku.


Postup:

  1. Údaje z akcelerometrov v mobile prenesiete cez Bluetooth alebo cez WiFi pomocou niektorej z aplikácií, ktoré poznáte z predošlých cvičení. Kontrola: v programe Terminal.exe alebo podobnom skontrolujete, či prijímate správne údaje.
  2. Údaje prijmete v aplikácii, ktorú máte ako vzor uvedenú nižšie. Treba len:
    1. rozparsovať prijímané dáta na tri súradnice ax, ay a az.
    2. prepočítať zrýchlenia na natočenia roll, yaw a pitch.
    3. na základe výpočtu pohybovať objektom v okne
  3. Okrem vzorovej kocky, ktorú máte vo vzorovej aplikácii, vytvorte alebo stiahnite z internetu iný 3D model vo formáte .obj a demonštrujte na krátkom videu, že ním viete otáčať.


Odovzdať treba:

  • video na ktorom vidno ako otáčate objektom pohybom mobilu
  • zdrojový kód v Processingu (.pde)
  • model objektu (.obj)


Vzorový program

import processing.serial.*;

Serial myPort;
PShape myObject;

float yaw = 0.0;
float pitch = 0.0;
float roll = 0.0;

void setup()
{
  size(600, 600, P3D);

  // myObject = loadShape("tinker.obj");  // objekt, ktorym chcem hybat
  // myObject.scale(2.0);                 // ak je prilis maly alebo velky, zmente mu velkost
 
  /* Toto je niekolko prikladov, ako si vybrat seriovy port, nie je aktivne
     ani jedno, musite si niektoru moznost odkomentovat                    */

  // ak nic neviete, vypiste si najprv vsetky porty co mate:
  printArray(Serial.list());
  
  // ak mate len jeden port, alebo viete ktory v poradi je ten vas:
  // myPort = new Serial(this, Serial.list()[1], 115200); 

  // ak viete cislo portu:
  //myPort = new Serial(this, "COM5:", 9600);        // Windows "COM#:"
  // myPort = new Serial(this, "\\\\.\\COM39", 115200); // Windows, od COM10 vyssie
  //myPort = new Serial(this, "/dev/ttyACM0", 9600);   // Linux "/dev/ttyACM#"
  //myPort = new Serial(this, "/dev/cu.usbmodem1217321", 9600);  // Mac "/dev/cu.usbmodem######"
}

void draw()
{
  serialEvent();   // nacitaj hodnoty z prichadzajucej spravy
  background(255); // biele pozadie
  lights();        // osvetlenie sceny

  translate(width/2, height/2); // pociatok suradnic bude v strede okna

    rotateX(radians(roll));     // argument je v radianoch <0,pi/2> co nam zabezpeci funkcia radians()
    rotateY(radians(-pitch));
    rotateZ(radians(yaw));

    drawObject();  // objekt bud nakreslime, alebo
    // shape(myObject); // zobrazime 3D model .obj


  // Ziskane hodnoty si pre istotu vypiseme aj do konzoly
  print(roll);
  print("\t");
  print(-pitch);
  print("\t");
  print(yaw);
  println();
}


void serialEvent()
{
  float aX, aY, aZ;
  int newLine = 13; // new line character in ASCII
  String message;

  do {
    message = myPort.readStringUntil(newLine);     // read from port until new line
    if (message != null) {
      String[] list = split(trim(message), " ");   // hodnoty su oddelene medzerami (ale mozem sem dat napr. ciarky)
      if (list.length >= 4 && list[0].equals("Orientation:")) {  // tu vyhodime zo zaciatku slovo Orientation: ale nemusi to byt vobec
        aX = float(list[1]); // convert to float yaw
        aY = float(list[2]); // convert to float pitch
        aZ = float(list[3]); // convert to float roll
        
        /* Tuto treba dopisat prevod zrychlenia v jednotlivych osiach na natocenia */ 
        /* Vasa uloha je namiesto pevnej hodnoty vlozit vypocet                    */

        yaw=45;    // tu predpokladame, ze hodnoty nam chodia v stupnoch, ale vase senzory mozno davaju radiany alebo nasobky g
        pitch=-45;
        roll=45;        
        
      }
    }
  } while (message != null);
}


void drawObject()
{
  stroke(0); // black outline
  fill(255, 215, 0); // gold color
  box(100,100, 100); // cube

}

Tipy:

Ale predpokladám, že vám bude stačiť toto, kde G sú jednotlivé zrýchlenia a ϕ = roll and θ = pitch:

Implementácia by mohla vyzerať napríklad takto (atan2 dáva výsledky v radiánoch)

roll = atan2(accelerationY, accelerationZ);

pitch = atan2(-accelerationX, sqrt(accelerationY*accelerationY + accelerationZ*accelerationZ));

yaw =  atan2(accelerationZ, sqrt(accelerationX*accelerationX + accelerationZ*accelerationZ));


  • Ak vám nefunguje on-line prenos dát, môžete toto zadanie spraviť tiež aj off-line, teda zo záznamu. Najprv nafilmujete ruku s mobilom, ktorou spravíte niekoľko jasne definovaných pohybov, potom doplníte video o ukážku, že objekt sa pohybuje v súlade s pohybom ruky, hoci aj nahraným v inom čase.
    • Na načítanie údajov zo súboru v programe Processing použite createReader() - pozrite si príklad a bude to jasné.
    • Pri načítaní dát zo súboru však musíte program trocha spomaliť, pretože zo súboru tie data dokážete čítať oveľa rýchlejšie ako ste ich zozbierali. Preto je vhodné po výpočte natočenia program zastaviť a "počkať" na ďalšiu vzorku, napríklad pomocou funkcie delay();.
  • Ak je objekt ktorý kreslíte príliš malý alebo veľký, zmeňte mu veľkosť príkazom myObject.scale(2.0); hneď po nahraní, za príkazom loadShape()


Ak vám to nepôjde ani jedným z uvedených spôsobov, skúste to ešte pomocou aplikácie MATLAB Mobile.

Ukážkový program na spracovanie dát a zobrazenie 3D objektu v Matlabe nájdete na samostatnej stránke tu.






Návrat na zoznam cvičení...