Pėdomačio prietaisas

„Pėdomatis“ Pėdomatis, prietaisas žmogaus judėjimo greičiui ir nueitam keliui stebėti. Jis realizuojamas akselerometro pagalba. Akselerometras, prietaisas pagreičiui matuoti (pagreičiamatis). Priklausomai nuo naudojamų sensorinių medžiagų, yra keli akselerometrų tipai: talpinis, piezo elektrinis, piezo- rezistyvonis, magnetinis, magneto- rezistyvinis. Šiame darbe aš naudoju talpinį, “Analog Devices” firmos akselerometrą ADXL202E. Jo veikimas pargystas tuo, kad viduje esančios talpos kinta priklausomai nuo pagreičio, o kintant talpai viduje, esanti logika kaičia išėjimo signalą. Šiuo taveju išėjimo signalas yra analoginis. Šis prietaisas yra dviejų judėjimo krypčių(X ir Y ašimis), tačiau šiame darbe mums užteks judėjimo tik X ašimi. Jis gali matuoti pagreitį iki ± 2g. Galima matuti tiek dinaminį pagreitį (pvz. vibraciją), tiek statinį pagreitį (pvz. gravitaciją). Maitinimo įtampa 5V, srovė #include /* Priskyrimai */ #define DB4 0x00 #define DB5 0x01 #define DB6 0x02 #define DB7 0x03 #define RS 0x04 #define CE 0x05 #define function_set 0x28 #define display 0x0C // Set ON Display, Cursor OFF , Cursor blink OFF #define entry 0x06 /* Globalus kintamieji */ unsigned char rezimas = 0, i; unsigned char ADC_rez, lcd_data [16]; float pagreitis=0, mom_greitis=0, vid_greitis=0, max_greitis=0, kelias=0; // Visi pradiniai parametrai lygus nuliui float greicio_buferis [5]; // naudojamas vidutiniam greiciui skaiciuoti. 5 momentinio greicio atskaitos pastoviai buferizuojamos perslenkant per viena i prieki su kiekviena nauja atskaita. unsigned char pointer; // Greicio buferio masyvo indeksas /* Paprogramiu sablonai */ int putchar(int); int printf(const char *,...); void konfiguracija (); void matuoti_pagreiti (); void skaiciuoti (); void rodyti_lcd (); void paleisti_lcd (); void lcd_com_write(unsigned char,unsigned char); void lcd_data_write(unsigned char); void clear_lcd(); void cursor (unsigned char); /* Pagrindine programa */ void main () { konfiguracija (); while (1) { matuoti_pagreiti (); skaiciuoti (); rodyti_lcd (); } } /* Paprogrames */ /* Pradinis sistemos konfiguravimas */ void konfiguracija () { DDRB = 0xFF; // B portas isejimo kryptis PORTB = 0x00; // Isejime visi nuliai GICR = 0x40; // Leisti INT0 isorines pertrauktis MCUCR = 0x03; // Pertrauktis generuojama kylanciu INT0 frontu ADCSR = 0x80; // Ijungti ADC ADMUX = 0x20; // ADC keitiklio nustatymai: 5V atramine itampa, ADC0 iejimas, 8 bitu rezultatas paleisti_lcd (); } /* Mygtuko aptarnavimas */ #pragma vector=INT0_vect __interrupt void pertrauktis (void) { rezimas++; if (rezimas>3) rezimas=0; } /* LCD parodymai */ void rodyti_lcd () { switch (rezimas) { case 0: cursor(0x00); // Uzrasas pirmoje eiluteje printf("MOM V, m/s"); cursor(0x40); // Rezultatas antroje eiluteje sprintf (lcd_data,"%10.5f",mom_greitis); // Float tipas keiciamas i ASCII kodo simbolius. Vaizduojama 10 skaitmenu pries kableli ir 5 skaitmenys po keblelio for (i=16; i>0; i--) printf("%d",lcd_data[i]); break; case 1: cursor(0x00); // Uzrasas pirmoje eiluteje printf("MAX V, m/s"); cursor(0x40); // Rezultatas antroje eiluteje sprintf (lcd_data,"%10.5f",max_greitis); for (i=16; i>0; i--) printf("%d",lcd_data[i]); break; case 2: cursor(0x00); // Uzrasas pirmoje eiluteje printf("VID V, m/s"); cursor(0x40); // Rezultatas antroje eiluteje sprintf (lcd_data,"%10.5f",vid_greitis); for (i=16; i>0; i--) printf("%d",lcd_data[i]); break; case 3: cursor(0x00); // Uzrasas pirmoje eiluteje printf("KELIAS, m "); cursor(0x40); // Rezultatas antroje eiluteje sprintf (lcd_data,"%10.5f",kelias); for (i=16; i>0; i--) printf("%d",lcd_data[i]); break; default: rezimas = 0; break; } } /* Pagreicio matavimas */ void matuoti_pagreiti () { ADCSR = 0xC0; // Pradeti ADC keitima while (ADCSR&0x10); //Laukti kol vyksta ADC keitimas ADC_rez = ADCH; pagreitis = ADC_rez * 0.588; // Gaunamas pagreitis vienetais m/s^2 } /* Iverciu skaiciavimas */ void skaiciuoti () { mom_greitis = mom_greitis + (pagreitis*0.01); // Greitis = Pagreicio integralas. Daroma prielaida, kad pagreitis matuojamas 0.01s periodu. Atliekamas integravimas ir buvusio greicio ivertinimas kelias = kelias + (mom_greitis*0.01)+((pagreitis*0.01*0.01)/2); // Kelias = Mom. greicio integralas + pries tai buves kelias if (max_greitis

Daugiau informacijos...

★ Klientai rekomenduoja

Šį rašto darbą rekomenduoja mūsų klientai. Ką tai reiškia?

Mūsų svetainėje pateikiama dešimtys tūkstančių skirtingų rašto darbų, kuriuos įkėlė daugybė moksleivių ir studentų su skirtingais gabumais. Būtent šis rašto darbas yra patikrintas specialistų ir rekomenduojamas kitų klientų, kurie po atsisiuntimo įvertino šį mokslo darbą teigiamai. Todėl galite būti tikri, kad šis pasirinkimas geriausias!