JP Abgrall | 53f17a9 | 2014-02-12 14:02:41 -0800 | [diff] [blame] | 1 | /* |
| 2 | * Copyright (c) 2007 - Andrey "nording" Chernyak <andrew@nording.ru> |
| 3 | * |
| 4 | * Redistribution and use in source and binary forms, with or without |
| 5 | * modification, are permitted provided that: (1) source code distributions |
| 6 | * retain the above copyright notice and this paragraph in its entirety, (2) |
| 7 | * distributions including binary code include the above copyright notice and |
| 8 | * this paragraph in its entirety in the documentation or other materials |
| 9 | * provided with the distribution, and (3) all advertising materials mentioning |
| 10 | * features or use of this software display the following acknowledgement: |
| 11 | * ``This product includes software developed by the University of California, |
| 12 | * Lawrence Berkeley Laboratory and its contributors.'' Neither the name of |
| 13 | * the University nor the names of its contributors may be used to endorse |
| 14 | * or promote products derived from this software without specific prior |
| 15 | * written permission. |
| 16 | * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED |
| 17 | * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF |
| 18 | * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. |
| 19 | * |
| 20 | * Format and print Realtek Remote Control Protocol (RRCP) |
| 21 | * and Realtek Echo Protocol (RRCP-REP) packets. |
| 22 | */ |
| 23 | |
| 24 | #ifndef lint |
| 25 | static const char rcsid[] _U_ = |
| 26 | "@(#) $Header: /tcpdump/master/tcpdump/print-rrcp.c,v 1.2 2008-04-11 17:21:34 gianluca Exp $"; |
| 27 | #endif |
| 28 | |
| 29 | #ifdef HAVE_CONFIG_H |
| 30 | #include "config.h" |
| 31 | #endif |
| 32 | |
| 33 | #include <tcpdump-stdinc.h> |
| 34 | |
| 35 | #include <stdio.h> |
| 36 | #include <string.h> |
| 37 | |
| 38 | #include "netdissect.h" |
| 39 | #include "addrtoname.h" |
| 40 | #include "extract.h" |
| 41 | #include "ether.h" |
| 42 | |
| 43 | #ifndef ETH_ALEN |
| 44 | #define ETH_ALEN 6 |
| 45 | #endif |
| 46 | |
| 47 | #define RRCP_OPCODE_MASK 0x7F /* 0x00 = hello, 0x01 = get, 0x02 = set */ |
| 48 | #define RRCP_ISREPLY 0x80 /* 0 = request to switch, 0x80 = reply from switch */ |
| 49 | |
| 50 | #define RRCP_PROTO_OFFSET 0 /* proto - 1 byte, must be 1 */ |
| 51 | #define RRCP_OPCODE_ISREPLY_OFFSET 1 /* opcode and isreply flag - 1 byte */ |
| 52 | #define RRCP_AUTHKEY_OFFSET 2 /* authorization key - 2 bytes, 0x2379 by default */ |
| 53 | |
| 54 | /* most packets */ |
| 55 | #define RRCP_REG_ADDR_OFFSET 4 /* register address - 2 bytes */ |
| 56 | #define RRCP_REG_DATA_OFFSET 6 /* register data - 4 bytes */ |
| 57 | #define RRCP_COOKIE1_OFFSET 10 /* 4 bytes */ |
| 58 | #define RRCP_COOKIE2_OFFSET 14 /* 4 bytes */ |
| 59 | |
| 60 | /* hello reply packets */ |
| 61 | #define RRCP_DOWNLINK_PORT_OFFSET 4 /* 1 byte */ |
| 62 | #define RRCP_UPLINK_PORT_OFFSET 5 /* 1 byte */ |
| 63 | #define RRCP_UPLINK_MAC_OFFSET 6 /* 6 byte MAC address */ |
| 64 | #define RRCP_CHIP_ID_OFFSET 12 /* 2 bytes */ |
| 65 | #define RRCP_VENDOR_ID_OFFSET 14 /* 4 bytes */ |
| 66 | |
| 67 | static const struct tok proto_values[] = { |
| 68 | { 1, "RRCP" }, |
| 69 | { 2, "RRCP-REP" }, |
| 70 | { 0, NULL } |
| 71 | }; |
| 72 | |
| 73 | static const struct tok opcode_values[] = { |
| 74 | { 0, "hello" }, |
| 75 | { 1, "get" }, |
| 76 | { 2, "set" }, |
| 77 | { 0, NULL } |
| 78 | }; |
| 79 | |
| 80 | /* |
| 81 | * Print RRCP requests |
| 82 | */ |
| 83 | void |
| 84 | rrcp_print(netdissect_options *ndo, |
| 85 | register const u_char *cp, |
| 86 | u_int length _U_) |
| 87 | { |
| 88 | const u_char *rrcp; |
| 89 | u_int8_t rrcp_proto; |
| 90 | u_int8_t rrcp_opcode; |
| 91 | register const struct ether_header *ep; |
| 92 | char proto_str[16]; |
| 93 | char opcode_str[32]; |
| 94 | |
| 95 | ep = (const struct ether_header *)cp; |
| 96 | rrcp = cp + ETHER_HDRLEN; |
| 97 | |
| 98 | ND_TCHECK(*(rrcp + RRCP_PROTO_OFFSET)); |
| 99 | rrcp_proto = *(rrcp + RRCP_PROTO_OFFSET); |
| 100 | ND_TCHECK(*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET)); |
| 101 | rrcp_opcode = (*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET)) & RRCP_OPCODE_MASK; |
| 102 | ND_PRINT((ndo, "%s > %s, %s %s", |
| 103 | etheraddr_string(ESRC(ep)), |
| 104 | etheraddr_string(EDST(ep)), |
| 105 | tok2strbuf(proto_values,"RRCP-0x%02x",rrcp_proto,proto_str,sizeof(proto_str)), |
| 106 | ((*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET)) & RRCP_ISREPLY) ? "reply" : "query")); |
| 107 | if (rrcp_proto==1){ |
| 108 | ND_PRINT((ndo, ": %s", |
| 109 | tok2strbuf(opcode_values,"unknown opcode (0x%02x)",rrcp_opcode,opcode_str,sizeof(opcode_str)))); |
| 110 | } |
| 111 | if (rrcp_opcode==1 || rrcp_opcode==2){ |
| 112 | ND_TCHECK2(*(rrcp + RRCP_REG_ADDR_OFFSET), 6); |
| 113 | ND_PRINT((ndo, " addr=0x%04x, data=0x%08x", |
| 114 | EXTRACT_LE_16BITS(rrcp + RRCP_REG_ADDR_OFFSET), |
| 115 | EXTRACT_LE_32BITS(rrcp + RRCP_REG_DATA_OFFSET))); |
| 116 | } |
| 117 | if (rrcp_proto==1){ |
| 118 | ND_TCHECK2(*(rrcp + RRCP_AUTHKEY_OFFSET), 2); |
| 119 | ND_PRINT((ndo, ", auth=0x%04x", |
| 120 | EXTRACT_16BITS(rrcp + RRCP_AUTHKEY_OFFSET))); |
| 121 | } |
| 122 | if (rrcp_proto==1 && rrcp_opcode==0 && |
| 123 | ((*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET)) & RRCP_ISREPLY)){ |
| 124 | ND_TCHECK2(*(rrcp + RRCP_VENDOR_ID_OFFSET), 4); |
| 125 | ND_PRINT((ndo, " downlink_port=%d, uplink_port=%d, uplink_mac=%s, vendor_id=%08x ,chip_id=%04x ", |
| 126 | *(rrcp + RRCP_DOWNLINK_PORT_OFFSET), |
| 127 | *(rrcp + RRCP_UPLINK_PORT_OFFSET), |
| 128 | etheraddr_string(rrcp + RRCP_UPLINK_MAC_OFFSET), |
| 129 | EXTRACT_32BITS(rrcp + RRCP_VENDOR_ID_OFFSET), |
| 130 | EXTRACT_16BITS(rrcp + RRCP_CHIP_ID_OFFSET))); |
| 131 | }else if (rrcp_opcode==1 || rrcp_opcode==2 || rrcp_proto==2){ |
| 132 | ND_TCHECK2(*(rrcp + RRCP_COOKIE2_OFFSET), 4); |
| 133 | ND_PRINT((ndo, ", cookie=0x%08x%08x ", |
| 134 | EXTRACT_32BITS(rrcp + RRCP_COOKIE2_OFFSET), |
| 135 | EXTRACT_32BITS(rrcp + RRCP_COOKIE1_OFFSET))); |
| 136 | } |
| 137 | if (!ndo->ndo_vflag) |
| 138 | return; |
| 139 | return; |
| 140 | |
| 141 | trunc: |
| 142 | ND_PRINT((ndo, "[|rrcp]")); |
| 143 | } |