cellular-infrastructure
/
osmocom-lcs
9
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

gps.c: Add error message in case of parser problems

This commit is contained in:
Dieter Spaar 2012-07-18 22:20:02 +02:00 committed by Harald Welte
parent d652a321d9
commit a5c8d80688
1 changed files with 6 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

7
gps.c
View File

@ -20,6 +20,8 @@
* along with this program. If not, see <http://www.gnu.org/licenses/>. * along with this program. If not, see <http://www.gnu.org/licenses/>.
*/ */
#include <stdio.h>
#include "gps.h" #include "gps.h"
@ -90,8 +92,10 @@ gps_unpack_sf123(uint32_t *sf, struct gps_ephemeris_sv *eph)
eph->aodo = GET_FIELD_U(sf2[7], 5, 2); eph->aodo = GET_FIELD_U(sf2[7], 5, 2);
/* Check & cross-validate iodc[7:0], iode1, iode2 */ /* Check & cross-validate iodc[7:0], iode1, iode2 */
if ((iode1 != iode2) || (iode1 != (eph->iodc & 0xff))) if ((iode1 != iode2) || (iode1 != (eph->iodc & 0xff))) {
fprintf(stderr, "gps_unpack_sf123 failed\n");
return -1; return -1;
}
return 0; return 0;
} }
@ -106,6 +110,7 @@ gps_unpack_sf123(uint32_t *sf, struct gps_ephemeris_sv *eph)
int int
gps_unpack_sf45_almanac(uint32_t *sf, struct gps_almanac_sv *alm) gps_unpack_sf45_almanac(uint32_t *sf, struct gps_almanac_sv *alm)
{ {
/* this is the page ID but not the satellite ID, its wrong in subframe 5 */
alm->sv_id = GET_FIELD_U(sf[0], 6, 16); alm->sv_id = GET_FIELD_U(sf[0], 6, 16);
alm->e = GET_FIELD_U(sf[0], 16, 0); alm->e = GET_FIELD_U(sf[0], 16, 0);