mirror of
https://github.com/the-tcpdump-group/tcpdump.git
synced 2024-11-28 04:25:16 +08:00
83236cce65
ndo_error, and ndo_warning function pointers in a netdissect_options structure. Fix some errors adding that caught. Have the RRCP dissector extract fields itself, with the EXTRACT_ macros and a u_char pointer, rather than printing numbers from a structure which doesn't put structure members on natural boundaries (__attribute__((packed)) doesn't help, as not all compilers support it) - note also that not all processors support dereferencing unaligned pointers, e.g. SPARC - and assuming some fields are in the "right" byte order. Also have it check whether data is available in the packet before referring to it.
146 lines
5.0 KiB
C
146 lines
5.0 KiB
C
/*
|
|
* Copyright (c) 2007 - Andrey "nording" Chernyak <andrew@nording.ru>
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that: (1) source code distributions
|
|
* retain the above copyright notice and this paragraph in its entirety, (2)
|
|
* distributions including binary code include the above copyright notice and
|
|
* this paragraph in its entirety in the documentation or other materials
|
|
* provided with the distribution, and (3) all advertising materials mentioning
|
|
* features or use of this software display the following acknowledgement:
|
|
* ``This product includes software developed by the University of California,
|
|
* Lawrence Berkeley Laboratory and its contributors.'' Neither the name of
|
|
* the University nor the names of its contributors may be used to endorse
|
|
* or promote products derived from this software without specific prior
|
|
* written permission.
|
|
* THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED
|
|
* WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
|
|
*
|
|
* Format and print Realtek Remote Control Protocol (RRCP)
|
|
* and Realtek Echo Protocol (RRCP-REP) packets.
|
|
*/
|
|
|
|
#ifndef lint
|
|
static const char rcsid[] _U_ =
|
|
"@(#) $Header: /tcpdump/master/tcpdump/print-rrcp.c,v 1.2 2008-04-11 17:21:34 gianluca Exp $";
|
|
#endif
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include <tcpdump-stdinc.h>
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
|
|
#include "netdissect.h"
|
|
#include "addrtoname.h"
|
|
#include "extract.h"
|
|
#include "ether.h"
|
|
|
|
#ifndef ETH_ALEN
|
|
#define ETH_ALEN 6
|
|
#endif
|
|
|
|
#define RRCP_OPCODE_MASK 0x7F /* 0x00 = hello, 0x01 = get, 0x02 = set */
|
|
#define RRCP_ISREPLY 0x80 /* 0 = request to switch, 0x80 = reply from switch */
|
|
|
|
#define RRCP_PROTO_OFFSET 0 /* proto - 1 byte, must be 1 */
|
|
#define RRCP_OPCODE_ISREPLY_OFFSET 1 /* opcode and isreply flag - 1 byte */
|
|
#define RRCP_AUTHKEY_OFFSET 2 /* authorization key - 2 bytes, 0x2379 by default */
|
|
|
|
/* most packets */
|
|
#define RRCP_REG_ADDR_OFFSET 4 /* register address - 2 bytes */
|
|
#define RRCP_REG_DATA_OFFSET 6 /* register data - 4 bytes */
|
|
#define RRCP_COOKIE1_OFFSET 10 /* 4 bytes */
|
|
#define RRCP_COOKIE2_OFFSET 14 /* 4 bytes */
|
|
|
|
/* hello reply packets */
|
|
#define RRCP_DOWNLINK_PORT_OFFSET 4 /* 1 byte */
|
|
#define RRCP_UPLINK_PORT_OFFSET 5 /* 1 byte */
|
|
#define RRCP_UPLINK_MAC_OFFSET 6 /* 6 byte MAC address */
|
|
#define RRCP_CHIP_ID_OFFSET 12 /* 2 bytes */
|
|
#define RRCP_VENDOR_ID_OFFSET 14 /* 4 bytes */
|
|
|
|
/*
|
|
* Print RRCP requests
|
|
*/
|
|
void
|
|
rrcp_print(netdissect_options *ndo,
|
|
register const u_char *cp,
|
|
u_int length _U_)
|
|
{
|
|
const u_char *rrcp;
|
|
u_int8_t rrcp_proto;
|
|
u_int8_t rrcp_opcode;
|
|
register const struct ether_header *ep;
|
|
char proto_str[16];
|
|
char opcode_str[32];
|
|
|
|
ep = (const struct ether_header *)cp;
|
|
rrcp = cp + ETHER_HDRLEN;
|
|
|
|
ND_TCHECK(*(rrcp + RRCP_PROTO_OFFSET));
|
|
rrcp_proto = *(rrcp + RRCP_PROTO_OFFSET);
|
|
if (rrcp_proto==1){
|
|
strcpy(proto_str,"RRCP");
|
|
}else if ( rrcp_proto==2 ){
|
|
strcpy(proto_str,"RRCP-REP");
|
|
}else{
|
|
sprintf(proto_str,"RRCP-0x%02d",rrcp_proto);
|
|
}
|
|
ND_TCHECK(*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET));
|
|
rrcp_opcode = (*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET)) & RRCP_OPCODE_MASK;
|
|
if (rrcp_opcode==0){
|
|
strcpy(opcode_str,"hello");
|
|
}else if ( rrcp_opcode==1 ){
|
|
strcpy(opcode_str,"get");
|
|
}else if ( rrcp_opcode==2 ){
|
|
strcpy(opcode_str,"set");
|
|
}else{
|
|
sprintf(opcode_str,"unknown opcode (0x%02d)",rrcp_opcode);
|
|
}
|
|
ND_PRINT((ndo, "%s > %s, %s %s",
|
|
etheraddr_string(ESRC(ep)),
|
|
etheraddr_string(EDST(ep)),
|
|
proto_str,
|
|
((*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET)) & RRCP_ISREPLY) ? "reply" : "query"));
|
|
if (rrcp_proto==1){
|
|
ND_PRINT((ndo, ": %s", opcode_str));
|
|
}
|
|
if (rrcp_opcode==1 || rrcp_opcode==2){
|
|
ND_TCHECK2(*(rrcp + RRCP_REG_ADDR_OFFSET), 6);
|
|
ND_PRINT((ndo, " addr=0x%04x, data=0x%08x",
|
|
EXTRACT_16BITS(rrcp + RRCP_REG_ADDR_OFFSET),
|
|
EXTRACT_32BITS(rrcp + RRCP_REG_DATA_OFFSET)));
|
|
}
|
|
if (rrcp_proto==1){
|
|
ND_TCHECK2(*(rrcp + RRCP_AUTHKEY_OFFSET), 2);
|
|
ND_PRINT((ndo, ", auth=0x%04x",
|
|
EXTRACT_16BITS(rrcp + RRCP_AUTHKEY_OFFSET)));
|
|
}
|
|
if (rrcp_proto==1 && rrcp_opcode==0 &&
|
|
((*(rrcp + RRCP_OPCODE_ISREPLY_OFFSET)) & RRCP_ISREPLY)){
|
|
ND_TCHECK2(*(rrcp + RRCP_VENDOR_ID_OFFSET), 4);
|
|
ND_PRINT((ndo, " downlink_port=%d, uplink_port=%d, uplink_mac=%s, vendor_id=%08x ,chip_id=%04x ",
|
|
*(rrcp + RRCP_DOWNLINK_PORT_OFFSET),
|
|
*(rrcp + RRCP_UPLINK_PORT_OFFSET),
|
|
etheraddr_string(rrcp + RRCP_UPLINK_MAC_OFFSET),
|
|
EXTRACT_32BITS(rrcp + RRCP_VENDOR_ID_OFFSET),
|
|
EXTRACT_16BITS(rrcp + RRCP_CHIP_ID_OFFSET)));
|
|
}else if (rrcp_opcode==1 || rrcp_opcode==2 || rrcp_proto==2){
|
|
ND_TCHECK2(*(rrcp + RRCP_COOKIE2_OFFSET), 4);
|
|
ND_PRINT((ndo, ", cookie=0x%08x%08x ",
|
|
EXTRACT_32BITS(rrcp + RRCP_COOKIE2_OFFSET),
|
|
EXTRACT_32BITS(rrcp + RRCP_COOKIE1_OFFSET)));
|
|
}
|
|
if (!ndo->ndo_vflag)
|
|
return;
|
|
return;
|
|
|
|
trunc:
|
|
ND_PRINT((ndo, "[|rrcp]"));
|
|
}
|