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
rrcp_print(netdissect_options * ndo,register const u_char * cp,u_int length _U_)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