NMEA 0183协议对RMC消息的定义如下:
我们从串口读取到的模组输出的LOG,有时候可能是好几行数据,所以我们要逐行解析$GPRMC报文。
bytes_read = read_serial(serial_fd, recv_buffer, sizeof(recv_buffer) - 1); if (bytes_read > 0) { recv_buffer[bytes_read] = '\0'; printf("\n\n通过串口从RTK模组读取到原始定位数据:\n%s", recv_buffer); // 解析GPRMC数据并处理JT808协议转换 line = strtok_r(recv_buffer, "\r\n", &saveptr); while (line != NULL) { memset(&gps_data, 0, sizeof(gps_data)); if (parse_gprmc(line, &gps_data) == 0) { printf("\n解析到有效GPS数据:\n纬度=%f, 经度=%f, " "速度=%f, 航向=%f, 日期=%s, 时间=%s\n", gps_data.latitude, gps_data.longitude, gps_data.speed, gps_data.direction, gps_data.date, gps_data.time); ......此处省略代码若干 line = strtok_r(NULL, "\r\n", &saveptr); } }此处用了strtok_r去分隔字符串而不是用strtok,可以避免原字符串被改变。用while循环去分隔每一行数据,然后对每一行数据进行解析。
解析函数需要实现如下功能:
输入验证
首先检查报文是否以$GPRMC开头,确保是GPRMC报文。
使用strncpy复制输入字符串到缓冲区,并确保以\0结尾。
字段解析
使用strtok_r按逗号分隔报文字段,saveptr保存分隔状态。
可以通过switch语句逐字段解析:
时间(HHMMSS):直接复制到gps->time。
状态(A/V):存储到gps->status。
纬度/经度:
为了与JT808协议要求的经纬度格式一致,所以需要将读取到的将度分秒格式(如3104.39321639)的经纬度转换为小数度(如31.073220271666668)。
可以通过atof转换为浮点数,计算分和秒部分。
速度/方向:直接转换为浮点数存储。
日期(DDMMYY):复制到gps->date。
错误处理
若字段数超过12或非GPRMC报文,返回-1表示解析失败。
具体代码实现如下:
int parse_gprmc(const char *nmea, GPSData *gps) { char buffer[256]; char *token; char *saveptr; // 用于strtok_r的保存指针 int field_count = 0; double lat_sec, lon_sec; int lat_min, lon_min; strncpy(buffer, nmea, sizeof(buffer) - 1); buffer[sizeof(buffer) - 1] = '0'; // 检查是否为GPRMC报文 if (strncmp(buffer, "$GPRMC", 6) != 0) { return -1; } token = strtok_r(buffer, ",", &saveptr); while (token != NULL && field_count < 12) { switch (field_count) { case 1: // 时间 HHMMSS strncpy(gps->time, token, sizeof(gps->time) - 1); break; case 2: // 状态 A/V gps->status = token[0]; break; case 3: // 纬度 if (strlen(token) > 0) { lat_min = (int)(atof(token) / 100); lat_sec = (atof(token) - lat_min * 100); gps->latitude = lat_min + lat_sec / 60.0; } break; case 4: // 纬度半球 N/S // 可根据需要处理 break; case 5: // 经度 if (strlen(token) > 0) { lon_min = (int)(atof(token) / 100); lon_sec = (atof(token) - lon_min * 100); gps->longitude = lon_min + lon_sec / 60.0; } break; case 6: // 经度半球 E/W // 可根据需要处理 break; case 7: // 速度 if (strlen(token) > 0) { gps->speed = atof(token); } break; case 8: // 方向 if (strlen(token) > 0) { gps->direction = atof(token); } break; case 9: // 日期 DDMMYY strncpy(gps->date, token, sizeof(gps->date) - 1); break; } field_count++; token = strtok_r(NULL, ",", &saveptr); } return (gps->status == 'A') ? 0 : -1; }