1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135 |
- /*
- * Driver for AIS messages.
- *
- * See the file AIVDM.txt on the GPSD website for documentation and references.
- * AIVDM de-armoring is handled elsewhere; this is the binary-packet driver.
- *
- * Code for message types 1-15, 18-21, and 24 has been tested against
- * live data with known-good decodings. Code for message types 16-17,
- * 22-23, and 25-27 has not.
- * For the special IMO messages (types 6 and 8), only the following have been
- * tested against known-good decodings:
- * - IMO236 met/hydro message: Type=8, DAC=1, FI=11
- * - IMO289 met/hydro message: Type=8, DAC=1, FI=31
- *
- * This file is Copyright 2010 by the GPSD project
- * SPDX-License-Identifier: BSD-2-clause
- */
- #include "gpsd_config.h" /* must be before all includes */
- #include <ctype.h>
- #include <stdlib.h>
- #include <string.h>
- #include "gpsd.h"
- #include "bits.h"
- /*
- * Parse the data from the device
- */
- /* beginning at bitvec bit start, unpack count sixbit characters */
- static void from_sixbit_untrimmed(unsigned char *bitvec, unsigned int start,
- int count, char *to)
- {
- const char sixchr[64] =
- "@ABCDEFGHIJKLMNOPQRSTUVWXYZ[\\]^_ !\"#$%&'()*+,-./0123456789:;<=>?";
- int i;
- /* six-bit to ASCII */
- for (i = 0; i < count; i++) {
- char newchar;
- newchar = sixchr[ubits(bitvec, start + 6 * i, 6U, false)];
- if (newchar == '@')
- break;
- else
- to[i] = newchar;
- }
- to[i] = '\0';
- }
- /* trim spaces on right end */
- static void trim_spaces_on_right_end(char* to)
- {
- int i;
- for (i = strlen(to) - 1; i >= 0; i--) {
- if (to[i] == ' ' || to[i] == '@') {
- to[i] = '\0';
- } else {
- break;
- }
- }
- }
- /* beginning at bitvec bit start, unpack count sixbit characters
- * and remove trailing spaces */
- static void from_sixbit(unsigned char *bitvec, unsigned int start, int count,
- char *to)
- {
- from_sixbit_untrimmed(bitvec, start, count, to);
- trim_spaces_on_right_end(to);
- }
- /* decode an AIS binary packet */
- 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)
- {
- unsigned int u; int i;
- #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(LOG_INF, errout, "AIVDM message type %d, MMSI %09d:\n",
- ais->type, ais->mmsi);
- #define PERMISSIVE_LENGTH_CHECK(correct) \
- if (bitlen < correct) { \
- GPSD_LOG(LOG_ERROR, errout, \
- "AIVDM message type %d size < %d bits (%zd).\n", \
- ais->type, correct, bitlen); \
- return false; \
- } else if (bitlen > correct) { \
- GPSD_LOG(LOG_WARN, errout, \
- "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(LOG_ERROR, errout, \
- "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(163)
- 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;
- if(bitlen >= 168)
- ais->type1.radio = UBITS(149, 19);
- if(bitlen < 168)
- ais->type1.radio = UBITS(149, bitlen - 149);
- 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(LOG_WARN, errout,
- "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;
- }
- }
- /* 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;
- }
- }
- /* 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];
- unsigned seqno[4];
- RANGE_CHECK(72, 168);
- for (u = 0; u < sizeof(mmsi)/sizeof(mmsi[0]); u++) {
- if (bitlen > 40 + 32*u) {
- mmsi[u] = UBITS(40 + 32 * u, 30);
- seqno[u] = UBITS(72 + 32 * u, 2);
- } else {
- mmsi[u] = 0;
- seqno[u] = 0;
- }
- }
- ais->type7.mmsi1 = mmsi[0];
- ais->type7.seqno1 = seqno[0];
- ais->type7.mmsi2 = mmsi[1];
- ais->type7.seqno2 = seqno[1];
- ais->type7.mmsi3 = mmsi[2];
- ais->type7.seqno2 = seqno[2];
- ais->type7.mmsi4 = mmsi[3];
- ais->type7.seqno3 = seqno[3];
- 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 */
- ais->type8.structured = true;
- } else if (ais->type8.bitcount == 72) {
- 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) {
- size_t number_of_bytes = BITS_TO_BYTES(ais->type8.bitcount);
- (void)memcpy(ais->type8.bitdata, (char *)bits + (56 / CHAR_BIT),
- number_of_bytes);
- size_t valid_bits_in_last_byte = ais->type8.bitcount % CHAR_BIT;
- if(valid_bits_in_last_byte > 0) {
- ais->type8.bitdata[number_of_bytes - 1] &=
- (0xFF << (8 - valid_bits_in_last_byte));
- }
- }
- 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, 168);
- 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 = SBITS(40, 18);
- ais->type17.lat = SBITS(58, 17);
- //ais->type17.spare = UBITS(75, 5);
- 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, 186);
- //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, 368);
- ais->type21.aid_type = UBITS(38, 5);
- from_sixbit_untrimmed((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);
- trim_spaces_on_right_end(ais->type21.name);
- 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(LOG_PROG, errout, "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(LOG_PROG, errout,
- "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(LOG_WARN, errout,
- "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(LOG_WARN, errout,
- "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(LOG_WARN, errout,
- "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(LOG_WARN, errout,
- "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(LOG_WARN, errout,
- "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(LOG_WARN, errout,
- "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(LOG_ERROR, errout,
- "Unparsed AIVDM message type %d.\n",ais->type);
- return false;
- }
- /* *INDENT-ON* */
- #undef UCHARS
- #undef SBITS
- #undef UBITS
- /* data is fully decoded */
- return true;
- }
- /* driver_ais.c ends here */
- // vim: set expandtab shiftwidth=4
|