123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360 |
- #ifdef HAVE_CONFIG_H
- #include "config.h"
- #endif
- #include <netdissect-stdinc.h>
- #include "netdissect.h"
- #include "extract.h"
- struct arc_header {
- uint8_t arc_shost;
- uint8_t arc_dhost;
- uint8_t arc_type;
-
- uint8_t arc_flag;
- uint16_t arc_seqid;
-
- uint8_t arc_type2;
- uint8_t arc_flag2;
- uint16_t arc_seqid2;
- };
- #define ARC_HDRLEN 3
- #define ARC_HDRNEWLEN 6
- #define ARC_HDRNEWLEN_EXC 10
- #define ARCTYPE_IP_OLD 240
- #define ARCTYPE_ARP_OLD 241
- #define ARCTYPE_IP 212
- #define ARCTYPE_ARP 213
- #define ARCTYPE_REVARP 214
- #define ARCTYPE_ATALK 221
- #define ARCTYPE_BANIAN 247
- #define ARCTYPE_IPX 250
- #define ARCTYPE_INET6 0xc4
- #define ARCTYPE_DIAGNOSE 0x80
- struct arc_linux_header {
- uint8_t arc_shost;
- uint8_t arc_dhost;
- uint16_t arc_offset;
- uint8_t arc_type;
-
- uint8_t arc_flag;
- uint16_t arc_seqid;
- };
- #define ARC_LINUX_HDRLEN 5
- #define ARC_LINUX_HDRNEWLEN 8
- static int arcnet_encap_print(netdissect_options *, u_char arctype, const u_char *p,
- u_int length, u_int caplen);
- static const struct tok arctypemap[] = {
- { ARCTYPE_IP_OLD, "oldip" },
- { ARCTYPE_ARP_OLD, "oldarp" },
- { ARCTYPE_IP, "ip" },
- { ARCTYPE_ARP, "arp" },
- { ARCTYPE_REVARP, "rarp" },
- { ARCTYPE_ATALK, "atalk" },
- { ARCTYPE_BANIAN, "banyan" },
- { ARCTYPE_IPX, "ipx" },
- { ARCTYPE_INET6, "ipv6" },
- { ARCTYPE_DIAGNOSE, "diag" },
- { 0, 0 }
- };
- static inline void
- arcnet_print(netdissect_options *ndo, const u_char *bp, u_int length, int phds,
- int flag, u_int seqid)
- {
- const struct arc_header *ap;
- const char *arctypename;
- ap = (const struct arc_header *)bp;
- if (ndo->ndo_qflag) {
- ND_PRINT((ndo, "%02x %02x %d: ",
- ap->arc_shost,
- ap->arc_dhost,
- length));
- return;
- }
- arctypename = tok2str(arctypemap, "%02x", ap->arc_type);
- if (!phds) {
- ND_PRINT((ndo, "%02x %02x %s %d: ",
- ap->arc_shost, ap->arc_dhost, arctypename,
- length));
- return;
- }
- if (flag == 0) {
- ND_PRINT((ndo, "%02x %02x %s seqid %04x %d: ",
- ap->arc_shost, ap->arc_dhost, arctypename, seqid,
- length));
- return;
- }
- if (flag & 1)
- ND_PRINT((ndo, "%02x %02x %s seqid %04x "
- "(first of %d fragments) %d: ",
- ap->arc_shost, ap->arc_dhost, arctypename, seqid,
- (flag + 3) / 2, length));
- else
- ND_PRINT((ndo, "%02x %02x %s seqid %04x "
- "(fragment %d) %d: ",
- ap->arc_shost, ap->arc_dhost, arctypename, seqid,
- flag/2 + 1, length));
- }
- u_int
- arcnet_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char *p)
- {
- u_int caplen = h->caplen;
- u_int length = h->len;
- const struct arc_header *ap;
- int phds, flag = 0, archdrlen = 0;
- u_int seqid = 0;
- u_char arc_type;
- if (caplen < ARC_HDRLEN || length < ARC_HDRLEN) {
- ND_PRINT((ndo, "[|arcnet]"));
- return (caplen);
- }
- ap = (const struct arc_header *)p;
- arc_type = ap->arc_type;
- switch (arc_type) {
- default:
- phds = 1;
- break;
- case ARCTYPE_IP_OLD:
- case ARCTYPE_ARP_OLD:
- case ARCTYPE_DIAGNOSE:
- phds = 0;
- archdrlen = ARC_HDRLEN;
- break;
- }
- if (phds) {
- if (caplen < ARC_HDRNEWLEN || length < ARC_HDRNEWLEN) {
- arcnet_print(ndo, p, length, 0, 0, 0);
- ND_PRINT((ndo, "[|phds]"));
- return (caplen);
- }
- if (ap->arc_flag == 0xff) {
- if (caplen < ARC_HDRNEWLEN_EXC || length < ARC_HDRNEWLEN_EXC) {
- arcnet_print(ndo, p, length, 0, 0, 0);
- ND_PRINT((ndo, "[|phds extended]"));
- return (caplen);
- }
- flag = ap->arc_flag2;
- seqid = EXTRACT_16BITS(&ap->arc_seqid2);
- archdrlen = ARC_HDRNEWLEN_EXC;
- } else {
- flag = ap->arc_flag;
- seqid = EXTRACT_16BITS(&ap->arc_seqid);
- archdrlen = ARC_HDRNEWLEN;
- }
- }
- if (ndo->ndo_eflag)
- arcnet_print(ndo, p, length, phds, flag, seqid);
-
- length -= archdrlen;
- caplen -= archdrlen;
- p += archdrlen;
- if (phds && flag && (flag & 1) == 0) {
-
- return (archdrlen);
- }
- if (!arcnet_encap_print(ndo, arc_type, p, length, caplen))
- ND_DEFAULTPRINT(p, caplen);
- return (archdrlen);
- }
- u_int
- arcnet_linux_if_print(netdissect_options *ndo, const struct pcap_pkthdr *h, const u_char *p)
- {
- u_int caplen = h->caplen;
- u_int length = h->len;
- const struct arc_linux_header *ap;
- int archdrlen = 0;
- u_char arc_type;
- if (caplen < ARC_LINUX_HDRLEN || length < ARC_LINUX_HDRLEN) {
- ND_PRINT((ndo, "[|arcnet]"));
- return (caplen);
- }
- ap = (const struct arc_linux_header *)p;
- arc_type = ap->arc_type;
- switch (arc_type) {
- default:
- archdrlen = ARC_LINUX_HDRNEWLEN;
- if (caplen < ARC_LINUX_HDRNEWLEN || length < ARC_LINUX_HDRNEWLEN) {
- ND_PRINT((ndo, "[|arcnet]"));
- return (caplen);
- }
- break;
- case ARCTYPE_IP_OLD:
- case ARCTYPE_ARP_OLD:
- case ARCTYPE_DIAGNOSE:
- archdrlen = ARC_LINUX_HDRLEN;
- break;
- }
- if (ndo->ndo_eflag)
- arcnet_print(ndo, p, length, 0, 0, 0);
-
- length -= archdrlen;
- caplen -= archdrlen;
- p += archdrlen;
- if (!arcnet_encap_print(ndo, arc_type, p, length, caplen))
- ND_DEFAULTPRINT(p, caplen);
- return (archdrlen);
- }
- static int
- arcnet_encap_print(netdissect_options *ndo, u_char arctype, const u_char *p,
- u_int length, u_int caplen)
- {
- switch (arctype) {
- case ARCTYPE_IP_OLD:
- case ARCTYPE_IP:
- ip_print(ndo, p, length);
- return (1);
- case ARCTYPE_INET6:
- ip6_print(ndo, p, length);
- return (1);
- case ARCTYPE_ARP_OLD:
- case ARCTYPE_ARP:
- case ARCTYPE_REVARP:
- arp_print(ndo, p, length, caplen);
- return (1);
- case ARCTYPE_ATALK:
- if (ndo->ndo_vflag)
- ND_PRINT((ndo, "et1 "));
- atalk_print(ndo, p, length);
- return (1);
- case ARCTYPE_IPX:
- ipx_print(ndo, p, length);
- return (1);
- default:
- return (0);
- }
- }
|