update gencode
This commit is contained in:
@@ -930,8 +930,8 @@ static void DecodePvtCoo(AtomStruct *atm, uint8_t *buff )
|
||||
atm->geo[2] = 0;
|
||||
}
|
||||
|
||||
atm->latitude = atm->geo[0]*R2D*1.0e7f;
|
||||
atm->longitude = atm->geo[1]*R2D*1.0e7f;
|
||||
atm->latitude = atm->geo[0]*R2D;
|
||||
atm->longitude = atm->geo[1]*R2D;
|
||||
atm->high = atm->geo[2];
|
||||
}
|
||||
else if(pos_mode==1)
|
||||
@@ -953,8 +953,8 @@ static void DecodePvtCoo(AtomStruct *atm, uint8_t *buff )
|
||||
if(lla_high < -6871947.6735)
|
||||
lla_high = 0;
|
||||
|
||||
atm->latitude = lla_latti*1.0e7f;
|
||||
atm->longitude = lla_longi*1.0e7f;
|
||||
atm->latitude = lla_latti;
|
||||
atm->longitude = lla_longi;
|
||||
atm->high = lla_high;
|
||||
}
|
||||
else
|
||||
@@ -1936,6 +1936,8 @@ int ParserMB2_char(ParserMB2_t *parser_MB2, uint8_t c)
|
||||
memcpy(&parser_MB2->buff, parser_MB2->head_buff, 5);
|
||||
parser_MB2->msgType = getbitu(parser_MB2->head_buff, 24, 12);
|
||||
parser_MB2->frame_len = (getbitu(parser_MB2->head_buff, 14, 10) + 6);
|
||||
if (parser_MB2->frame_len > 200)
|
||||
parser_MB2->stage = 0;
|
||||
if ((parser_MB2->msgType < 1001) || (parser_MB2->msgType > 4095))/** ashtech message number 4095*/
|
||||
{
|
||||
parser_MB2->stage = 0;
|
||||
|
||||
Reference in New Issue
Block a user