119 lines
4.2 KiB
C
119 lines
4.2 KiB
C
/*
|
||
了解GPS相关知识
|
||
$GPRMC协议格式
|
||
例：$GPRMC, 024813.640, A, 3158.4608, N, 11848.3737, E, 10.05, 324.27, 150706, , , A * 50
|
||
字段0：$GPRMC，语句ID，表明该语句为Recommended Minimum Specific GPS / TRANSIT Data（RMC）推荐最小定位信息
|
||
字段1：UTC时间，hhmmss.sss格式(UTC时间是世界统一时间，中国的时间是UTC + 8，比如：上面的时间是02 : 48 : 13而中国的时间是10 : 48 : 13)
|
||
字段2：状态，A = 定位，V = 未定位
|
||
字段3：纬度ddmm.mmmm，度分格式（前导位数不足则补0）
|
||
字段4：纬度N（北纬）或S（南纬）
|
||
字段5：经度dddmm.mmmm，度分格式（前导位数不足则补0）
|
||
字段6：经度E（东经）或W（西经）
|
||
字段7：速度，节，Knots
|
||
字段8：方位角，度
|
||
字段9：UTC日期，DDMMYY格式
|
||
字段10：磁偏角，（000 - 180）度（前导位数不足则补0）
|
||
字段11：磁偏角方向，E = 东W = 西
|
||
字段16：校验值
|
||
|
||
【提示】利用strtok切割、sscanf或者strncpy、atoi、atof
|
||
*/
|
||
#include <stdio.h>
|
||
#include <string.h>
|
||
|
||
typedef struct
|
||
{
|
||
char time[10]; // UTC时间，格式为hhmmss.sss
|
||
char status; // 状态，A表示定位，V表示未定位
|
||
double latitude; // 纬度，格式为ddmm.mmmm
|
||
char latitude_dir; // 纬度半球，N表示北半球，S表示南半球
|
||
double longitude; // 经度，格式为dddmm.mmmm
|
||
char longitude_dir; // 经度半球，E表示东经，W表示西经
|
||
double speed; // 速度，以节为单位
|
||
double course; // 方位角，以度为单位
|
||
char date[7]; // UTC日期，格式为DDMMYY
|
||
double declination; // 磁偏角，以度为单位
|
||
char declination_dir; // 磁偏角方向，E表示东偏，W表示西偏
|
||
} gprmc_t;
|
||
|
||
int parse_gprmc(const char *str, gprmc_t *gprmc)
|
||
{
|
||
char *token;
|
||
int i = 0;
|
||
token = strtok((char *)str, ",");
|
||
while (token != NULL)
|
||
{
|
||
switch (i)
|
||
{
|
||
case 0:
|
||
if (strcmp(token, "$GPRMC") != 0)
|
||
{
|
||
return -1;
|
||
}
|
||
break;
|
||
case 1:
|
||
sscanf(token, "%2s", gprmc->time);
|
||
sscanf(token + 2, "%2lf%lf", &gprmc->time[2], &gprmc->time[4]);
|
||
sscanf(token + 4, "%lf", &gprmc->time[6]);
|
||
break;
|
||
case 2:
|
||
gprmc->status = *token;
|
||
break;
|
||
case 3:
|
||
sscanf(token, "%lf", &gprmc->latitude);
|
||
sscanf(token + 2, "%lf", &gprmc->latitude);
|
||
break;
|
||
case 4:
|
||
gprmc->latitude_dir = *token;
|
||
break;
|
||
case 5:
|
||
sscanf(token, "%lf", &gprmc->longitude);
|
||
sscanf(token + 3, "%lf", &gprmc->longitude);
|
||
break;
|
||
case 6:
|
||
gprmc->longitude_dir = *token;
|
||
break;
|
||
case 7:
|
||
sscanf(token, "%lf", &gprmc->speed);
|
||
break;
|
||
case 8:
|
||
sscanf(token, "%lf", &gprmc->course);
|
||
break;
|
||
case 9:
|
||
sscanf(token, "%2s", gprmc->date);
|
||
sscanf(token + 2, "%2lf%lf", &gprmc->date[2], &gprmc->date[4]);
|
||
sscanf(token + 4, "%lf", &gprmc->date[6]);
|
||
break;
|
||
case 10:
|
||
sscanf(token, "%lf", &gprmc->declination);
|
||
break;
|
||
case 11:
|
||
gprmc->declination_dir = *token;
|
||
break;
|
||
default:
|
||
break;
|
||
}
|
||
token = strtok(NULL, ",");
|
||
i++;
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
int main()
|
||
{
|
||
const char *str = "$GPRMC,024813.640,A,3158.4608,N,11848.3737,E,10.05,324.27,150706,,,A*50";
|
||
gprmc_t gprmc;
|
||
if (parse_gprmc(str, &gprmc) == 0)
|
||
{
|
||
printf("UTC时间：%s\n", gprmc.time);
|
||
printf("状态：%c\n", gprmc.status);
|
||
printf("纬度：%lf %c\n", gprmc.latitude, gprmc.latitude_dir);
|
||
printf("经度：%lf %c\n", gprmc.longitude, gprmc.longitude_dir);
|
||
printf("速度：%lf\n", gprmc.speed);
|
||
printf("方位角：%lf\n", gprmc.course);
|
||
printf("UTC日期：%s\n", gprmc.date);
|
||
printf("磁偏角：%lf %c\n", gprmc.declination, gprmc.declination_dir);
|
||
}
|
||
return 0;
|
||
}
|