/************************************************************************
* 函数名: ParseGSA
* 描 述: 解析GSA
* 入 参:
* 出 参:
* 返 回:
* 备 注:
$GPGSA, <1>,<2>,<3>,<3>,,,,,<3>,<3>,<3>,<4>,<5>,<6>,<7><CR><LF>
<1>模式 ：M = 手动， A = 自动。
<2>定位型式 1 = 未定位， 2 = 二维定位， 3 = 三维定位。
<3>PRN 数字：01 至 32 表天空使用中的卫星编号，最多可接收12颗卫星信息。
<4> PDOP位置精度因子（0.5~99.9）
<5> HDOP水平精度因子（0.5~99.9）
<6> VDOP垂直精度因子（0.5~99.9）
<7> Checksum.(检查位).
************************************************************************/
void CPosData::ParseGSA(PCSTR pcGSA)
{
//Test
//GPGSA = "$GPGSA,A,3,14,15,05,22,18,26,,,,,,,2.1,1.2,1.7*3D";
WORD wFieldLen = 0; //数据段(两个','之间的字符串)的长度
int nValue = 0; //整型数据段的值
double fValue = 0; //浮点型数据段的值
PCSTR pcField = NULL;
//移至第一个卫星编号
pcField = ScanField(pcGSA, 3, wFieldLen);
//天空使用中的卫星编号
memset(g_pPosInfo->gsa_data.wUsedID, NULL, sizeof(g_pPosInfo->gsa_data.wUsedID));
for ( int i = 0; i < 12; i++ )
{
if(NULL == pcField || 0 == wFieldLen)
{
g_pPosInfo->gsa_data.wSatNum = i; //卫星个数
break;
}
g_pPosInfo->gsa_data.wUsedID[i] = atoi( pcField );
pcField = ScanField(pcField, 1, wFieldLen);
}
//PDOP位置精度因子(0.5~99.9)
//MAX_SATE_NUM-g_pPosInfo->gsa_data.wSatNum,跳过剩余空白的卫星编号数
pcField = ScanField(pcField, 12-g_pPosInfo->gsa_data.wSatNum, wFieldLen);
if(NULL == pcField)
return;
fValue = atof( pcField );
g_pPosInfo->gsa_data.dbPdop = fValue;
//HDOP水平精度因子(0.5~99.9)
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
fValue = atof( pcField );
g_pPosInfo->gsa_data.dbHdop = fValue;
//VDOP垂直精度因子(0.5~99.9)
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
fValue = atof( pcField );
g_pPosInfo->gsa_data.dbVdop = fValue;
}
SdbgMeta &SdbgMeta::Deserialize(std::ifstream &is) {
size_t num_buckets;
ScanField(is, "k", k_);
ScanField(is, "words_per_tip_label", words_per_tip_label_);
ScanField(is, "num_buckets", num_buckets);
ScanField(is, "num_files", num_files_);
std::vector<SdbgBucketRecord> bucket_rec(num_buckets);
for (size_t i = 0; i < num_buckets; ++i) {
is >> bucket_rec[i].bucket_id
>> bucket_rec[i].file_id
>> bucket_rec[i].starting_offset
>> bucket_rec[i].num_items
>> bucket_rec[i].num_tips
>> bucket_rec[i].num_large_mul;
}
return FromBucketRecord(bucket_rec, k_, words_per_tip_label_);
}
/************************************************************************
* 函数名: ParseGGA
* 描 述: 解析GGA
* 入 参:
* 出 参:
* 返 回:
* 备 注:
$GPGGA,<1>,<2>,<3>,<4>,<5>,<6>,<7>,<8>,<9>,M,<10>,M,<11>,<12>*hh<CR><LF>
<1> UTC时间，hhmmss（时分秒）格式
<2> 纬度ddmm.mmmm（度分）格式（前面的0也将被传输）
<3> 纬度半球N（北半球）或S（南半球）
<4> 经度dddmm.mmmm（度分）格式（前面的0也将被传输）
<5> 经度半球E（东经）或W（西经）
<6> GPS状态：0=未定位，1=非差分定位，2=差分定位，6=正在估算
<7> 正在使用解算位置的卫星数量（00~12）（前面的0也将被传输）
<8> HDOP水平精度因子（0.5~99.9）
<9> 海拔高度（-9999.9~99999.9）
<10> 地球椭球面相对大地水准面的高度
<11> 差分时间（从最近一次接收到差分信号开始的秒数，如果不是差分定位将为空）
<12> 差分站ID号0000~1023（前面的0也将被传输，如果不是差分定位将为空）
************************************************************************/
void CPosData::ParseGGA(PCSTR pcGGA)
{
//Test
//pcGPGGA = "$GPGGA,101904.000,3110.4104,N,12123.8126,E,1,04,2.7,91.0,M,8.0,M,,0000*5C";
WORD wFieldLen = 0; //数据段(两个','之间的字符串)的长度
int nValue = 0; //整型数据段的值
double fValue = 0; //浮点型数据段的值
if (NULL == pcGGA)
{
return;
}
//<9> 海拔高度（-9999.9~99999.9）
PCSTR pcField = ScanField(pcGGA, 9, wFieldLen);
if(NULL == pcField)
return;
fValue = atof( pcField );
g_pPosInfo->rmc_data.dbAltitude = fValue;
}
/************************************************************************
* 函数名: ParseGSV
* 描 述: 解析GSV
* 入 参:
* 出 参:
* 返 回:
* 备 注:
$GPGSV, <1>,<2>,<3>,<4>,<5>,<6>,<7>,?<4>,<5>,<6>,<7>,<8><CR><LF>
<1> GSV语句的总数
<2> 本句GSV的编号
<3> 可见卫星的总数，00 至 12。
<4> 卫星编号， 01 至 32。
<5>卫星仰角， 00 至 90 度。
<6>卫星方位角， 000 至 359 度。实际值。
<7>讯号噪声比（C/No）， 00 至 99 dB；无表未接收到讯号。
<8>Checksum.(检查位).
************************************************************************/
void CPosData::ParseGSV(PCSTR pcGSV, PCSTR pcSectionGSV)
{
//Test
//GPGSV = "$GPGSV,3,1,10,18,84,067,23,09,67,067,27,22,49,312,28,15,47,231,30*70
// $GPGSV,3,2,10,21,32,199,23,14,25,272,24,05,21,140,32,26,14,070,20*7E
// $GPGSV,3,3,10,29,07,074,,30,07,163,28*7D";
WORD wFieldLen = 0; //数据段(两个','之间的字符串)的长度
int nValue = 0; //整型数据段的值
WORD wGSVNum = 0; //GSV语句总数
WORD wGSVIndex = 0; //当前GSV语句序号
//WORD wSateNum = 0; //视野内卫星数
const WORD GSV_SATE_NUM = 4; //一条GSV语句中最大卫星数
//memset(g_pPosInfo->gsv_data, NULL, sizeof(g_pPosInfo->gsv_data));
BOOL bFirstGSV = TRUE;
PCSTR pcField = pcGSV;
do
{
//GSV语句总数
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
if(bFirstGSV)
wGSVNum = atoi( pcField );
//当前GSV语句序号
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
wGSVIndex = atoi( pcField );
//视野内卫星数
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
if(bFirstGSV)
g_pPosInfo->rmc_data.pos_state.dwSateNum = atoi( pcField );
for(int i=0; i<GSV_SATE_NUM; i++)
{
int j = (wGSVIndex-1)*GSV_SATE_NUM+i;
if (j >= 12)
{
break;
}
//最后一颗卫星信息
if(j == g_pPosInfo->rmc_data.pos_state.dwSateNum)
break;
//卫星编号
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
g_pPosInfo->gsv_data[j].wSatID = atoi( pcField );
//卫星仰角:度
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
g_pPosInfo->gsv_data[j].wElevation = atoi( pcField );
//卫星方位角:度
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
g_pPosInfo->gsv_data[j].wAzimuth = atoi( pcField );
//信噪比
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
g_pPosInfo->gsv_data[j].wSNR = atoi( pcField );
g_pPosInfo->gsv_data[j].bAvailible = TRUE;
}
//最后一条GSV语句
if(wGSVIndex == wGSVNum)
break;
//移至下一条GSV语句
pcField = strstr(pcField, pcSectionGSV);
if(NULL == pcField)
break;
bFirstGSV = FALSE;
} while ( TRUE );
for(int i = g_pPosInfo->rmc_data.pos_state.dwSateNum; i < MAX_SATE_NUM; i++)
g_pPosInfo->gsv_data[i].bAvailible = FALSE;
return;
}
/************************************************************************
* 函数名: ParseRMC
* 描 述: 解析RMC
* 入 参:
* 出 参:
* 返 回:
* 备 注:
$GPRMC,<1>,<2>,<3>,<4>,<5>,<6>,<7>,<8>,<9>,<10>,<11>,<12>*hh<CR><LF>
<1> UTC时间，hhmmss(时分秒)格式
<2> 定位状态，A=有效定位，V=无效定位
<3> 纬度ddmm.mmmm(度分)格式(前面的0也将被传输)
<4> 纬度半球N(北半球)或S(南半球)
<5> 经度dddmm.mmmm(度分)格式(前面的0也将被传输)
<6> 经度半球E(东经)或W(西经)
<7> 地面速率(000.0~999.9节，前面的0也将被传输)
<8> 地面航向(000.0~359.9度，以真北为参考基准，前面的0也将被传输)
<9> UTC日期，ddmmyy(日月年)格式
<10> 磁偏角(000.0~180.0度，前面的0也将被传输)
<11> 磁偏角方向，E(东)或W(西)
<12> 模式指示(仅NMEA0183 3.00版本输出，A=自主定位，D=差分，E=估算，N=数据无效)
************************************************************************/
void CPosData::ParseRMC(PCSTR pcRMC)
{
//test
//pcGPRMC = "$GPRMC,101904.000,A,3110.4104,N,12123.8126,E,0.00,,220707,,,A*71";
WORD wFieldLen = 0; //数据段(两个','之间的字符串)的长度
int nValue = 0; //整型数据段的值
double fValue = 0; //浮点型数据段的值
//<1> UTC时间，hhmmss(时分秒)格式
PCSTR pcField = ScanField(pcRMC, 1, wFieldLen);
if(NULL == pcField)
return;
nValue = atoi( pcField );
g_pPosInfo->rmc_data.UtcTime.wHour = nValue / 10000;
g_pPosInfo->rmc_data.UtcTime.wMinute = nValue / 100 % 100;
g_pPosInfo->rmc_data.UtcTime.wSecond = nValue % 100;
//<2> 定位状态，A=有效定位，V=无效定位
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
if('A' == pcField[0])
{
g_pPosInfo->rmc_data.pos_state.cFix = 1; //定位状态
}
else if('V' == pcField[0])
{
g_pPosInfo->rmc_data.pos_state.cFix = 0; //定位状态
}
else
{
return;
}
//<3> 纬度ddmm.mmmm(度分)格式(前面的0也将被传输)
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
fValue = atof( pcField );
nValue = (int)fValue / 100; //计算度
g_pPosInfo->rmc_data.dbLatitude = (double)(nValue + (fValue - nValue*100)/60);//纬度 去掉10的6次方，取原值
//<4> 纬度半球N(北半球)或S(南半球)
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
if('N' == pcField[0])
g_pPosInfo->rmc_data.pos_state.cLatitudeType = 0;
else if('S' == pcField[0])
g_pPosInfo->rmc_data.pos_state.cLatitudeType = 1;
else
g_pPosInfo->rmc_data.pos_state.cLatitudeType = 0;
//<5> 经度dddmm.mmmm(度分)格式(前面的0也将被传输)
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
fValue = atof( pcField );
nValue = (int)fValue / 100; //计算度
g_pPosInfo->rmc_data.dbLongitude = (double)(nValue + (fValue - nValue*100)/60);//经度 去掉10的6次方，取原值
//<6> 经度半球E(东经)或W(西经)
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
if('E' == pcField[0])
g_pPosInfo->rmc_data.pos_state.cLongitudeType = 0;
else if('W' == pcField[0])
g_pPosInfo->rmc_data.pos_state.cLongitudeType = 1;
else
g_pPosInfo->rmc_data.pos_state.cLongitudeType = 0;
//<7> 地面速率(000.0~999.9节，前面的0也将被传输) 1节(海里) = 1.852km/h
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
fValue = atof( pcField );
g_pPosInfo->rmc_data.dbSpeed = fValue*1.852+0.5; //地面速率1.851985
//<8> 地面航向(000.0~359.9度，以真北为参考基准，前面的0也将被传输)
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
//fValue = atof( pcField ) + 0.5; //四舍五入
fValue = atof( pcField );
g_pPosInfo->rmc_data.dbAzimuth = fValue; //方位角
//<9> UTC日期，ddmmyy(日月年)格式
pcField = ScanField(pcField, 1, wFieldLen);
if(NULL == pcField)
return;
nValue = atoi( pcField );
g_pPosInfo->rmc_data.UtcTime.wYear = (nValue % 100) + 2000;
g_pPosInfo->rmc_data.UtcTime.wMonth = nValue / 100 % 100;
g_pPosInfo->rmc_data.UtcTime.wDay = nValue / 10000;
}