/*Retira os espacos em excesso numa linha de compras*/
void trim(char* s)
{
int i;
for(i = 0;s[i] == ' ';) shiftleft(s,i);
for(i = 0;s[i] != '\0';)
if(s[i] == ' ' && s[i+1] == ' ') shiftleft(s,i);
else i++;
if(i > 0 && s[i-1] == ' ') s[i-1] = '\0';
}
void list_remove(list_t list, int index)
{
if(index < 0 || index >= list->size)
return; // ERROR
shiftleft(list, index);
list->size--;
}
static int cmac_setkey(drew_mac_t *ctxt, const uint8_t *data, size_t len)
{
struct cmac *ctx = ctxt->ctx;
uint8_t buf[BUFFER_SIZE] = {0};
uint8_t c;
uint8_t rb = (ctx->blksize == 16) ? 0x87 : 0x1b;
ctx->block.functbl->setkey(&ctx->block, data, len, 0);
ctx->block.functbl->encrypt(&ctx->block, ctx->k1, buf);
c = ctx->k1[0];
shiftleft(ctx->k1, ctx->blksize);
if (c & 0x80)
ctx->k1[ctx->blksize-1] ^= rb;
memcpy(ctx->k2, ctx->k1, ctx->blksize);
shiftleft(ctx->k2, ctx->blksize);
if (c & 0x40)
ctx->k2[ctx->blksize-1] ^= rb;
return 0;
}
void TileMap::shift(int dx, int dy)
{
while (dx < 0)
{
shiftleft();
dx++;
}
while (dx > 0)
{
shiftright();
dx--;
}
while (dy < 0)
{
shiftup();
dy++;
}
while (dy > 0)
{
shiftdown();
dy--;
}
}
int RF24Mesh::write()
{
IF_SERIAL_DEBUG(printf_P(PSTR("%lu: write to air \n\r"),rTable.getMillis()));
bool result = false;
if ( send_available() )
{
shiftleft(send_queue, frame_size, frame_buffer, send_frame_p);
// Move the pointer back one in the queue
send_frame_p -= frame_size;
RF24NetworkHeader h;
// Copy the next available frame from the queue into the provided buffer
memcpy(&h,frame_buffer,sizeof(RF24NetworkHeader));
result = write(rTable.getMac(h.to_node));
rTable.sentData(h);
IF_SERIAL_DEBUG(printf_P(PSTR("%lu: NET *RF24*Mesh::sent to Air to mac: %lx (%s)\n\r"),rTable.getMillis(), rTable.getMac(h.to_node), h.toString()));
}
return result;
}
/*@ +charint @*/
bool ais_binary_decode(const struct gpsd_errout_t *errout,
struct ais_t *ais,
const unsigned char *bits, size_t bitlen,
struct ais_type24_queue_t *type24_queue)
/* decode an AIS binary packet */
{
unsigned int u; int i;
#ifdef S_SPLINT_S
assert(type24_queue != NULL);
#endif /* S_SPLINT_S */
#define UBITS(s, l) ubits((unsigned char *)bits, s, l, false)
#define SBITS(s, l) sbits((signed char *)bits, s, l, false)
#define UCHARS(s, to) from_sixbit((unsigned char *)bits, s, sizeof(to)-1, to)
#define ENDCHARS(s, to) from_sixbit((unsigned char *)bits, s, (bitlen-(s))/6,to)
ais->type = UBITS(0, 6);
ais->repeat = UBITS(6, 2);
ais->mmsi = UBITS(8, 30);
gpsd_log(errout, LOG_INF,
"AIVDM message type %d, MMSI %09d:\n",
ais->type, ais->mmsi);
#define PERMISSIVE_LENGTH_CHECK(correct) \
if (bitlen < correct) { \
gpsd_log(errout, LOG_ERROR, \
"AIVDM message type %d size < %d bits (%zd).\n", \
ais->type, correct, bitlen); \
return false; \
} else if (bitlen > correct) { \
gpsd_log(errout, LOG_WARN, \
"AIVDM message type %d size > %d bits (%zd).\n", \
ais->type, correct, bitlen); \
}
#define RANGE_CHECK(min, max) \
if (bitlen < min || bitlen > max) { \
gpsd_log(errout, LOG_ERROR, \
"AIVDM message type %d size is out of range (%zd).\n", \
ais->type, bitlen); \
return false; \
}
/*
* Something about the shape of this switch statement confuses
* GNU indent so badly that there is no point in trying to be
* finer-grained than leaving it all alone.
*/
/* *INDENT-OFF* */
switch (ais->type) {
case 1: /* Position Report */
case 2:
case 3:
PERMISSIVE_LENGTH_CHECK(168)
ais->type1.status = UBITS(38, 4);
ais->type1.turn = SBITS(42, 8);
ais->type1.speed = UBITS(50, 10);
ais->type1.accuracy = UBITS(60, 1)!=0;
ais->type1.lon = SBITS(61, 28);
ais->type1.lat = SBITS(89, 27);
ais->type1.course = UBITS(116, 12);
ais->type1.heading = UBITS(128, 9);
ais->type1.second = UBITS(137, 6);
ais->type1.maneuver = UBITS(143, 2);
//ais->type1.spare = UBITS(145, 3);
ais->type1.raim = UBITS(148, 1)!=0;
ais->type1.radio = UBITS(149, 19);
break;
case 4: /* Base Station Report */
case 11: /* UTC/Date Response */
PERMISSIVE_LENGTH_CHECK(168)
ais->type4.year = UBITS(38, 14);
ais->type4.month = UBITS(52, 4);
ais->type4.day = UBITS(56, 5);
ais->type4.hour = UBITS(61, 5);
ais->type4.minute = UBITS(66, 6);
ais->type4.second = UBITS(72, 6);
ais->type4.accuracy = UBITS(78, 1)!=0;
ais->type4.lon = SBITS(79, 28);
ais->type4.lat = SBITS(107, 27);
ais->type4.epfd = UBITS(134, 4);
//ais->type4.spare = UBITS(138, 10);
ais->type4.raim = UBITS(148, 1)!=0;
ais->type4.radio = UBITS(149, 19);
break;
case 5: /* Ship static and voyage related data */
if (bitlen != 424) {
gpsd_log(errout, LOG_WARN,
"AIVDM message type 5 size not 424 bits (%zd).\n",
bitlen);
/*
* For unknown reasons, a lot of transmitters in the wild ship
* with a length of 420 or 422. This is a recoverable error.
*/
if (bitlen < 420)
return false;
}
ais->type5.ais_version = UBITS(38, 2);
ais->type5.imo = UBITS(40, 30);
UCHARS(70, ais->type5.callsign);
UCHARS(112, ais->type5.shipname);
ais->type5.shiptype = UBITS(232, 8);
ais->type5.to_bow = UBITS(240, 9);
ais->type5.to_stern = UBITS(249, 9);
ais->type5.to_port = UBITS(258, 6);
ais->type5.to_starboard = UBITS(264, 6);
ais->type5.epfd = UBITS(270, 4);
ais->type5.month = UBITS(274, 4);
ais->type5.day = UBITS(278, 5);
ais->type5.hour = UBITS(283, 5);
ais->type5.minute = UBITS(288, 6);
ais->type5.draught = UBITS(294, 8);
UCHARS(302, ais->type5.destination);
if (bitlen >= 423)
ais->type5.dte = UBITS(422, 1);
//ais->type5.spare = UBITS(423, 1);
break;
case 6: /* Addressed Binary Message */
RANGE_CHECK(88, 1008);
ais->type6.seqno = UBITS(38, 2);
ais->type6.dest_mmsi = UBITS(40, 30);
ais->type6.retransmit = UBITS(70, 1)!=0;
//ais->type6.spare = UBITS(71, 1);
ais->type6.dac = UBITS(72, 10);
ais->type6.fid = UBITS(82, 6);
ais->type6.bitcount = bitlen - 88;
/* not strictly required - helps stability in testing */
(void)memset(ais->type6.bitdata, '\0', sizeof(ais->type6.bitdata));
ais->type6.structured = false;
/* Inland AIS */
if (ais->type6.dac == 200) {
switch (ais->type6.fid) {
case 21: /* ETA at lock/bridge/terminal */
if (bitlen != 248)
break;
UCHARS(88, ais->type6.dac200fid21.country);
UCHARS(100, ais->type6.dac200fid21.locode);
UCHARS(118, ais->type6.dac200fid21.section);
UCHARS(148, ais->type6.dac200fid21.terminal);
UCHARS(178, ais->type6.dac200fid21.hectometre);
ais->type6.dac200fid21.month = UBITS(208, 4);
ais->type6.dac200fid21.day = UBITS(212, 5);
ais->type6.dac200fid21.hour = UBITS(217, 5);
ais->type6.dac200fid21.minute = UBITS(222, 6);
ais->type6.dac200fid21.tugs = UBITS(228, 3);
ais->type6.dac200fid21.airdraught = UBITS(231, 12);
/* skip 5 bits */
ais->type6.structured = true;
break;
case 22: /* RTA at lock/bridge/terminal */
if (bitlen != 232)
break;
UCHARS(88, ais->type6.dac200fid22.country);
UCHARS(100, ais->type6.dac200fid22.locode);
UCHARS(118, ais->type6.dac200fid22.section);
UCHARS(148, ais->type6.dac200fid22.terminal);
UCHARS(178, ais->type6.dac200fid22.hectometre);
ais->type6.dac200fid22.month = UBITS(208, 4);
ais->type6.dac200fid22.day = UBITS(212, 5);
ais->type6.dac200fid22.hour = UBITS(217, 5);
ais->type6.dac200fid22.minute = UBITS(222, 6);
ais->type6.dac200fid22.status = UBITS(228, 2);
/* skip 2 bits */
ais->type6.structured = true;
break;
case 55: /* Number of Persons On Board */
if (bitlen != 168)
break;
ais->type6.dac200fid55.crew = UBITS(88, 8);
ais->type6.dac200fid55.passengers = UBITS(96, 13);
ais->type6.dac200fid55.personnel = UBITS(109, 8);
/* skip 51 bits */
ais->type6.structured = true;
break;
}
break;
}
/* UK and Republic Of Ireland */
else if (ais->type6.dac == 235 || ais->type6.dac == 250) {
switch (ais->type6.fid) {
case 10: /* GLA - AtoN monitoring data */
if (bitlen != 136)
break;
ais->type6.dac235fid10.ana_int = UBITS(88, 10);
ais->type6.dac235fid10.ana_ext1 = UBITS(98, 10);
ais->type6.dac235fid10.ana_ext2 = UBITS(108, 10);
ais->type6.dac235fid10.racon = UBITS(118, 2);
ais->type6.dac235fid10.light = UBITS(120, 2);
ais->type6.dac235fid10.alarm = UBITS(122, 1);
ais->type6.dac235fid10.stat_ext = UBITS(123, 8);
ais->type6.dac235fid10.off_pos = UBITS(131, 1);
/* skip 4 bits */
ais->type6.structured = true;
break;
}
break;
}
/* International */
else if (ais->type6.dac == 1)
switch (ais->type6.fid) {
case 12: /* IMO236 - Dangerous cargo indication */
UCHARS(88, ais->type6.dac1fid12.lastport);
ais->type6.dac1fid12.lmonth = UBITS(118, 4);
ais->type6.dac1fid12.lday = UBITS(122, 5);
ais->type6.dac1fid12.lhour = UBITS(127, 5);
ais->type6.dac1fid12.lminute = UBITS(132, 6);
UCHARS(138, ais->type6.dac1fid12.nextport);
ais->type6.dac1fid12.nmonth = UBITS(168, 4);
ais->type6.dac1fid12.nday = UBITS(172, 5);
ais->type6.dac1fid12.nhour = UBITS(177, 5);
ais->type6.dac1fid12.nminute = UBITS(182, 6);
UCHARS(188, ais->type6.dac1fid12.dangerous);
UCHARS(308, ais->type6.dac1fid12.imdcat);
ais->type6.dac1fid12.unid = UBITS(332, 13);
ais->type6.dac1fid12.amount = UBITS(345, 10);
ais->type6.dac1fid12.unit = UBITS(355, 2);
/* skip 3 bits */
ais->type6.structured = true;
break;
case 14: /* IMO236 - Tidal Window */
ais->type6.dac1fid32.month = UBITS(88, 4);
ais->type6.dac1fid32.day = UBITS(92, 5);
#define ARRAY_BASE 97
#define ELEMENT_SIZE 93
for (u = 0; ARRAY_BASE + (ELEMENT_SIZE*u) <= bitlen; u++) {
int a = ARRAY_BASE + (ELEMENT_SIZE*u);
struct tidal_t *tp = &ais->type6.dac1fid32.tidals[u];
tp->lat = SBITS(a + 0, 27);
tp->lon = SBITS(a + 27, 28);
tp->from_hour = UBITS(a + 55, 5);
tp->from_min = UBITS(a + 60, 6);
tp->to_hour = UBITS(a + 66, 5);
tp->to_min = UBITS(a + 71, 6);
tp->cdir = UBITS(a + 77, 9);
tp->cspeed = UBITS(a + 86, 7);
}
ais->type6.dac1fid32.ntidals = u;
#undef ARRAY_BASE
#undef ELEMENT_SIZE
ais->type6.structured = true;
break;
case 15: /* IMO236 - Extended Ship Static and Voyage Related Data */
ais->type6.dac1fid15.airdraught = UBITS(56, 11);
ais->type6.structured = true;
break;
case 16: /* IMO236 - Number of persons on board */
if (ais->type6.bitcount == 136)
ais->type6.dac1fid16.persons = UBITS(88, 13);/* 289 */
else
ais->type6.dac1fid16.persons = UBITS(55, 13);/* 236 */
ais->type6.structured = true;
break;
case 18: /* IMO289 - Clearance time to enter port */
ais->type6.dac1fid18.linkage = UBITS(88, 10);
ais->type6.dac1fid18.month = UBITS(98, 4);
ais->type6.dac1fid18.day = UBITS(102, 5);
ais->type6.dac1fid18.hour = UBITS(107, 5);
ais->type6.dac1fid18.minute = UBITS(112, 6);
UCHARS(118, ais->type6.dac1fid18.portname);
UCHARS(238, ais->type6.dac1fid18.destination);
ais->type6.dac1fid18.lon = SBITS(268, 25);
ais->type6.dac1fid18.lat = SBITS(293, 24);
/* skip 43 bits */
ais->type6.structured = true;
break;
case 20: /* IMO289 - Berthing data - addressed */
ais->type6.dac1fid20.linkage = UBITS(88, 10);
ais->type6.dac1fid20.berth_length = UBITS(98, 9);
ais->type6.dac1fid20.berth_depth = UBITS(107, 8);
ais->type6.dac1fid20.position = UBITS(115, 3);
ais->type6.dac1fid20.month = UBITS(118, 4);
ais->type6.dac1fid20.day = UBITS(122, 5);
ais->type6.dac1fid20.hour = UBITS(127, 5);
ais->type6.dac1fid20.minute = UBITS(132, 6);
ais->type6.dac1fid20.availability = UBITS(138, 1);
ais->type6.dac1fid20.agent = UBITS(139, 2);
ais->type6.dac1fid20.fuel = UBITS(141, 2);
ais->type6.dac1fid20.chandler = UBITS(143, 2);
ais->type6.dac1fid20.stevedore = UBITS(145, 2);
ais->type6.dac1fid20.electrical = UBITS(147, 2);
ais->type6.dac1fid20.water = UBITS(149, 2);
ais->type6.dac1fid20.customs = UBITS(151, 2);
ais->type6.dac1fid20.cartage = UBITS(153, 2);
ais->type6.dac1fid20.crane = UBITS(155, 2);
ais->type6.dac1fid20.lift = UBITS(157, 2);
ais->type6.dac1fid20.medical = UBITS(159, 2);
ais->type6.dac1fid20.navrepair = UBITS(161, 2);
ais->type6.dac1fid20.provisions = UBITS(163, 2);
ais->type6.dac1fid20.shiprepair = UBITS(165, 2);
ais->type6.dac1fid20.surveyor = UBITS(167, 2);
ais->type6.dac1fid20.steam = UBITS(169, 2);
ais->type6.dac1fid20.tugs = UBITS(171, 2);
ais->type6.dac1fid20.solidwaste = UBITS(173, 2);
ais->type6.dac1fid20.liquidwaste = UBITS(175, 2);
ais->type6.dac1fid20.hazardouswaste = UBITS(177, 2);
ais->type6.dac1fid20.ballast = UBITS(179, 2);
ais->type6.dac1fid20.additional = UBITS(181, 2);
ais->type6.dac1fid20.regional1 = UBITS(183, 2);
ais->type6.dac1fid20.regional2 = UBITS(185, 2);
ais->type6.dac1fid20.future1 = UBITS(187, 2);
ais->type6.dac1fid20.future2 = UBITS(189, 2);
UCHARS(191, ais->type6.dac1fid20.berth_name);
ais->type6.dac1fid20.berth_lon = SBITS(311, 25);
ais->type6.dac1fid20.berth_lat = SBITS(336, 24);
ais->type6.structured = true;
break;
case 23: /* IMO289 - Area notice - addressed */
break;
case 25: /* IMO289 - Dangerous cargo indication */
ais->type6.dac1fid25.unit = UBITS(88, 2);
ais->type6.dac1fid25.amount = UBITS(90, 10);
for (u = 0; 100 + u*17 < bitlen; u++) {
ais->type6.dac1fid25.cargos[u].code = UBITS(100+u*17,4);
ais->type6.dac1fid25.cargos[u].subtype = UBITS(104+u*17,13);
}
ais->type6.dac1fid25.ncargos = u;
ais->type6.structured = true;
break;
case 28: /* IMO289 - Route info - addressed */
ais->type6.dac1fid28.linkage = UBITS(88, 10);
ais->type6.dac1fid28.sender = UBITS(98, 3);
ais->type6.dac1fid28.rtype = UBITS(101, 5);
ais->type6.dac1fid28.month = UBITS(106, 4);
ais->type6.dac1fid28.day = UBITS(110, 5);
ais->type6.dac1fid28.hour = UBITS(115, 5);
ais->type6.dac1fid28.minute = UBITS(120, 6);
ais->type6.dac1fid28.duration = UBITS(126, 18);
ais->type6.dac1fid28.waycount = UBITS(144, 5);
#define ARRAY_BASE 149
#define ELEMENT_SIZE 55
for (u = 0; u < (unsigned char)ais->type6.dac1fid28.waycount; u++) {
int a = ARRAY_BASE + (ELEMENT_SIZE*u);
ais->type6.dac1fid28.waypoints[u].lon = SBITS(a+0, 28);
ais->type6.dac1fid28.waypoints[u].lat = SBITS(a+28,27);
}
#undef ARRAY_BASE
#undef ELEMENT_SIZE
ais->type6.structured = true;
break;
case 30: /* IMO289 - Text description - addressed */
ais->type6.dac1fid30.linkage = UBITS(88, 10);
ENDCHARS(98, ais->type6.dac1fid30.text);
ais->type6.structured = true;
break;
case 32: /* IMO289 - Tidal Window */
ais->type6.dac1fid32.month = UBITS(88, 4);
ais->type6.dac1fid32.day = UBITS(92, 5);
#define ARRAY_BASE 97
#define ELEMENT_SIZE 88
for (u = 0; ARRAY_BASE + (ELEMENT_SIZE*u) <= bitlen; u++) {
int a = ARRAY_BASE + (ELEMENT_SIZE*u);
struct tidal_t *tp = &ais->type6.dac1fid32.tidals[u];
tp->lon = SBITS(a + 0, 25);
tp->lat = SBITS(a + 25, 24);
tp->from_hour = UBITS(a + 49, 5);
tp->from_min = UBITS(a + 54, 6);
tp->to_hour = UBITS(a + 60, 5);
tp->to_min = UBITS(a + 65, 6);
tp->cdir = UBITS(a + 71, 9);
tp->cspeed = UBITS(a + 80, 8);
}
ais->type6.dac1fid32.ntidals = u;
#undef ARRAY_BASE
#undef ELEMENT_SIZE
ais->type6.structured = true;
break;
}
if (!ais->type6.structured)
(void)memcpy(ais->type6.bitdata,
(char *)bits + (88 / CHAR_BIT),
BITS_TO_BYTES(ais->type6.bitcount));
break;
case 7: /* Binary acknowledge */
case 13: /* Safety Related Acknowledge */
{
unsigned int mmsi[4];
RANGE_CHECK(72, 158);
for (u = 0; u < sizeof(mmsi)/sizeof(mmsi[0]); u++)
if (bitlen > 40 + 32*u)
mmsi[u] = UBITS(40 + 32*u, 30);
else
mmsi[u] = 0;
/*@ -usedef @*/
ais->type7.mmsi1 = mmsi[0];
ais->type7.mmsi2 = mmsi[1];
ais->type7.mmsi3 = mmsi[2];
ais->type7.mmsi4 = mmsi[3];
/*@ +usedef @*/
break;
}
case 8: /* Binary Broadcast Message */
RANGE_CHECK(56, 1008);
//ais->type8.spare = UBITS(38, 2);
ais->type8.dac = UBITS(40, 10);
ais->type8.fid = UBITS(50, 6);
ais->type8.bitcount = bitlen - 56;
/* not strictly required - helps stability in testing */
(void)memset(ais->type8.bitdata, '\0', sizeof(ais->type8.bitdata));
ais->type8.structured = false;
if (ais->type8.dac == 1)
switch (ais->type8.fid) {
case 11: /* IMO236 - Meteorological/Hydrological data */
/* layout is almost identical to FID=31 from IMO289 */
ais->type8.dac1fid11.lat = SBITS(56, 24);
ais->type8.dac1fid11.lon = SBITS(80, 25);
ais->type8.dac1fid11.day = UBITS(105, 5);
ais->type8.dac1fid11.hour = UBITS(110, 5);
ais->type8.dac1fid11.minute = UBITS(115, 6);
ais->type8.dac1fid11.wspeed = UBITS(121, 7);
ais->type8.dac1fid11.wgust = UBITS(128, 7);
ais->type8.dac1fid11.wdir = UBITS(135, 9);
ais->type8.dac1fid11.wgustdir = UBITS(144, 9);
ais->type8.dac1fid11.airtemp = UBITS(153, 11);
ais->type8.dac1fid11.humidity = UBITS(164, 7);
ais->type8.dac1fid11.dewpoint = UBITS(171, 10);
ais->type8.dac1fid11.pressure = UBITS(181, 9);
ais->type8.dac1fid11.pressuretend = UBITS(190, 2);
ais->type8.dac1fid11.visibility = UBITS(192, 8);
ais->type8.dac1fid11.waterlevel = UBITS(200, 9);
ais->type8.dac1fid11.leveltrend = UBITS(209, 2);
ais->type8.dac1fid11.cspeed = UBITS(211, 8);
ais->type8.dac1fid11.cdir = UBITS(219, 9);
ais->type8.dac1fid11.cspeed2 = UBITS(228, 8);
ais->type8.dac1fid11.cdir2 = UBITS(236, 9);
ais->type8.dac1fid11.cdepth2 = UBITS(245, 5);
ais->type8.dac1fid11.cspeed3 = UBITS(250, 8);
ais->type8.dac1fid11.cdir3 = UBITS(258, 9);
ais->type8.dac1fid11.cdepth3 = UBITS(267, 5);
ais->type8.dac1fid11.waveheight = UBITS(272, 8);
ais->type8.dac1fid11.waveperiod = UBITS(280, 6);
ais->type8.dac1fid11.wavedir = UBITS(286, 9);
ais->type8.dac1fid11.swellheight = UBITS(295, 8);
ais->type8.dac1fid11.swellperiod = UBITS(303, 6);
ais->type8.dac1fid11.swelldir = UBITS(309, 9);
ais->type8.dac1fid11.seastate = UBITS(318, 4);
ais->type8.dac1fid11.watertemp = UBITS(322, 10);
ais->type8.dac1fid11.preciptype = UBITS(332, 3);
ais->type8.dac1fid11.salinity = UBITS(335, 9);
ais->type8.dac1fid11.ice = UBITS(344, 2);
ais->type8.structured = true;
break;
case 13: /* IMO236 - Fairway closed */
UCHARS(56, ais->type8.dac1fid13.reason);
UCHARS(176, ais->type8.dac1fid13.closefrom);
UCHARS(296, ais->type8.dac1fid13.closeto);
ais->type8.dac1fid13.radius = UBITS(416, 10);
ais->type8.dac1fid13.extunit = UBITS(426, 2);
ais->type8.dac1fid13.fday = UBITS(428, 5);
ais->type8.dac1fid13.fmonth = UBITS(433, 4);
ais->type8.dac1fid13.fhour = UBITS(437, 5);
ais->type8.dac1fid13.fminute = UBITS(442, 6);
ais->type8.dac1fid13.tday = UBITS(448, 5);
ais->type8.dac1fid13.tmonth = UBITS(453, 4);
ais->type8.dac1fid13.thour = UBITS(457, 5);
ais->type8.dac1fid13.tminute = UBITS(462, 6);
/* skip 4 bits */
ais->type8.structured = true;
break;
case 15: /* IMO236 - Extended ship and voyage */
ais->type8.dac1fid15.airdraught = UBITS(56, 11);
/* skip 5 bits */
ais->type8.structured = true;
break;
case 16: /* Number of Persons On Board */
if (ais->type8.bitcount == 136)
ais->type8.dac1fid16.persons = UBITS(88, 13);/* 289 */
else
ais->type8.dac1fid16.persons = UBITS(55, 13);/* 236 */
ais->type8.structured = true;
break;
case 17: /* IMO289 - VTS-generated/synthetic targets */
#define ARRAY_BASE 56
#define ELEMENT_SIZE 122
for (u = 0; ARRAY_BASE + (ELEMENT_SIZE*u) <= bitlen; u++) {
struct target_t *tp = &ais->type8.dac1fid17.targets[u];
int a = ARRAY_BASE + (ELEMENT_SIZE*u);
tp->idtype = UBITS(a + 0, 2);
switch (tp->idtype) {
case DAC1FID17_IDTYPE_MMSI:
tp->id.mmsi = UBITS(a + 2, 42);
break;
case DAC1FID17_IDTYPE_IMO:
tp->id.imo = UBITS(a + 2, 42);
break;
case DAC1FID17_IDTYPE_CALLSIGN:
UCHARS(a+2, tp->id.callsign);
break;
default:
UCHARS(a+2, tp->id.other);
break;
}
/* skip 4 bits */
tp->lat = SBITS(a + 48, 24);
tp->lon = SBITS(a + 72, 25);
tp->course = UBITS(a + 97, 9);
tp->second = UBITS(a + 106, 6);
tp->speed = UBITS(a + 112, 10);
}
ais->type8.dac1fid17.ntargets = u;
#undef ARRAY_BASE
#undef ELEMENT_SIZE
ais->type8.structured = true;
break;
case 19: /* IMO289 - Marine Traffic Signal */
ais->type8.dac1fid19.linkage = UBITS(56, 10);
UCHARS(66, ais->type8.dac1fid19.station);
ais->type8.dac1fid19.lon = SBITS(186, 25);
ais->type8.dac1fid19.lat = SBITS(211, 24);
ais->type8.dac1fid19.status = UBITS(235, 2);
ais->type8.dac1fid19.signal = UBITS(237, 5);
ais->type8.dac1fid19.hour = UBITS(242, 5);
ais->type8.dac1fid19.minute = UBITS(247, 6);
ais->type8.dac1fid19.nextsignal = UBITS(253, 5);
/* skip 102 bits */
ais->type8.structured = true;
break;
case 21: /* IMO289 - Weather obs. report from ship */
break;
case 22: /* IMO289 - Area notice - broadcast */
break;
case 24: /* IMO289 - Extended ship static & voyage-related data */
break;
case 26: /* IMO289 - Environmental */
break;
case 27: /* IMO289 - Route information - broadcast */
ais->type8.dac1fid27.linkage = UBITS(56, 10);
ais->type8.dac1fid27.sender = UBITS(66, 3);
ais->type8.dac1fid27.rtype = UBITS(69, 5);
ais->type8.dac1fid27.month = UBITS(74, 4);
ais->type8.dac1fid27.day = UBITS(78, 5);
ais->type8.dac1fid27.hour = UBITS(83, 5);
ais->type8.dac1fid27.minute = UBITS(88, 6);
ais->type8.dac1fid27.duration = UBITS(94, 18);
ais->type8.dac1fid27.waycount = UBITS(112, 5);
#define ARRAY_BASE 117
#define ELEMENT_SIZE 55
for (i = 0; i < ais->type8.dac1fid27.waycount; i++) {
int a = ARRAY_BASE + (ELEMENT_SIZE*i);
ais->type8.dac1fid27.waypoints[i].lon = SBITS(a + 0, 28);
ais->type8.dac1fid27.waypoints[i].lat = SBITS(a + 28, 27);
}
#undef ARRAY_BASE
#undef ELEMENT_SIZE
ais->type8.structured = true;
break;
case 29: /* IMO289 - Text Description - broadcast */
ais->type8.dac1fid29.linkage = UBITS(56, 10);
ENDCHARS(66, ais->type8.dac1fid29.text);
ais->type8.structured = true;
break;
case 31: /* IMO289 - Meteorological/Hydrological data */
ais->type8.dac1fid31.lon = SBITS(56, 25);
ais->type8.dac1fid31.lat = SBITS(81, 24);
ais->type8.dac1fid31.accuracy = (bool)UBITS(105, 1);
ais->type8.dac1fid31.day = UBITS(106, 5);
ais->type8.dac1fid31.hour = UBITS(111, 5);
ais->type8.dac1fid31.minute = UBITS(116, 6);
ais->type8.dac1fid31.wspeed = UBITS(122, 7);
ais->type8.dac1fid31.wgust = UBITS(129, 7);
ais->type8.dac1fid31.wdir = UBITS(136, 9);
ais->type8.dac1fid31.wgustdir = UBITS(145, 9);
ais->type8.dac1fid31.airtemp = SBITS(154, 11);
ais->type8.dac1fid31.humidity = UBITS(165, 7);
ais->type8.dac1fid31.dewpoint = SBITS(172, 10);
ais->type8.dac1fid31.pressure = UBITS(182, 9);
ais->type8.dac1fid31.pressuretend = UBITS(191, 2);
ais->type8.dac1fid31.visgreater = UBITS(193, 1);
ais->type8.dac1fid31.visibility = UBITS(194, 7);
ais->type8.dac1fid31.waterlevel = UBITS(201, 12);
ais->type8.dac1fid31.leveltrend = UBITS(213, 2);
ais->type8.dac1fid31.cspeed = UBITS(215, 8);
ais->type8.dac1fid31.cdir = UBITS(223, 9);
ais->type8.dac1fid31.cspeed2 = UBITS(232, 8);
ais->type8.dac1fid31.cdir2 = UBITS(240, 9);
ais->type8.dac1fid31.cdepth2 = UBITS(249, 5);
ais->type8.dac1fid31.cspeed3 = UBITS(254, 8);
ais->type8.dac1fid31.cdir3 = UBITS(262, 9);
ais->type8.dac1fid31.cdepth3 = UBITS(271, 5);
ais->type8.dac1fid31.waveheight = UBITS(276, 8);
ais->type8.dac1fid31.waveperiod = UBITS(284, 6);
ais->type8.dac1fid31.wavedir = UBITS(290, 9);
ais->type8.dac1fid31.swellheight = UBITS(299, 8);
ais->type8.dac1fid31.swellperiod = UBITS(307, 6);
ais->type8.dac1fid31.swelldir = UBITS(313, 9);
ais->type8.dac1fid31.seastate = UBITS(322, 4);
ais->type8.dac1fid31.watertemp = SBITS(326, 10);
ais->type8.dac1fid31.preciptype = UBITS(336, 3);
ais->type8.dac1fid31.salinity = UBITS(339, 9);
ais->type8.dac1fid31.ice = UBITS(348, 2);
ais->type8.structured = true;
break;
}
else if (ais->type8.dac == 200) {
switch (ais->type8.fid) {
case 10: /* Inland ship static and voyage related data */
if (bitlen != 168)
break;
UCHARS(56, ais->type8.dac200fid10.vin);
ais->type8.dac200fid10.length = UBITS(104, 13);
ais->type8.dac200fid10.beam = UBITS(117, 10);
ais->type8.dac200fid10.shiptype = UBITS(127, 14);
ais->type8.dac200fid10.hazard = UBITS(141, 3);
ais->type8.dac200fid10.draught = UBITS(144, 11);
ais->type8.dac200fid10.loaded = UBITS(155, 2);
ais->type8.dac200fid10.speed_q = (bool)UBITS(157, 1);
ais->type8.dac200fid10.course_q = (bool)UBITS(158, 1);
ais->type8.dac200fid10.heading_q = (bool)UBITS(159, 1);
/* skip 8 bits */
/*
* Attempt to prevent false matches with this message type
* by range-checking certain fields.
*/
if (ais->type8.dac200fid10.hazard > DAC200FID10_HAZARD_MAX
|| !isascii((int)ais->type8.dac200fid10.vin[0]))
ais->type8.structured = false;
else
ais->type8.structured = true;
break;
case 23: /* EMMA warning */
if (bitlen != 256)
break;
ais->type8.dac200fid23.start_year = UBITS(56, 8);
ais->type8.dac200fid23.start_month = UBITS(64, 4);
ais->type8.dac200fid23.start_day = UBITS(68, 5);
ais->type8.dac200fid23.end_year = UBITS(73, 8);
ais->type8.dac200fid23.end_month = UBITS(81, 4);
ais->type8.dac200fid23.end_day = UBITS(85, 5);
ais->type8.dac200fid23.start_hour = UBITS(90, 5);
ais->type8.dac200fid23.start_minute = UBITS(95, 6);
ais->type8.dac200fid23.end_hour = UBITS(101, 5);
ais->type8.dac200fid23.end_minute = UBITS(106, 6);
ais->type8.dac200fid23.start_lon = SBITS(112, 28);
ais->type8.dac200fid23.start_lat = SBITS(140, 27);
ais->type8.dac200fid23.end_lon = SBITS(167, 28);
ais->type8.dac200fid23.end_lat = SBITS(195, 27);
ais->type8.dac200fid23.type = UBITS(222, 4);
ais->type8.dac200fid23.min = SBITS(226, 9);
ais->type8.dac200fid23.max = SBITS(235, 9);
ais->type8.dac200fid23.intensity = UBITS(244, 2);
ais->type8.dac200fid23.wind = UBITS(246, 4);
/* skip 6 bits */
ais->type8.structured = true;
break;
case 24: /* Water level */
if (bitlen != 168)
break;
UCHARS(56, ais->type8.dac200fid24.country);
#define ARRAY_BASE 68
#define ELEMENT_SIZE 25
for (i = 0; ARRAY_BASE + (ELEMENT_SIZE*i) < (int)bitlen; i++) {
int a = ARRAY_BASE + (ELEMENT_SIZE*i);
ais->type8.dac200fid24.gauges[i].id = UBITS(a+0, 11);
ais->type8.dac200fid24.gauges[i].level = SBITS(a+11, 14);
}
ais->type8.dac200fid24.ngauges = i;
#undef ARRAY_BASE
#undef ELEMENT_SIZE
/* skip 6 bits */
ais->type8.structured = true;
break;
case 40: /* Signal status */
if (bitlen != 168)
break;
ais->type8.dac200fid40.lon = SBITS(56, 28);
ais->type8.dac200fid40.lat = SBITS(84, 27);
ais->type8.dac200fid40.form = UBITS(111, 4);
ais->type8.dac200fid40.facing = UBITS(115, 9);
ais->type8.dac200fid40.direction = UBITS(124, 3);
ais->type8.dac200fid40.status = UBITS(127, 30);
/* skip 11 bits */
ais->type8.structured = true;
break;
}
}
/* land here if we failed to match a known DAC/FID */
if (!ais->type8.structured)
(void)memcpy(ais->type8.bitdata,
(char *)bits + (56 / CHAR_BIT),
BITS_TO_BYTES(ais->type8.bitcount));
break;
case 9: /* Standard SAR Aircraft Position Report */
PERMISSIVE_LENGTH_CHECK(168);
ais->type9.alt = UBITS(38, 12);
ais->type9.speed = UBITS(50, 10);
ais->type9.accuracy = (bool)UBITS(60, 1);
ais->type9.lon = SBITS(61, 28);
ais->type9.lat = SBITS(89, 27);
ais->type9.course = UBITS(116, 12);
ais->type9.second = UBITS(128, 6);
ais->type9.regional = UBITS(134, 8);
ais->type9.dte = UBITS(142, 1);
//ais->type9.spare = UBITS(143, 3);
ais->type9.assigned = UBITS(146, 1)!=0;
ais->type9.raim = UBITS(147, 1)!=0;
ais->type9.radio = UBITS(148, 20);
break;
case 10: /* UTC/Date inquiry */
PERMISSIVE_LENGTH_CHECK(72);
//ais->type10.spare = UBITS(38, 2);
ais->type10.dest_mmsi = UBITS(40, 30);
//ais->type10.spare2 = UBITS(70, 2);
break;
case 12: /* Safety Related Message */
RANGE_CHECK(72, 1008);
ais->type12.seqno = UBITS(38, 2);
ais->type12.dest_mmsi = UBITS(40, 30);
ais->type12.retransmit = (bool)UBITS(70, 1);
//ais->type12.spare = UBITS(71, 1);
ENDCHARS(72, ais->type12.text);
break;
case 14: /* Safety Related Broadcast Message */
RANGE_CHECK(40, 1008);
//ais->type14.spare = UBITS(38, 2);
ENDCHARS(40, ais->type14.text);
break;
case 15: /* Interrogation */
RANGE_CHECK(88, 168);
(void)memset(&ais->type15, '\0', sizeof(ais->type15));
//ais->type14.spare = UBITS(38, 2);
ais->type15.mmsi1 = UBITS(40, 30);
ais->type15.type1_1 = UBITS(70, 6);
ais->type15.type1_1 = UBITS(70, 6);
ais->type15.offset1_1 = UBITS(76, 12);
//ais->type14.spare2 = UBITS(88, 2);
if (bitlen > 90) {
ais->type15.type1_2 = UBITS(90, 6);
ais->type15.offset1_2 = UBITS(96, 12);
//ais->type14.spare3 = UBITS(108, 2);
if (bitlen > 110) {
ais->type15.mmsi2 = UBITS(110, 30);
ais->type15.type2_1 = UBITS(140, 6);
ais->type15.offset2_1 = UBITS(146, 12);
//ais->type14.spare4 = UBITS(158, 2);
}
}
break;
case 16: /* Assigned Mode Command */
RANGE_CHECK(96, 144);
ais->type16.mmsi1 = UBITS(40, 30);
ais->type16.offset1 = UBITS(70, 12);
ais->type16.increment1 = UBITS(82, 10);
if (bitlen < 144)
ais->type16.mmsi2=ais->type16.offset2=ais->type16.increment2 = 0;
else {
ais->type16.mmsi2 = UBITS(92, 30);
ais->type16.offset2 = UBITS(122, 12);
ais->type16.increment2 = UBITS(134, 10);
}
break;
case 17: /* GNSS Broadcast Binary Message */
RANGE_CHECK(80, 816);
//ais->type17.spare = UBITS(38, 2);
ais->type17.lon = UBITS(40, 18);
ais->type17.lat = UBITS(58, 17);
//ais->type17.spare = UBITS(75, 4);
ais->type17.bitcount = bitlen - 80;
(void)memcpy(ais->type17.bitdata,
(char *)bits + (80 / CHAR_BIT),
BITS_TO_BYTES(ais->type17.bitcount));
break;
case 18: /* Standard Class B CS Position Report */
PERMISSIVE_LENGTH_CHECK(168)
ais->type18.reserved = UBITS(38, 8);
ais->type18.speed = UBITS(46, 10);
ais->type18.accuracy = UBITS(56, 1)!=0;
ais->type18.lon = SBITS(57, 28);
ais->type18.lat = SBITS(85, 27);
ais->type18.course = UBITS(112, 12);
ais->type18.heading = UBITS(124, 9);
ais->type18.second = UBITS(133, 6);
ais->type18.regional = UBITS(139, 2);
ais->type18.cs = UBITS(141, 1)!=0;
ais->type18.display = UBITS(142, 1)!=0;
ais->type18.dsc = UBITS(143, 1)!=0;
ais->type18.band = UBITS(144, 1)!=0;
ais->type18.msg22 = UBITS(145, 1)!=0;
ais->type18.assigned = UBITS(146, 1)!=0;
ais->type18.raim = UBITS(147, 1)!=0;
ais->type18.radio = UBITS(148, 20);
break;
case 19: /* Extended Class B CS Position Report */
PERMISSIVE_LENGTH_CHECK(312)
ais->type19.reserved = UBITS(38, 8);
ais->type19.speed = UBITS(46, 10);
ais->type19.accuracy = UBITS(56, 1)!=0;
ais->type19.lon = SBITS(57, 28);
ais->type19.lat = SBITS(85, 27);
ais->type19.course = UBITS(112, 12);
ais->type19.heading = UBITS(124, 9);
ais->type19.second = UBITS(133, 6);
ais->type19.regional = UBITS(139, 4);
UCHARS(143, ais->type19.shipname);
ais->type19.shiptype = UBITS(263, 8);
ais->type19.to_bow = UBITS(271, 9);
ais->type19.to_stern = UBITS(280, 9);
ais->type19.to_port = UBITS(289, 6);
ais->type19.to_starboard = UBITS(295, 6);
ais->type19.epfd = UBITS(301, 4);
ais->type19.raim = UBITS(305, 1)!=0;
ais->type19.dte = UBITS(306, 1)!=0;
ais->type19.assigned = UBITS(307, 1)!=0;
//ais->type19.spare = UBITS(308, 4);
break;
case 20: /* Data Link Management Message */
RANGE_CHECK(72, 160);
//ais->type20.spare = UBITS(38, 2);
ais->type20.offset1 = UBITS(40, 12);
ais->type20.number1 = UBITS(52, 4);
ais->type20.timeout1 = UBITS(56, 3);
ais->type20.increment1 = UBITS(59, 11);
ais->type20.offset2 = UBITS(70, 12);
ais->type20.number2 = UBITS(82, 4);
ais->type20.timeout2 = UBITS(86, 3);
ais->type20.increment2 = UBITS(89, 11);
ais->type20.offset3 = UBITS(100, 12);
ais->type20.number3 = UBITS(112, 4);
ais->type20.timeout3 = UBITS(116, 3);
ais->type20.increment3 = UBITS(119, 11);
ais->type20.offset4 = UBITS(130, 12);
ais->type20.number4 = UBITS(142, 4);
ais->type20.timeout4 = UBITS(146, 3);
ais->type20.increment4 = UBITS(149, 11);
break;
case 21: /* Aid-to-Navigation Report */
RANGE_CHECK(272, 360);
ais->type21.aid_type = UBITS(38, 5);
from_sixbit((unsigned char *)bits,
43, 20, ais->type21.name);
ais->type21.accuracy = UBITS(163, 1);
ais->type21.lon = SBITS(164, 28);
ais->type21.lat = SBITS(192, 27);
ais->type21.to_bow = UBITS(219, 9);
ais->type21.to_stern = UBITS(228, 9);
ais->type21.to_port = UBITS(237, 6);
ais->type21.to_starboard = UBITS(243, 6);
ais->type21.epfd = UBITS(249, 4);
ais->type21.second = UBITS(253, 6);
ais->type21.off_position = UBITS(259, 1)!=0;
ais->type21.regional = UBITS(260, 8);
ais->type21.raim = UBITS(268, 1)!=0;
ais->type21.virtual_aid = UBITS(269, 1)!=0;
ais->type21.assigned = UBITS(270, 1)!=0;
//ais->type21.spare = UBITS(271, 1);
if (strlen(ais->type21.name) == 20 && bitlen > 272)
ENDCHARS(272, ais->type21.name+20);
break;
case 22: /* Channel Management */
PERMISSIVE_LENGTH_CHECK(168)
ais->type22.channel_a = UBITS(40, 12);
ais->type22.channel_b = UBITS(52, 12);
ais->type22.txrx = UBITS(64, 4);
ais->type22.power = UBITS(68, 1);
ais->type22.addressed = UBITS(139, 1);
if (!ais->type22.addressed) {
ais->type22.area.ne_lon = SBITS(69, 18);
ais->type22.area.ne_lat = SBITS(87, 17);
ais->type22.area.sw_lon = SBITS(104, 18);
ais->type22.area.sw_lat = SBITS(122, 17);
} else {
ais->type22.mmsi.dest1 = UBITS(69, 30);
ais->type22.mmsi.dest2 = UBITS(104, 30);
}
ais->type22.band_a = UBITS(140, 1);
ais->type22.band_b = UBITS(141, 1);
ais->type22.zonesize = UBITS(142, 3);
break;
case 23: /* Group Assignment Command */
PERMISSIVE_LENGTH_CHECK(160)
ais->type23.ne_lon = SBITS(40, 18);
ais->type23.ne_lat = SBITS(58, 17);
ais->type23.sw_lon = SBITS(75, 18);
ais->type23.sw_lat = SBITS(93, 17);
ais->type23.stationtype = UBITS(110, 4);
ais->type23.shiptype = UBITS(114, 8);
ais->type23.txrx = UBITS(144, 4);
ais->type23.interval = UBITS(146, 4);
ais->type23.quiet = UBITS(150, 4);
break;
case 24: /* Class B CS Static Data Report */
switch (UBITS(38, 2)) {
case 0:
RANGE_CHECK(160, 168);
/* save incoming 24A shipname/MMSI pairs in a circular queue */
{
struct ais_type24a_t *saveptr = &type24_queue->ships[type24_queue->index];
gpsd_log(errout, LOG_PROG,
"AIVDM: 24A from %09u stashed.\n",
ais->mmsi);
saveptr->mmsi = ais->mmsi;
UCHARS(40, saveptr->shipname);
++type24_queue->index;
type24_queue->index %= MAX_TYPE24_INTERLEAVE;
}
//ais->type24.a.spare = UBITS(160, 8);
UCHARS(40, ais->type24.shipname);
ais->type24.part = part_a;
return true;
case 1:
PERMISSIVE_LENGTH_CHECK(168)
ais->type24.shiptype = UBITS(40, 8);
/*
* In ITU-R 1371-4, there are new model and serial fields
* carved out of the right-hand end of vendorid, which is
* reduced from 7 chars to 3. To cope with older AIS
* implementations conforming to revision 3 and older,
* unpack the trailing bits *both* ways; truly
* revision-4-conformant implementations will have up to
* four characters of trailing garbage on the vendorid,
* and older implementations will have garbafe in the
* model and serial fields.
*/
UCHARS(48, ais->type24.vendorid);
ais->type24.model = UBITS(66, 4);
ais->type24.serial = UBITS(70, 20);
UCHARS(90, ais->type24.callsign);
if (AIS_AUXILIARY_MMSI(ais->mmsi)) {
ais->type24.mothership_mmsi = UBITS(132, 30);
} else {
ais->type24.dim.to_bow = UBITS(132, 9);
ais->type24.dim.to_stern = UBITS(141, 9);
ais->type24.dim.to_port = UBITS(150, 6);
ais->type24.dim.to_starboard = UBITS(156, 6);
}
//ais->type24.b.spare = UBITS(162, 8);
/* search the 24A queue for a matching MMSI */
for (i = 0; i < MAX_TYPE24_INTERLEAVE; i++) {
if (type24_queue->ships[i].mmsi == ais->mmsi) {
(void)strlcpy(ais->type24.shipname,
type24_queue->ships[i].shipname,
sizeof(ais->type24.shipname));
gpsd_log(errout, LOG_PROG,
"AIVDM 24B from %09u matches a 24A.\n",
ais->mmsi);
/* prevent false match if a 24B is repeated */
type24_queue->ships[i].mmsi = 0;
ais->type24.part = both;
return true;
}
}
/* no match, return Part B */
ais->type24.part = part_b;
return true;
default:
gpsd_log(errout, LOG_WARN,
"AIVDM message type 24 of subtype unknown.\n");
return false;
}
// break;
case 25: /* Binary Message, Single Slot */
/* this check and the following one reject line noise */
if (bitlen < 40 || bitlen > 168) {
gpsd_log(errout, LOG_WARN,
"AIVDM message type 25 size not between 40 to 168 bits (%zd).\n",
bitlen);
return false;
}
ais->type25.addressed = (bool)UBITS(38, 1);
ais->type25.structured = (bool)UBITS(39, 1);
if (bitlen < (unsigned)(40 + (16*ais->type25.structured) + (30*ais->type25.addressed))) {
gpsd_log(errout, LOG_WARN,
"AIVDM message type 25 too short for mode.\n");
return false;
}
if (ais->type25.addressed)
ais->type25.dest_mmsi = UBITS(40, 30);
if (ais->type25.structured)
ais->type25.app_id = UBITS(40+ais->type25.addressed*30,16);
ais->type25.bitcount = bitlen - 40 - 16*ais->type25.structured;
/* bit 40 is exactly 5 bytes in; 2 bytes is 16 bits */
(void)memcpy(ais->type25.bitdata,
(char *)bits+5 + 2 * ais->type25.structured,
BITS_TO_BYTES(ais->type25.bitcount));
/* discard MMSI if addressed */
if (ais->type25.addressed) {
shiftleft((unsigned char *)ais->type25.bitdata, ais->type25.bitcount, 30);
ais->type25.bitcount -= 30;
}
break;
case 26: /* Binary Message, Multiple Slot */
RANGE_CHECK(60, 1004);
ais->type26.addressed = (bool)UBITS(38, 1);
ais->type26.structured = (bool)UBITS(39, 1);
if ((signed)bitlen < 40 + 16*ais->type26.structured + 30*ais->type26.addressed + 20) {
gpsd_log(errout, LOG_WARN,
"AIVDM message type 26 too short for mode.\n");
return false;
}
if (ais->type26.addressed)
ais->type26.dest_mmsi = UBITS(40, 30);
if (ais->type26.structured)
ais->type26.app_id = UBITS(40+ais->type26.addressed*30,16);
ais->type26.bitcount = bitlen - 60 - 16*ais->type26.structured;
(void)memcpy(ais->type26.bitdata,
(unsigned char *)bits+5 + 2 * ais->type26.structured,
BITS_TO_BYTES(ais->type26.bitcount));
/* discard MMSI if addressed */
if (ais->type26.addressed) {
shiftleft((unsigned char *)ais->type26.bitdata, ais->type26.bitcount, 30);
ais->type26.bitcount -= 30;
}
break;
case 27: /* Long Range AIS Broadcast message */
if (bitlen != 96 && bitlen != 168) {
gpsd_log(errout, LOG_WARN,
"unexpected AIVDM message type 27 (%zd).\n",
bitlen);
return false;
} if (bitlen == 168) {
/*
* This is an implementation error observed in the wild,
* sending a full 168-bit slot rather than just 96 bits.
*/
gpsd_log(errout, LOG_WARN,
"oversized 169=8-bit AIVDM message type 27.\n");
}
ais->type27.accuracy = (bool)UBITS(38, 1);
ais->type27.raim = UBITS(39, 1)!=0;
ais->type27.status = UBITS(40, 4);
ais->type27.lon = SBITS(44, 18);
ais->type27.lat = SBITS(62, 17);
ais->type27.speed = UBITS(79, 6);
ais->type27.course = UBITS(85, 9);
ais->type27.gnss = (bool)UBITS(94, 1);
break;
default:
gpsd_log(errout, LOG_ERROR,
"Unparsed AIVDM message type %d.\n",ais->type);
return false;
}
/* *INDENT-ON* */
#undef UCHARS
#undef SBITS
#undef UBITS
/* data is fully decoded */
return true;
}
/*@ -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)"},
};
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 @*/
if (!quiet)
(void)printf("Testing bitfield extraction\n");
/*@-type@*/
sb1 = getsb(buf, 0);
sb2 = getsb(buf, 8);
ub1 = getub(buf, 0);
ub2 = getub(buf, 8);
/*@+type@*/
if (!quiet) {
unsigned char *sp;
(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");
/*@-type@*/
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);
/*@+type@*/
bedumpall();
/* little-endian test */
printf("Little-endian:\n");
/*@-type@*/
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@*/
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");
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");
}
shiftleft(buf, 28, 30);
printf("Left-shifted 30 bits: %s\n", hexdump(buf, 28));
/*
* After the 24-bit shift, the but array loses its first three bytes:
* 0x0405060708 = 00000100 00000101 00000110 00000111 00001000
* By inspection, the results of the 6-bit shift are
* 00000001 01000001 10000001 11000010 00
*/
#define LASSERT(n, v) if (buf[n] != v) printf("Expected buf[%d] to be %02x, was %02x\n", n, v, buf[n])
LASSERT(0, 0x01);
LASSERT(1, 0x41);
LASSERT(2, 0x81);
LASSERT(3, 0xc1);
#undef LASSERT
exit(failures ? EXIT_FAILURE : EXIT_SUCCESS);
}
int
sc_main(int argc, char* argv[])
{
sc_report_handler::
set_actions("/IEEE_Std_1666/deprecated", SC_DO_NOTHING);
char stbuf[256];
// SIGNALS
// Data signals
sc_signal< sc_bv<DWORD> > bus_mux1;
sc_signal< sc_bv<DWORD> > bus_mux2;
sc_signal< sc_bv<DWORD> > bus_mux3;
sc_signal< sc_bv<AWORDREG> > bus_mux4;
sc_signal< sc_bv<6> > bus_decoder_instr_31_26;
sc_signal< sc_bv<AWORDREG> > bus_decoder_instr_25_21;
sc_signal< sc_bv<AWORDREG> > bus_decoder_instr_20_16;
sc_signal< sc_bv<AWORDREG> > bus_decoder_instr_15_11;
sc_signal< sc_bv<SIGNEXTENDBIT> > bus_decoder_instr_15_0;
sc_signal< sc_bv<6> > bus_decoder_instr_5_0;
sc_signal< sc_bv<DWORD> > bus_pc;
sc_signal< sc_bv<DWORD> > bus_add1;
sc_signal< sc_bv<DWORD> > bus_add2;
sc_signal< sc_bv<DWORD> > bus_shiftleft;
sc_signal< sc_bv<DWORD> > bus_signextend;
sc_signal< sc_bv<DWORD> > bus_imem_1;
sc_signal< sc_bv<DWORD> > bus_dmem_1;
sc_signal< sc_bv<DWORD> > bus_alu_result;
sc_signal< sc_bv<1> > bus_alu_zero;
sc_signal< sc_bv<DWORD> > bus_registers_1;
sc_signal< sc_bv<DWORD> > bus_registers_2;
// Control signals
sc_signal< sc_bv<1> > bus_ctrl_regdst;
sc_signal< sc_bv<1> > bus_ctrl_branch;
sc_signal< sc_bv<1> > bus_ctrl_memread;
sc_signal< sc_bv<1> > bus_ctrl_memtoreg;
sc_signal< sc_bv<2> > bus_ctrl_aluop;
sc_signal< sc_bv<1> > bus_ctrl_memwrite;
sc_signal< sc_bv<1> > bus_ctrl_alusrc;
sc_signal< sc_bv<1> > bus_ctrl_regwrite;
sc_signal< sc_bv<DWORD> > bus_ctrl_c4;
sc_signal< sc_bv<3> > bus_aluctrl;
sc_signal< sc_bv<1> > bus_and1;
// MODULES
REGISTER pc("pc");
ADD add1("add1");
ADD add2("add2");
AND and1("and1");
ROM imem("instruction_memory"); // Instruction memory
RAM dmem("data_memory"); // Data memory
REGFILE registers("registers"); // Registerfile
ALU alu("alu");
ALUCTRL aluctrl("aluctrl");
SIGNEXTEND signextend("signextend");
SHIFTLEFT shiftleft("shiftleft");
CTRL ctrl("ctrl");
DECODER decoder("decoder");
MUX mux1("mux1");
MUX mux2("mux2");
MUX mux3("mux3");
MUX2_AWORDREG mux4("mux4");
sc_clock clk("clock", 20); // Clock
// CONNECTIONS
// Program counter
pc.in(bus_mux1);
pc.out(bus_pc);
pc.w(clk);
pc.clk(clk);
// Add 1 (PC + 4)
add1.a(bus_pc);
add1.b(bus_ctrl_c4);
add1.r(bus_add1);
// Add 2 (add1 + shiftleft)
add2.a(bus_add1);
add2.b(bus_shiftleft);
add2.r(bus_add2);
// Mux 1 (add1 or add2)
mux1.in0(bus_add1);
mux1.in1(bus_add2);
mux1.sel(bus_and1);
mux1.out(bus_mux1);
// Shift left 2
shiftleft.in(bus_signextend);
shiftleft.out(bus_shiftleft);
// Sign extend
signextend.in(bus_decoder_instr_15_0);
signextend.out(bus_signextend);
// Decoder (Select correct part of instruction for registerfile)
decoder.instr(bus_imem_1);
decoder.instr_31_26(bus_decoder_instr_31_26);
decoder.instr_25_21(bus_decoder_instr_25_21);
decoder.instr_20_16(bus_decoder_instr_20_16);
decoder.instr_15_11(bus_decoder_instr_15_11);
decoder.instr_15_0(bus_decoder_instr_15_0);
decoder.instr_5_0(bus_decoder_instr_5_0);
// Mux 4 (Select address for write to registerfile)
mux4.in0(bus_decoder_instr_20_16);
mux4.in1(bus_decoder_instr_15_11);
mux4.sel(bus_ctrl_regdst);
mux4.out(bus_mux4);
// ALU
alu.a(bus_registers_1);
alu.b(bus_mux2);
alu.r(bus_alu_result);
alu.z(bus_alu_zero);
alu.ctrl(bus_aluctrl);
// Mux 2 (Registerfile or signextend)
mux2.in0(bus_registers_2);
mux2.in1(bus_signextend);
mux2.sel(bus_ctrl_alusrc);
mux2.out(bus_mux2);
// ALU ctrl
aluctrl.ALUop(bus_ctrl_aluop);
aluctrl.functionCode(bus_decoder_instr_5_0);
aluctrl.ALUctrl(bus_aluctrl);
// Mux 3 (ALU result or memory result to register)
mux3.in0(bus_alu_result);
mux3.in1(bus_dmem_1);
mux3.sel(bus_ctrl_memtoreg);
mux3.out(bus_mux3);
// AND
and1.a(bus_alu_zero);
and1.b(bus_ctrl_branch);
and1.r(bus_and1);
// Registerfile
registers.r_addr_reg1(bus_decoder_instr_25_21);
registers.r_addr_reg2(bus_decoder_instr_20_16);
registers.w_addr_reg(bus_mux4);
registers.r_data_reg1(bus_registers_1);
registers.r_data_reg2(bus_registers_2);
registers.w_data_reg(bus_mux3);
registers.w(bus_ctrl_regwrite);
registers.clk(clk);
// Data memory
dmem.a_read(bus_alu_result);
dmem.d_read(bus_dmem_1);
dmem.r(bus_ctrl_memread);
dmem.a_write(bus_alu_result);
dmem.d_write(bus_registers_2);
dmem.w(bus_ctrl_memwrite);
dmem.clk(clk);
// Instruction Memory
imem.a_read(bus_pc);
imem.d_read(bus_imem_1);
imem.clk(clk);
// Controller
ctrl.Opcode(bus_decoder_instr_31_26);
ctrl.RegDst(bus_ctrl_regdst);
ctrl.Branch(bus_ctrl_branch);
ctrl.MemRead(bus_ctrl_memread);
ctrl.MemtoReg(bus_ctrl_memtoreg);
ctrl.ALUop(bus_ctrl_aluop);
ctrl.MemWrite(bus_ctrl_memwrite);
ctrl.ALUSrc(bus_ctrl_alusrc);
ctrl.RegWrite(bus_ctrl_regwrite);
ctrl.c4(bus_ctrl_c4);
// INITIALIZATION
imem.rom_init("mips.rom");
dmem.ram_init("mips.ram");
// TRACING
sc_trace_file* tf;
tf = sc_create_vcd_trace_file("mips");
// Signals
sc_trace(tf, clk, "clock");
sc_trace(tf, bus_mux1, "bus_mux1");
sc_trace(tf, bus_mux2, "bus_mux2");
sc_trace(tf, bus_mux3, "bus_mux3");
sc_trace(tf, bus_mux4, "bus_mux4");
sc_trace(tf, bus_pc, "bus_pc");
sc_trace(tf, bus_add1, "bus_add1");
sc_trace(tf, bus_add2, "bus_add2");
sc_trace(tf, bus_shiftleft, "bus_shiftleft");
sc_trace(tf, bus_signextend, "bus_signextend");
sc_trace(tf, bus_imem_1, "bus_imem_1");
sc_trace(tf, bus_dmem_1, "bus_dmem_1");
sc_trace(tf, bus_alu_result, "bus_alu_result");
sc_trace(tf, bus_alu_zero, "bus_alu_zero");
sc_trace(tf, bus_registers_1, "bus_registers_1");
sc_trace(tf, bus_registers_2, "bus_registers_2");
sc_trace(tf, bus_ctrl_regdst, "bus_ctrl_regdst");
sc_trace(tf, bus_ctrl_branch, "bus_ctrl_branch");
sc_trace(tf, bus_ctrl_memread, "bus_ctrl_memread");
sc_trace(tf, bus_ctrl_memtoreg, "bus_ctrl_memtoreg");
sc_trace(tf, bus_ctrl_aluop, "bus_ctrl_aluop");
sc_trace(tf, bus_ctrl_memwrite, "bus_ctrl_memwrite");
sc_trace(tf, bus_ctrl_alusrc, "bus_ctrl_alusrc");
sc_trace(tf, bus_ctrl_regwrite, "bus_ctrl_regwrite");
sc_trace(tf, bus_ctrl_c4, "bus_ctrl_c4");
sc_trace(tf, bus_aluctrl, "bus_aluctrl");
sc_trace(tf, bus_and1, "bus_and1");
sc_trace(tf, bus_decoder_instr_31_26, "bus_decoder_instr_31_26");
sc_trace(tf, bus_decoder_instr_25_21, "bus_decoder_instr_25_21");
sc_trace(tf, bus_decoder_instr_20_16, "bus_decoder_instr_20_16");
sc_trace(tf, bus_decoder_instr_15_11, "bus_decoder_instr_15_11");
sc_trace(tf, bus_decoder_instr_15_0, "bus_decoder_instr_15_0");
sc_trace(tf, bus_decoder_instr_5_0, "bus_decoder_instr_5_0");
for (int i = 0; i < REGSIZE; i++) {
sprintf(stbuf, "registers.reg(%d)", i);
sc_trace(tf, registers.rfile[i], stbuf);
}
for (int i = 0; i < RAMSIZE; i++) {
sprintf(stbuf, "memory.dmem(%d)", i);
sc_trace(tf, dmem.ramfile[i], stbuf);
}
for (int i = 0; i < ROMSIZE; i++) {
sprintf(stbuf, "memory.imem(%d)", i);
sc_trace(tf, imem.romfile[i], stbuf);
}
// SIMULATION
int sim_time = 500;
if (argc == 2)
sim_time = atoi(argv[1]);
sc_start(sim_time, SC_NS);
sc_close_vcd_trace_file(tf);
dmem.ram_dump("mips_ram.dump");
return 0;
}
