Funkcja budująca ramkę GPS w standardzie NMEA na podstawie podania mu szerokości i długości geograficznej przeliczonych odpowiednio na standard NMEA:
[syntax=c]void budowanie_ramki(uint32_t szerokosc_czesc_calkowita,uint32_t dlugosc_czesc_calkowita,uint32_t szerokosc_czesc_ulamkowa,uint32_t dlugosc_czesc_ulamkowa)
{
char szerokosc_calkowita[10];// bufor na wynik funkcji itoa np. [5,2,2,4]
char dlugosc_calkowita[10];
char szerokosc_ulamkowa[10];
char dlugosc_ulamkowa[10];
itoa(szerokosc_czesc_calkowita,szerokosc_calkowita, 10);// konwertowanie value na string
itoa(dlugosc_czesc_calkowita,dlugosc_calkowita, 10);
itoa(szerokosc_czesc_ulamkowa,szerokosc_ulamkowa, 10);
itoa(dlugosc_czesc_ulamkowa,dlugosc_ulamkowa, 10);
char tablica[45] = "$GPRMC,,,";// początek ramki
uint8_t i=9;// wstawienie szerokosci (czesc całkowita)
char *c = szerokosc_calkowita;
char s;
while((s = *c++)) tablica[i++] = s;
tablica[i++] = '.';// '.' kropka oddzielająca częsci
uint8_t j=14;// wstawienie szerokosci (czesc ulamkowa)
char *w = szerokosc_ulamkowa;
char z;
while((z = *w++)) tablica[j++] = z;
uint8_t k=18;// wstawienie ",N,0"
char dane[10] = ",N,0";
char *y = dane;
char x;
while((x = *y++)) tablica[k++] = x;
uint8_t a=22;// wstawienie dlugosc (czesc całkowita)
char *b = dlugosc_calkowita;
char d;
while((d = *b++)) tablica[a++] = d;
tablica[a++] = '.';// '.' kropka oddzielająca częsci
uint8_t o=27;// wstawienie dlugosc (czesc ulamkowa)
char *p = dlugosc_ulamkowa;
char r;
while((r = *p++)) tablica[o++] = r;
uint8_t t=31;// wstawienie "E,,,,,,,,,*"
char dane_02[15] = ",E,,,,,,,,,*";
char *f = dane_02;
char u;
while((u = *f++)) tablica[t++] = u;
uart_puts_gpschecksum(tablica); // funkcja liczy checksumę i wyswietla całą gotową ramkę
}[/syntax]
Teraz wystarczy, że w głównym pliku main i petli głównej wywołamy:
[syntax=c]budowanie_ramki(szerokosc_czesc_calkowita,dlugosc_czesc_calkowita,szerokosc_czesc_ulamkowa,dlugosc_czesc_ulamkowa);
uart_putc('\r\n');[/syntax]
I na terminalu pokazują nam się pięknie chciane ramki GPS [NMEA] z obliczoną "w locie" checksumą.
[syntax=c]np. $GPRMC,,,5224.1370,N,01655.1050,E,,,,,,,,,*5B[/syntax]
Funkcja może nie jest najpiękniejsza. Może i da się ją jeszcze jakoś uprościć ale nie zajmuję aż tyle miejsca i co najważniejsze pracuje tak jak chciałem.
Dziękuję wszystkim za pomoc, w szczególności Mirkowi, który pomógł mi na starcie pominąć strasznie double'e i float'y.
Lecą dla każdego "pomógł"
Pzdr Jacek.
Statystyki: Napisane przez zlata_n — 13 gru 2012, o 19:53
]]>
ale zmienna Checksum powinna być typu unsigned char albo uint8_t.