Rozdíly

Zde můžete vidět rozdíly mezi vybranou verzí a aktuální verzí dané stránky.

--- gpoa2019:tilt-sensing [2019/05/01 19:42]
Jiří Křivák
+++ gpoa2019:tilt-sensing [2019/05/02 07:45] (aktuální)
Jiří Křivák [Summary]
@@ Řádek 14: / Řádek 14: @@
 For the project, we selected Development Board from STMicroelectronics STM32F4 - Discovery
+{{ :gpoa2019:capture3.png?400| STM32F4-Discovery Board}}
 === KEY FEATURES ===
@@ Řádek 28: / Řádek 29: @@
   * USB OTG FS with micro-AB connector
   * Comprehensive free software including a variety of examples, part of STM32CubeF4 package or STSW-STM32068 to use legacy standard libraries.
+{{:gpoa2019:capture1.png?400| Discovery Board Topl}}
 ====== Implementation======
@@ Řádek 35: / Řádek 38: @@
 We also used ARM GCC Libraries: stdio.h, stdlib.h, math.h
 The app was designed for Em::Bitz and its integrated ARM GCC Compiler.
-Because we use function Printf with floats we need to give the GCC compiler flag that tells it that floats are used for string formatting we also use mathematical library math.h, so we need to give the linker flag to include mathematical libraries.
+Because we use function Printf with floats, we need to give the GCC compiler flag that tells it that floats are used for string formatting we also use mathematical library math.h, so we need to provide the linker flag to include mathematical libraries.
 GCC Compiler Flag: -u _printf_float
 Linker Flag: -lm
+{{ :gpoa2019:unnamed0.png?400 | Block diagram of the program implementation}}
 ===== USB Virtual Com Port and communication =====
 To create Virtual Com Port we used middleware libraries from STMicroelectronics.
-For easier communication, we remapped the Printf function so that when it is called we send data over the USB VCP. Remaping of Printf in ARM GCC is done by modificiation of _write function.
+For easier communication, we remapped the Printf function so that when it is called we send data over the USB VCP. Remapping of Printf in ARM GCC is done by modification of _write function.
 <code c>
 int _write(int fd, char * str, int len)
@@ Řádek 56: / Řádek 60: @@
 </code>
-We used Legacy Middleware library for USB so it is necessarz to instal [[https://www.st.com/en/development-tools/stsw-stm32102.html | VCP Driver]] from STMicroelectronics.
+We used Legacy Middleware library for USB so it is necessary to install [[https://www.st.com/en/development-tools/stsw-stm32102.html | VCP Driver]] from STMicroelectronics.
-===== Vícejádrové zpracování dat =====
+===== Calculation of Reference Roll, Pitch, Yaw =====
+ From XYZ values in reference possition we calculate Roll (Phi), Pitch (Theta) and Yaw (Psi)
+  Phi   = atan(y / sqrt( z^2 + x^2)) ;
+  Theta = atan( -x / sqrt(y^2 + z^2)) ;
+  Psi   = atan(z / sqrt(y^2+x^2) ) ;
+ We get the values of Phi,Theta,Psi in radians that are used for derrotation of XYZ.
+ These values were calculated using MatLab, and the script is not implemented inside the ST32F4-Discovery boards' Firmware.
+===== Derotation =====
+ Using the values of Roll, Pitch, Yaw we de-rotate the XYZ to Reference so we can get values relative to the Base (Reference Position). We use the method of derotation as is described in [[https://www.st.com/resource/en/design_tip/dm00358510.pdf|DT0076]] documentation for compensation of installation error for Accelerometer.
+ To implement this we used GCC mathematical libraries math.h
+<code c>
+// Callibration with Reference Plane
+void derotate_vector(double *Vect ,double phi,double theta,double psi , int16_t XYZ[3])
+{
+// Roll(phi) Pitch(theta) Yaw(psi), angles in radians
+double m11 = cos(theta)*cos(psi);
+double m21 = cos(theta)*sin(psi);
+double m31 = -sin(theta);
+double m12 = sin(phi)*sin(theta)*cos(psi)-cos(phi)*sin(psi);
+double m22 = sin(phi)*sin(theta)*sin(psi)+cos(phi)*cos(psi);
+double m32 = sin(phi)*cos(theta);
+double m13 = cos(phi)*sin(theta)*cos(psi)+sin(phi)*sin(psi);
+double m23 = cos(phi)*sin(theta)*sin(psi)-sin(phi)*cos(psi);
+double m33 = cos(phi)*cos(theta);
+ // derotate vector (product matrix by vector)
+Vect[0] = m11*XYZ[0] + m12*XYZ[1] + m13*XYZ[2];
+Vect[1] = m21*XYZ[0] + m22*XYZ[1] + m23*XYZ[2];
+Vect[2] = m31*XYZ[0] + m32*XYZ[1] + m33*XYZ[3];
-===== Prahování =====
+}
+</code>
+===== Roll Pitch Calculation =====
+From the derotated vectros we calculate Roll and Pitch. These are then sent by USB VCP to Terrminal in computer.
+<code c>
+//calaculation of Roll and Pitch - outputn in angles
+void PITCH_ROLL(double InputData[3])
+{
-===== Detekce hran =====
+  double x_Buff = InputData[0] ;
+  double  y_Buff = InputData[1] ;
+  double  z_Buff = InputData[2] ;
+  printf("ROT: X axis: %lf Y axis: %lf Z axis: %lf \r",x_Buff,y_Buff,z_Buff);
+  double pitch = atan(y_Buff / sqrt( z_Buff * z_Buff + x_Buff * x_Buff)) * 57.3;
+  double roll  = atan((- x_Buff) / sqrt(y_Buff * y_Buff + z_Buff * z_Buff)) * 57.3 ;
+  printf("Roll: %lf Pitch: %lf\n\r",roll,pitch);
+}
-==== Filtr Sobel ====
+</code>
@@ Řádek 73: / Řádek 117: @@
 https://github.com/cerberuspower/GPOA_Project
+===== VCP Driver =====
+{{ :gpoa2019:en.stsw-stm32102.zip |STMicroelectronics USB VCP}}
 ====== Summary ======
+The board senses active Roll and Pitch related to the reference plane which is parrarel to the ground plane.
+==== Problem with unstable reference plane ====
+In the implementation, there was a problem that when the reference plane lies parallel to the ground, there are unstable values of the XYZ values from the accelerometer. This results in instability of reference plane. One possible solution for this is to use a different reference plane.
+==== Video ====
+{{youtube>fNs9JOP4SWY?medium}}
+----
+ --- //[[xkriva25@stud.feec.vutbr.cz|Jiří Křivák]] 2019/05/01 21:46//
+====== References and Sources ======
-====== References ======
+  * https://www.st.com/content/ccc/resource/technical/document/design_tip/group0/dd/3b/63/52/15/c1/43/25/DM00358510/files/DM00358510.pdf/jcr:content/translations/en.DM00358510.pdf
+  * https://www.st.com/en/development-tools/stsw-stm32102.html
+  * https://www.st.com/ja/evaluation-tools/stm32f4discovery.html
+  * http://www.embitz.org/ - Ide Used
+  * https://www.st.com/content/ccc/resource/technical/document/user_manual/70/fe/4a/3f/e7/e1/4f/7d/DM00039084.pdf/files/DM00039084.pdf/jcr:content/translations/en.DM00039084.pdf - STM32F4-Discovery Datasheet

Individální projekty MPOA

Uživatelské nástroje

Nástroje pro tento web

Rozdíly

Nástroje pro stránku