ATNEL tech-forum

Re: Parsowanie NMEA

2017-12-10T23:09:52+01:00

wojtekr51 napisał(a):

A tu implementacja funkcji która zastępuje strtok().

Tyle, że no ona nie do końca zastępuje strtok - w ogóle nie ma wyboru rodzaju separatora. Separatorem jest na sztywno pojedynczy znak przecinka. Polecam się zainteresować funkcją, którą pokazałem wyżej bo ta rzeczywiście zastępuje strtok - 1:1

Statystyki: Napisane przez mirekk36 — 10 gru 2017, o 23:09

Re: Parsowanie NMEA

2017-12-10T23:07:13+01:00

Wrzucam fragment biblioteki gdzie parsuję sentencję GPGGA.

[syntax=c]/*------------------------------------------------------------------------------------------------------
Parse GGA sentence
1 2 3 4 5 6 7 8 9 10 11 12 13 14
| | | | | | | | | | | | | |
$GPGGA,hhmmss.ss,llll.ll,a,yyyyy.yy,a,x,xx,x.x,x.x,M,x.x,M,x.x,xxxx*hh

1) Time (UTC)
2) Latitude
3) N or S (North or South)
4) Longitude
5) E or W (East or West)
6) GPS Quality Indicator,
0 - fix not available,
1 - GPS fix,
2 - Differential GPS fix
6 - Estimated/Dead Reckoning
7) Number of satellites in view, 00 - 12
8) Horizontal Dilution of precision
9) Antenna Altitude above/below mean-sea-level (geoid)
10) Units of antenna altitude, meters
11) Geoidal separation, the difference between the WGS-84 earth ellipsoid and
mean-sea-level (geoid), "-" means mean-sea-level below ellipsoid
12) Units of geoidal separation, meters
13) Age of differential GPS data, time in seconds since last SC104
type 1 or 9 update, null field when DGPS is not used
14) Differential reference station ID, 0000-1023
------------------------------------------------------------------------------------------------------*/
void ParseGPGGA(char *data_str, T_GPS_DATA *data)
{
char *field, *ptr;

/* 1 UTC */
/*
* h h m m s s . s s
* field idx:0 1 2 3 4 5 6 7 8
*/
field = GetSentenceDataField(data_str);
if( field && *field ) {
data->UTC_hund_sec = atoi(field + 7);
field[6] = '\0';
data->UTC_sec = atoi(field + 4);
field[4] = '\0';
data->UTC_min = atoi(field + 2);
field[2] = '\0';
data->UTC_hour = atoi(field);
}
else {
data->UTC_hour = GPS_UTC_INVALID;
data->UTC_min = GPS_UTC_INVALID;
data->UTC_sec = GPS_UTC_INVALID;
data->UTC_hund_sec = GPS_UTC_INVALID;
}

/* 2 Latitude */
/*
* d d m m . m m m m m
* field idx:0 1 2 3 4 5 6 7 8 9
*/
field = GetSentenceDataField(NULL);
if( field && *field ) {
ptr = strchr(field, '.');
if(ptr - 2 > field){
data->Latitude = atof(ptr - 2) / 60.0;
*(ptr - 2) = '\0';
data->Latitude += atof(field);
}
else data->Latitude = GPS_LATITUDE_INVALID;
}
else data->Latitude = GPS_LATITUDE_INVALID;

/* 3 Latitude indicator N/S */
field = GetSentenceDataField(NULL);
if( field && (*field == 'S' || *field == 'N') ) {
if(*field == 'S' && data->Latitude != GPS_LATITUDE_INVALID)
data->Latitude = -data->Latitude;
}
else data->Latitude = GPS_LATITUDE_INVALID;

/* 4 Longitude */
/*
* d d d m m . m m m m m
* field idx:0 1 2 3 4 5 6 7 8 9 10
*/
field = GetSentenceDataField(NULL);
if( field && *field ) {
ptr = strchr(field, '.');
if(ptr - 2 > field){
data->Longitude = atof(ptr - 2) / 60.0;
*(ptr - 2) = '\0';
data->Longitude += atof(field);
}
else data->Longitude = GPS_LONGITUDE_INVALID;
}
else data->Longitude = GPS_LONGITUDE_INVALID;

/* 5 Longitude indicator E/W */
field = GetSentenceDataField(NULL);
if( field && (*field == 'E' || *field == 'W') ) {
if(*field == 'W' && data->Longitude != GPS_LONGITUDE_INVALID)
data->Longitude = -data->Longitude;
}
else data->Longitude = GPS_LONGITUDE_INVALID;

/* 6 Signal Status (NMEA version 2.3) */
field = GetSentenceDataField(NULL);
if( field && (*field == '1' || *field == '2') ) data->SignalStatus = FIX_POSITION;
else if(data->UTC_hour != GPS_UTC_INVALID) data->SignalStatus = FIX_TIME_ONLY;
else data->SignalStatus = INVALID;

/* 7 Satelites use */
field = GetSentenceDataField(NULL);
if( field && *field ) data->SatelitesUse = atoi(field);
else data->SatelitesUse = 0;

/* 8 HDOP */
field = GetSentenceDataField(NULL);
if( field && *field ) data->HDOP = atof(field);
else data->HDOP = GPS_HDOP_INVALID;

/* 9 Altitude */
field = GetSentenceDataField(NULL);
if( field && *field ) data->Altitude = atof(field);
else data->Altitude = GPS_ALTITUDE_INVALID;

}[/syntax]

