Fot. 7. Powiązanie osi kierunków z czujnikiem MEMS
Poniższy kod nie powinien sprawić problemów w zrozumieniu, ale niektóre fragmenty mogą wymagać komentarzy. Funkcja sChar2Str() konwertuje liczbę w tekst i przyjmuje wskaźnik do ciągu znaków typu char (do którego zostanie zapisana liczba w postaci symboli) oraz wartość liczbową typu signed char. Podczas wyznaczania wysokości słupków występuje podzielenie zmierzonej wartości przez 60 i pomnożenie przez 49 – pierwsza wartość została w przybliżeniu wybrana jako maksymalna mierzona statycznie, a druga określa maksymalną wysokość słupka od linii odniesienia.
|
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 |
signed char x, y, z , xKor=0, yKor=0, zKor=0; void indicator(){ unsigned int j; signed int x_temp, y_temp, z_temp; unsigned char STATE = 0; //Rysowanie ramek drawRectangle(-40, -50, -20, 50, RED, 0); drawRectangle(-10, -50, 10, 50, BLUE, 0); drawRectangle( 20, -50, 40, 50,GREEN, 0); //Rysowanie linii odniesienia drawLine(-66,0,66,0,WHITE); //Wyświetlenie oznaczeń osi LCDPutChar('X',120, 35, 0, 0xFFF, 0x00); LCDPutChar('Y',120, 65, 0, 0xFFF, 0x00); LCDPutChar('Z',120, 95, 0, 0xFFF, 0x00); while(1){ //Odczyt wartości przyśpieszeń LIS35_GetPosition(&x, &y, &z); //Korekta wskazan akcelerometru x+=xKor; y+=yKor; z+=zKor; sChar2Str(tempCHAR, x);//Konwersja wartości przyśpieszenia w osi x na ciąg typu String for (j=0; j < 4; j++) //Wyświetlenie znaków ciągu LCDPutChar(tempCHAR[j], 0, 20+j*7, 0, 0xFFF, 0x00); sChar2Str(tempCHAR, y); for (j=0; j < 4; j++) LCDPutChar(tempCHAR[j], 0, 50+j*7, 0, 0xFFF, 0x00); sChar2Str(tempCHAR, z); for (j=0; j < 4; j++) LCDPutChar(tempCHAR[j], 0, 80+j*7, 0, 0xFFF, 0x00); //(***KOREKTA***) x_temp = (signed int) (( (float) x/60)*49); //Wyznaczenie wysokości słupka if(abs(x_temp) > 49) x_temp = (x_temp < 0) ? -49:49; //Ograniczenie wysokości słupka y_temp = (signed int) (( (float) y/60)*49); if(abs(y_temp) > 49) y_temp = (y_temp < 0) ? -49 : 49 ; z_temp = (signed int) (( (float) z/60)*49); if(abs(z_temp) > 49) z_temp = (z_temp < 0) ? -49 : 49 ; //Rysowanie słupków przyśpieszenia drawRectangle(-38, 0, -21, x_temp, RED, 1); drawRectangle( -8, 0, 9, y_temp, BLUE, 1); drawRectangle( 22, 0, 39, z_temp,GREEN, 1); Delay(0x6FFFFF); //Ustawienie okresu aktualizacji obrazu //Czyszczenie narysowanych słupków drawRectangle(-38, 0, -21, x_temp, 0x000, 1); drawRectangle( -8, 0, 9, y_temp, 0x000, 1); drawRectangle( 22, 0, 39, z_temp, 0x000, 1); if(GPIO_ReadInputDataBit(JOY_PORT, JOY_RIGHT) == 0) break; //Zakonczenie dzialania } } |
