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#include <sys/cdefs.h>
25#ifndef lint
26#if 0
27static const char rcsid[] _U_ =
28    "@(#) Header: /tcpdump/master/tcpdump/print-rrcp.c,v 1.2 2008-04-11 17:21:34 gianluca Exp";
29#else
30__RCSID("$NetBSD$");
31#endif
32#endif
33
34#ifdef HAVE_CONFIG_H
35#include "config.h"
36#endif
37
38#include <tcpdump-stdinc.h>
39
40#include <stdio.h>
41#include <string.h>
42
43#include "netdissect.h"
44#include "addrtoname.h"
45#include "extract.h"
46#include "ether.h"
47
48#ifndef ETH_ALEN
49#define ETH_ALEN 6
50#endif
51
52#define RRCP_OPCODE_MASK	0x7F	/* 0x00 = hello, 0x01 = get, 0x02 = set */
53#define RRCP_ISREPLY		0x80	/* 0 = request to switch, 0x80 = reply from switch */
54
55#define RRCP_PROTO_OFFSET		0	/* proto - 1 byte, must be 1 */
56#define RRCP_OPCODE_ISREPLY_OFFSET	1	/* opcode and isreply flag - 1 byte */
57#define RRCP_AUTHKEY_OFFSET		2	/* authorization key - 2 bytes, 0x2379 by default */
58
59/* most packets */
60#define RRCP_REG_ADDR_OFFSET		4	/* register address - 2 bytes */
61#define RRCP_REG_DATA_OFFSET		6	/* register data - 4 bytes */
62#define RRCP_COOKIE1_OFFSET		10	/* 4 bytes */
63#define RRCP_COOKIE2_OFFSET		14	/* 4 bytes */
64
65/* hello reply packets */
66#define RRCP_DOWNLINK_PORT_OFFSET	4	/* 1 byte */
67#define RRCP_UPLINK_PORT_OFFSET		5	/* 1 byte */
68#define RRCP_UPLINK_MAC_OFFSET		6	/* 6 byte MAC address */
69#define RRCP_CHIP_ID_OFFSET		12	/* 2 bytes */
70#define RRCP_VENDOR_ID_OFFSET		14	/* 4 bytes */
71
72static const struct tok proto_values[] = {
73	{ 1, "RRCP" },
74	{ 2, "RRCP-REP" },
75	{ 0, NULL }
76};
77
78static const struct tok opcode_values[] = {
79	{ 0, "hello" },
80	{ 1, "get" },
81	{ 2, "set" },
82	{ 0, NULL }
83};
84
85/*
86 * Print RRCP requests
87 */
88void
89rrcp_print(netdissect_options *ndo,
90	  register const u_char *cp,
91	  u_int length _U_)
92{
93	const u_char *rrcp;
94	u_int8_t rrcp_proto;
95	u_int8_t rrcp_opcode;
96	register const struct ether_header *ep;
97	char proto_str[16];
98	char opcode_str[32];
99
100	ep = (const struct ether_header *)cp;
101	rrcp = cp + ETHER_HDRLEN;
102
103	ND_TCHECK(*(rrcp + RRCP_PROTO_OFFSET));
104	rrcp_proto = *(rrcp + RRCP_PROTO_OFFSET);
105	ND_TCHECK(*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET));
106	rrcp_opcode = (*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET)) & RRCP_OPCODE_MASK;
107        ND_PRINT((ndo, "%s > %s, %s %s",
108		etheraddr_string(ESRC(ep)),
109		etheraddr_string(EDST(ep)),
110		tok2strbuf(proto_values,"RRCP-0x%02d",rrcp_proto,proto_str,sizeof(proto_str)),
111		((*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET)) & RRCP_ISREPLY) ? "reply" : "query"));
112	if (rrcp_proto==1){
113    	    ND_PRINT((ndo, ": %s",
114		     tok2strbuf(opcode_values,"unknown opcode (0x%02d)",rrcp_opcode,opcode_str,sizeof(opcode_str))));
115	}
116	if (rrcp_opcode==1 || rrcp_opcode==2){
117	    ND_TCHECK2(*(rrcp + RRCP_REG_ADDR_OFFSET), 6);
118    	    ND_PRINT((ndo, " addr=0x%04x, data=0x%08x",
119		     EXTRACT_16BITS(rrcp + RRCP_REG_ADDR_OFFSET),
120		     EXTRACT_32BITS(rrcp + RRCP_REG_DATA_OFFSET)));
121	}
122	if (rrcp_proto==1){
123	    ND_TCHECK2(*(rrcp + RRCP_AUTHKEY_OFFSET), 2);
124    	    ND_PRINT((ndo, ", auth=0x%04x",
125		  EXTRACT_16BITS(rrcp + RRCP_AUTHKEY_OFFSET)));
126	}
127	if (rrcp_proto==1 && rrcp_opcode==0 &&
128	     ((*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET)) & RRCP_ISREPLY)){
129	    ND_TCHECK2(*(rrcp + RRCP_VENDOR_ID_OFFSET), 4);
130	    ND_PRINT((ndo, " downlink_port=%d, uplink_port=%d, uplink_mac=%s, vendor_id=%08x ,chip_id=%04x ",
131		     *(rrcp + RRCP_DOWNLINK_PORT_OFFSET),
132		     *(rrcp + RRCP_UPLINK_PORT_OFFSET),
133		     etheraddr_string(rrcp + RRCP_UPLINK_MAC_OFFSET),
134		     EXTRACT_32BITS(rrcp + RRCP_VENDOR_ID_OFFSET),
135		     EXTRACT_16BITS(rrcp + RRCP_CHIP_ID_OFFSET)));
136	}else if (rrcp_opcode==1 || rrcp_opcode==2 || rrcp_proto==2){
137	    ND_TCHECK2(*(rrcp + RRCP_COOKIE2_OFFSET), 4);
138	    ND_PRINT((ndo, ", cookie=0x%08x%08x ",
139		    EXTRACT_32BITS(rrcp + RRCP_COOKIE2_OFFSET),
140		    EXTRACT_32BITS(rrcp + RRCP_COOKIE1_OFFSET)));
141	}
142        if (!ndo->ndo_vflag)
143            return;
144	return;
145
146trunc:
147	ND_PRINT((ndo, "[|rrcp]"));
148}
149