A tu implementacja funkcji która zastępuje strtok().
[syntax=c]/*-------------------------------------------------------------------------------------------------------------------
* Funkcja do podziału string na pola odzielone separatorami (podobnie działa funkcja strtok).
* Pierwsze wywołanie funkcji z podaniem stringa, kolejne wywołania z argumentem NULL.
* Z każdym wywołaniem zwraca adres stringa kolejnego pola danych, gdy pola się skończą zwraca NULL.
* String podany jako argument zostanie zmodyfikowany, w miejsce separatorów ',' wstawia znak końca stringa '\0'.
*-----------------------------------------------------------------------------------------------------------------*/
char *GetSentenceDataField(char *SentenceDataStr)
{
static char *NextField;
char *Field, *ptr;

if(SentenceDataStr) Field = SentenceDataStr;
else Field = NextField;

if(Field){
ptr = strchr(Field, ',');
if(ptr) *ptr = '\0', NextField = ptr + 1;
else NextField = NULL;
}
return Field;
}[/syntax]

Funkcja mirka jest bardziej uniwersalna. Moją funkcję pisałem specjalnie na potrzeby parsowania NMEA.

Statystyki: Napisane przez wojtekr51 — 10 gru 2017, o 23:07

Re: Parsowanie NMEA

2017-12-10T21:06:26+01:00

Funkcja by była dobra ale potrzebowałbym widziec ja jej uzyć bo chyba nic nie wymyśle.

Statystyki: Napisane przez kuba — 10 gru 2017, o 21:06

Re: Parsowanie NMEA

2017-12-10T00:14:07+01:00

W Yellowbooku

http://atnel.pl/wkuwamy-c-majsterkuj.html

pokazywałem taką funkcję i inne różnie ciekawostki

[syntax=c]// własna implementacja funckcji strtok, która różni się od oryginalnej tym
// że możliwe jest wystąpienie dwóch separatorów w analizowanym stringu jeden po drugim.
// Przykład stringa z pustym tokenem, którego nie obsłuży strtok() z separatorami w postaci przecinka
// "token1,token2,,token4"
// niestety strtok() źle zadzaiła w takim przypadku
// natomiast nasza własna implementacja będzie działać poprawnie i wskaźnik na trzeci token
// będzie wskazywał na pusty łańcuch czyli na wartość = 0 (koniec stringa NULL) i dalej można parsować
char * strtok_mk(char * str, char const * delims) {
static char * src = NULL;
char * p, * ret = 0;

if (str != NULL)
src = str;
if (src == NULL)
return NULL;
if ((p = strpbrk (src, delims)) != NULL) {
*p = 0;
ret = src;
src = ++p;
} else if (*src) {
ret = src;
src = NULL;
}
return ret;
}[/syntax]

