1 /* 2 * Copyright (c) 2007 - Andrey "nording" Chernyak <andrew (at) 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 } 144
