static void ledumpall(void)
{
(void)printf("getsb: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64 "\n",
(uint64_t) sb1, (uint64_t) sb2,
(uint64_t) getsb(buf, 0), (uint64_t) getsb(buf, 8));
(void)printf("getub: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64 "\n",
(uint64_t) ub1, (uint64_t) ub2,
(uint64_t) getub(buf, 0), (uint64_t) getub(buf, 8));
(void)printf("getles16: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64 "\n",
(uint64_t) sw1, (uint64_t) sw2,
(uint64_t) getles16(buf, 0), (uint64_t) getles16(buf, 8));
(void)printf("getleu16: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64 "\n",
(uint64_t) uw1, (uint64_t) uw2,
(uint64_t) getleu16(buf, 0), (uint64_t) getleu16(buf, 8));
(void)printf("getles32: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64 "\n",
(uint64_t) sl1, (uint64_t) sl2,
(uint64_t) getles32(buf, 0), (uint64_t) getles32(buf, 8));
(void)printf("getleu32: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64 "\n",
(uint64_t) ul1, (uint64_t) ul2,
(uint64_t) getleu32(buf, 0), (uint64_t) getleu32(buf, 8));
(void)printf("getles64: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64 "\n",
(uint64_t) sL1, (uint64_t) sL2,
(uint64_t) getles64(buf, 0), (uint64_t) getles64(buf, 8));
(void)printf("getleu64: %016" PRIx64 " %016" PRIx64 " %016" PRIx64 " %016" PRIx64 "\n",
(uint64_t) uL1, (uint64_t) uL2,
(uint64_t) getleu64(buf, 0), (uint64_t) getleu64(buf, 8));
(void)printf("getlef32: %f %f\n", f1, getlef32((const char *)buf, 24));
(void)printf("getled64: %.16f %.16f\n", d1, getled64((const char *)buf, 16));
}
static gps_mask_t decode_itk_pseudo(struct gps_device_t *session,
unsigned char *buf, size_t len)
{
unsigned short flags, n, i;
n = (unsigned short) getleu16(buf, 7 + 4);
if ((n < 1) || (n > MAXCHANNELS)){
gpsd_report(&session->context->errout, LOG_INF,
"ITALK: bad PSEUDO channel count\n");
return 0;
}
if (len != (size_t)((n+1)*36)) {
gpsd_report(&session->context->errout, LOG_PROG,
"ITALK: bad PSEUDO len %zu\n", len);
}
gpsd_report(&session->context->errout, LOG_PROG, "iTalk PSEUDO [%u]\n", n);
flags = (unsigned short)getleu16(buf, 7 + 6);
if ((flags & 0x3) != 0x3)
return 0; // bail if measurement time not valid.
session->newdata.time = gpsd_gpstime_resolve(session,
(unsigned short int)getleu16((char *)buf, 7 + 8),
(unsigned int)getleu32(buf, 7 + 38) / 1000.0);
/*@-type@*/
for (i = 0; i < n; i++){
session->gpsdata.skyview[i].PRN = getleu16(buf, 7 + 26 + (i*36)) & 0xff;
session->gpsdata.skyview[i].ss = getleu16(buf, 7 + 26 + (i*36 + 2)) & 0x3f;
session->gpsdata.raw.satstat[i] = getleu32(buf, 7 + 26 + (i*36 + 4));
session->gpsdata.raw.pseudorange[i] = getled64((char *)buf, 7 + 26 + (i*36 + 8));
session->gpsdata.raw.doppler[i] = getled64((char *)buf, 7 + 26 + (i*36 + 16));
session->gpsdata.raw.carrierphase[i] = getleu16(buf, 7 + 26 + (i*36 + 28));
session->gpsdata.raw.mtime[i] = session->newdata.time;
session->gpsdata.raw.codephase[i] = NAN;
session->gpsdata.raw.deltarange[i] = NAN;
}
/*@+type@*/
return RAW_IS;
}
/*@ -duplicatequals +ignorequals @*/
int main(int argc, char *argv[])
{
bool failures = false;
bool quiet = (argc > 1) && (strcmp(argv[1], "--quiet") == 0);
/*@ -observertrans -usereleased @*/
struct unsigned_test *up, unsigned_tests[] = {
/* tests using the big buffer */
{buf, 0, 1, 0, false, "first bit of first byte"},
{buf, 0, 8, 0x01, false, "first 8 bits"},
{buf, 32, 7, 0x02, false, "first seven bits of fifth byte (0x05)"},
{buf, 56, 12, 0x8f, false, "12 bits crossing 7th to 8th bytes (0x08ff)"},
{buf, 78, 4, 0xb, false, "4 bits crossing 8th to 9th byte (0xfefd)"},
{buf, 0, 1, 0, true, "first bit of first byte"},
{buf, 0, 8, 0x80, true, "first 8 bits"},
{buf, 32, 7, 0x20, true, "first seven bits of fifth byte (0x05)"},
{buf, 56, 12, 0xf10,true, "12 bits crossing 7th to 8th bytes (0x08ff)"},
{buf, 78, 4, 0xd, true, "4 bits crossing 8th to 9th byte (0xfefd)"},
/* sporadic tests based on found bugs */
{(unsigned char *)"\x19\x23\f6",
7, 2, 2, false, "2 bits crossing 1st to 2nd byte (0x1923)"},
};
unsigned char *sp;
memcpy(buf, "\x01\x02\x03\x04\x05\x06\x07\x08", 8);
memcpy(buf + 8, "\xff\xfe\xfd\xfc\xfb\xfa\xf9\xf8", 8);
memcpy(buf + 16, "\x40\x09\x21\xfb\x54\x44\x2d\x18", 8);
memcpy(buf + 24, "\x40\x49\x0f\xdb", 4);
/*@ +observertrans +usereleased @*/
/*@-type@*/
sb1 = getsb(buf, 0);
sb2 = getsb(buf, 8);
ub1 = getub(buf, 0);
ub2 = getub(buf, 8);
sw1 = getbes16(buf, 0);
sw2 = getbes16(buf, 8);
uw1 = getbeu16(buf, 0);
uw2 = getbeu16(buf, 8);
sl1 = getbes32(buf, 0);
sl2 = getbes32(buf, 8);
ul1 = getbeu32(buf, 0);
ul2 = getbeu32(buf, 8);
sL1 = getbes64(buf, 0);
sL2 = getbes64(buf, 8);
uL1 = getbeu64(buf, 0);
uL2 = getbeu64(buf, 8);
f1 = getbef32((const char *)buf, 24);
d1 = getbed64((const char *)buf, 16);
sb1 = getsb(buf, 0);
sb2 = getsb(buf, 8);
ub1 = getub(buf, 0);
ub2 = getub(buf, 8);
sw1 = getles16(buf, 0);
sw2 = getles16(buf, 8);
uw1 = getleu16(buf, 0);
uw2 = getleu16(buf, 8);
sl1 = getles32(buf, 0);
sl2 = getles32(buf, 8);
ul1 = getleu32(buf, 0);
ul2 = getleu32(buf, 8);
sL1 = getles64(buf, 0);
sL2 = getles64(buf, 8);
uL1 = getleu64(buf, 0);
uL2 = getleu64(buf, 8);
f1 = getlef32((const char *)buf, 24);
d1 = getled64((const char *)buf, 16);
/*@+type@*/
if (!quiet) {
(void)fputs("Test data:", stdout);
for (sp = buf; sp < buf + 28; sp++)
(void)printf(" %02x", *sp);
(void)putc('\n', stdout);
/* big-endian test */
printf("Big-endian:\n");
bedumpall();
/* little-endian test */
printf("Little-endian:\n");
ledumpall();
}
if (sb1 != 1) printf("getsb(buf, 0) FAILED\n");
if (sb2 != -1) printf("getsb(buf, 8) FAILED\n");
if (ub1 != 1) printf("getub(buf, 0) FAILED\n");
if (ub2 != 0xff) printf("getub(buf, 8) FAILED\n");
(void)printf("Testing bitfield extraction\n");
for (up = unsigned_tests;
up <
unsigned_tests + sizeof(unsigned_tests) / sizeof(unsigned_tests[0]);
up++) {
uint64_t res = ubits((unsigned char *)buf, up->start, up->width, up->le);
bool success = (res == up->expected);
if (!success)
failures = true;
if (!success || !quiet)
(void)printf("ubits(%s, %d, %d, %s) %s should be %" PRIx64 ", is %" PRIx64 ": %s\n",
hexdump(buf, strlen((char *)buf)),
up->start, up->width, up->le ? "true" : "false",
up->description, up->expected, res,
success ? "succeeded" : "FAILED");
}
exit(failures ? EXIT_FAILURE : EXIT_SUCCESS);
}