Statystyki: Napisane przez mirekk36 — 10 gru 2017, o 00:14

Re: Parsowanie NMEA

2017-12-09T23:59:22+01:00

Problemem jest to że funkcja strtok_r() której używasz, w przypadku gdy pola danych pomiędzy separatorami "," są puste, nie działa w taki sposób jak założyłeś. Gdy w zdaniu występują przecinki obok siebie to owa funkcja potraktuje te wszystkie przecinki tak jakby był tylko jeden przecinek. Też kiedyś miałem taki sam problem z tą funkcją. Rozwiązałem to poprzez napisanie własnej funkcji która działa podobnie do strtok() i wykrywa wszystkie pola nawet gdy ich nie ma . Możesz pokombinować z napisaniem własnej funkcyjki, a jak chcesz to wrzucę tu moje rozwiązanie.

Statystyki: Napisane przez wojtekr51 — 9 gru 2017, o 23:59

Re: Parsowanie NMEA

2017-12-09T23:00:39+01:00

Zrobiłem coś takiego i działa ale jak nie nadlecą wszystkie dane to mi się wyświetla suma kontrolna.Co z tym można zrobić ?
[syntax=c]void parse_UART(char * pBuf) {

char * buf;
char * reszta;

buf = strtok_r(pBuf,",",&reszta);

if (buf && (strcmp(buf,"$GPGGA")==0)){

buf = strtok_r(NULL,",",&reszta);
uart_puts("time: ");
uart_puts(buf);
uart_puts("\r\n");

buf = strtok_r(NULL,",",&reszta);
uart_puts("width: ");
uart_puts(buf);
buf = strtok_r(NULL,",",&reszta);
uart_puts(" ");
uart_puts(buf);
uart_puts("\r\n");

buf = strtok_r(NULL,",",&reszta);
uart_puts("length: ");
uart_puts(buf);
buf = strtok_r(NULL,",",&reszta);
uart_puts(" ");
uart_puts(buf);
uart_puts("\r\n");

}

}[/syntax]

Statystyki: Napisane przez kuba — 9 gru 2017, o 23:00

Re: Parsowanie NMEA

2017-12-07T21:08:22+01:00

Coś takiego próbuje ale zadziała to i na inne zdanie

[syntax=c]void parse_UART(char * buf) {

lcd_locate(0,0);
lcd_str(buf);

if ( strpbrk(buf, "$GPGGA")){
PORTA ^= (1< lcd_locate(1,0);
lcd_str(buf);
}

}[/syntax]

Statystyki: Napisane przez kuba — 7 gru 2017, o 21:08

Re: Parsowanie NMEA

2017-12-07T01:03:42+01:00

O parsowaniu danych z GPS tutaj było:
http://forum.atnel.pl/topic11972.html

Statystyki: Napisane przez Ognisty — 7 gru 2017, o 01:03

Parsowanie NMEA

2017-12-07T00:23:02+01:00

Witam
Jakim sposobem parsować tyle dużo danych z GPS.
$GPGGA,,,,,,0,00,99.99,,,,,,*48
$GPGSA,A,1,,,,,,,,,,,,,99.99,99.99,99.99*30
$GPGSV,4,1,13,01,,,24,05,,,21,08,,,22,10,,,25*71
$GPGSV,4,2,13,14,,,23,15,,,22,16,,,20,21,,,21*78
$GPGSV,4,3,13,23,,,24,26,,,23,27,,,23,28,,,26*74
$GPGSV,4,4,13,29,,,22*70
$GPGLL,,,,,,V,N*64
$GPRMC,,V,,,,,,,,,,N*53
$GPVTG,,,,,,,,,N*30

Mie interesuje $GPGGA jak to zdanie rozpoznać z pomiendzy ostatnich i ułożyć do bufora?

Statystyki: Napisane przez kuba — 7 gru 2017, o 00:23