1190203Srpaulo/* 2190203Srpaulo * Copyright (c) 1998-2007 The TCPDUMP project 3190203Srpaulo * 4190203Srpaulo * Redistribution and use in source and binary forms, with or without 5190203Srpaulo * modification, are permitted provided that: (1) source code 6190203Srpaulo * distributions retain the above copyright notice and this paragraph 7190203Srpaulo * in its entirety, and (2) distributions including binary code include 8190203Srpaulo * the above copyright notice and this paragraph in its entirety in 9190203Srpaulo * the documentation or other materials provided with the distribution. 10190203Srpaulo * THIS SOFTWARE IS PROVIDED ``AS IS'' AND 11190203Srpaulo * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT 12190203Srpaulo * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 13190203Srpaulo * FOR A PARTICULAR PURPOSE. 14190203Srpaulo * 15190203Srpaulo * UNIDIRECTIONAL LINK DETECTION (UDLD) as per 16190203Srpaulo * http://www.ietf.org/internet-drafts/draft-foschiano-udld-02.txt 17190203Srpaulo * 18190203Srpaulo * Original code by Carles Kishimoto <carles.kishimoto@gmail.com> 19190203Srpaulo */ 20190203Srpaulo 21190203Srpaulo#ifdef HAVE_CONFIG_H 22190203Srpaulo#include "config.h" 23190203Srpaulo#endif 24190203Srpaulo 25190203Srpaulo#include <tcpdump-stdinc.h> 26190203Srpaulo 27190203Srpaulo#include <stdio.h> 28190203Srpaulo#include <string.h> 29190203Srpaulo 30190203Srpaulo#include "interface.h" 31190203Srpaulo#include "addrtoname.h" 32190203Srpaulo#include "extract.h" 33190203Srpaulo#include "nlpid.h" 34190203Srpaulo 35190203Srpaulo#define UDLD_HEADER_LEN 4 36190203Srpaulo#define UDLD_DEVICE_ID_TLV 0x0001 37190203Srpaulo#define UDLD_PORT_ID_TLV 0x0002 38190203Srpaulo#define UDLD_ECHO_TLV 0x0003 39190203Srpaulo#define UDLD_MESSAGE_INTERVAL_TLV 0x0004 40190203Srpaulo#define UDLD_TIMEOUT_INTERVAL_TLV 0x0005 41190203Srpaulo#define UDLD_DEVICE_NAME_TLV 0x0006 42190203Srpaulo#define UDLD_SEQ_NUMBER_TLV 0x0007 43190203Srpaulo 44190203Srpaulostatic struct tok udld_tlv_values[] = { 45190203Srpaulo { UDLD_DEVICE_ID_TLV, "Device-ID TLV"}, 46190203Srpaulo { UDLD_PORT_ID_TLV, "Port-ID TLV"}, 47190203Srpaulo { UDLD_ECHO_TLV, "Echo TLV"}, 48190203Srpaulo { UDLD_MESSAGE_INTERVAL_TLV, "Message Interval TLV"}, 49190203Srpaulo { UDLD_TIMEOUT_INTERVAL_TLV, "Timeout Interval TLV"}, 50190203Srpaulo { UDLD_DEVICE_NAME_TLV, "Device Name TLV"}, 51190203Srpaulo { UDLD_SEQ_NUMBER_TLV,"Sequence Number TLV"}, 52190203Srpaulo { 0, NULL} 53190203Srpaulo}; 54190203Srpaulo 55190203Srpaulostatic struct tok udld_code_values[] = { 56190203Srpaulo { 0x00, "Reserved"}, 57190203Srpaulo { 0x01, "Probe message"}, 58190203Srpaulo { 0x02, "Echo message"}, 59190203Srpaulo { 0x03, "Flush message"}, 60190203Srpaulo { 0, NULL} 61190203Srpaulo}; 62190203Srpaulo 63190203Srpaulostatic struct tok udld_flags_values[] = { 64190203Srpaulo { 0x00, "RT"}, 65190203Srpaulo { 0x01, "RSY"}, 66190203Srpaulo { 0, NULL} 67190203Srpaulo}; 68190203Srpaulo 69190203Srpaulo/* 70190203Srpaulo * 71190203Srpaulo * 0 1 2 3 72190203Srpaulo * 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 2 3 4 5 6 7 8 9 0 1 73190203Srpaulo * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 74190203Srpaulo * | Ver | Opcode | Flags | Checksum | 75190203Srpaulo * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 76190203Srpaulo * | List of TLVs (variable length list) | 77190203Srpaulo * | ... | 78190203Srpaulo * +-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+ 79190203Srpaulo * 80190203Srpaulo */ 81190203Srpaulo 82190203Srpaulo#define UDLD_EXTRACT_VERSION(x) (((x)&0xe0)>>5) 83190203Srpaulo#define UDLD_EXTRACT_OPCODE(x) ((x)&0x1f) 84190203Srpaulo 85190203Srpaulovoid 86190203Srpauloudld_print (const u_char *pptr, u_int length) 87190203Srpaulo{ 88190203Srpaulo int code, type, len; 89190203Srpaulo const u_char *tptr; 90190203Srpaulo 91190203Srpaulo if (length < UDLD_HEADER_LEN) 92190203Srpaulo goto trunc; 93190203Srpaulo 94190203Srpaulo tptr = pptr; 95190203Srpaulo 96190203Srpaulo if (!TTEST2(*tptr, UDLD_HEADER_LEN)) 97190203Srpaulo goto trunc; 98190203Srpaulo 99190203Srpaulo code = UDLD_EXTRACT_OPCODE(*tptr); 100190203Srpaulo 101190203Srpaulo printf("UDLDv%u, Code %s (%x), Flags [%s] (0x%02x), length %u", 102190203Srpaulo UDLD_EXTRACT_VERSION(*tptr), 103190203Srpaulo tok2str(udld_code_values, "Reserved", code), 104190203Srpaulo code, 105190203Srpaulo bittok2str(udld_flags_values, "none", *(tptr+1)), 106190203Srpaulo *(tptr+1), 107190203Srpaulo length); 108190203Srpaulo 109190203Srpaulo /* 110190203Srpaulo * In non-verbose mode, just print version and opcode type 111190203Srpaulo */ 112190203Srpaulo if (vflag < 1) { 113190203Srpaulo return; 114190203Srpaulo } 115190203Srpaulo 116190203Srpaulo printf("\n\tChecksum 0x%04x (unverified)", EXTRACT_16BITS(tptr+2)); 117190203Srpaulo 118190203Srpaulo tptr += UDLD_HEADER_LEN; 119190203Srpaulo 120190203Srpaulo while (tptr < (pptr+length)) { 121190203Srpaulo 122190203Srpaulo if (!TTEST2(*tptr, 4)) 123190203Srpaulo goto trunc; 124190203Srpaulo 125190203Srpaulo type = EXTRACT_16BITS(tptr); 126190203Srpaulo len = EXTRACT_16BITS(tptr+2); 127190203Srpaulo len -= 4; 128190203Srpaulo tptr += 4; 129190203Srpaulo 130190203Srpaulo /* infinite loop check */ 131190203Srpaulo if (type == 0 || len == 0) { 132190203Srpaulo return; 133190203Srpaulo } 134190203Srpaulo 135190203Srpaulo printf("\n\t%s (0x%04x) TLV, length %u", 136190203Srpaulo tok2str(udld_tlv_values, "Unknown", type), 137190203Srpaulo type, len); 138190203Srpaulo 139190203Srpaulo switch (type) { 140190203Srpaulo case UDLD_DEVICE_ID_TLV: 141190203Srpaulo case UDLD_PORT_ID_TLV: 142190203Srpaulo case UDLD_ECHO_TLV: 143190203Srpaulo case UDLD_DEVICE_NAME_TLV: 144190203Srpaulo printf(", %s", tptr); 145190203Srpaulo break; 146190203Srpaulo 147190203Srpaulo case UDLD_MESSAGE_INTERVAL_TLV: 148190203Srpaulo case UDLD_TIMEOUT_INTERVAL_TLV: 149190203Srpaulo printf(", %us", (*tptr)); 150190203Srpaulo break; 151190203Srpaulo 152190203Srpaulo case UDLD_SEQ_NUMBER_TLV: 153190203Srpaulo printf(", %u", EXTRACT_32BITS(tptr)); 154190203Srpaulo break; 155190203Srpaulo 156190203Srpaulo default: 157190203Srpaulo break; 158190203Srpaulo } 159190203Srpaulo tptr += len; 160190203Srpaulo } 161190203Srpaulo 162190203Srpaulo return; 163190203Srpaulo 164190203Srpaulo trunc: 165190203Srpaulo printf("[|udld]"); 166190203Srpaulo} 167190203Srpaulo 168190203Srpaulo/* 169190203Srpaulo * Local Variables: 170190203Srpaulo * c-style: whitesmith 171190203Srpaulo * c-basic-offset: 4 172190203Srpaulo * End: 173190203Srpaulo */ 174