1*b636d99dSDavid van Moolenbroek /* NetBSD: print-ascii.c,v 1.1 1999/09/30 14:49:12 sjg Exp */
2*b636d99dSDavid van Moolenbroek
3*b636d99dSDavid van Moolenbroek /*-
4*b636d99dSDavid van Moolenbroek * Copyright (c) 1997, 1998 The NetBSD Foundation, Inc.
5*b636d99dSDavid van Moolenbroek * All rights reserved.
6*b636d99dSDavid van Moolenbroek *
7*b636d99dSDavid van Moolenbroek * This code is derived from software contributed to The NetBSD Foundation
8*b636d99dSDavid van Moolenbroek * by Alan Barrett and Simon J. Gerraty.
9*b636d99dSDavid van Moolenbroek *
10*b636d99dSDavid van Moolenbroek * Redistribution and use in source and binary forms, with or without
11*b636d99dSDavid van Moolenbroek * modification, are permitted provided that the following conditions
12*b636d99dSDavid van Moolenbroek * are met:
13*b636d99dSDavid van Moolenbroek * 1. Redistributions of source code must retain the above copyright
14*b636d99dSDavid van Moolenbroek * notice, this list of conditions and the following disclaimer.
15*b636d99dSDavid van Moolenbroek * 2. Redistributions in binary form must reproduce the above copyright
16*b636d99dSDavid van Moolenbroek * notice, this list of conditions and the following disclaimer in the
17*b636d99dSDavid van Moolenbroek * documentation and/or other materials provided with the distribution.
18*b636d99dSDavid van Moolenbroek *
19*b636d99dSDavid van Moolenbroek * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
20*b636d99dSDavid van Moolenbroek * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
21*b636d99dSDavid van Moolenbroek * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
22*b636d99dSDavid van Moolenbroek * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
23*b636d99dSDavid van Moolenbroek * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
24*b636d99dSDavid van Moolenbroek * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
25*b636d99dSDavid van Moolenbroek * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
26*b636d99dSDavid van Moolenbroek * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
27*b636d99dSDavid van Moolenbroek * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
28*b636d99dSDavid van Moolenbroek * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
29*b636d99dSDavid van Moolenbroek * POSSIBILITY OF SUCH DAMAGE.
30*b636d99dSDavid van Moolenbroek */
31*b636d99dSDavid van Moolenbroek
32*b636d99dSDavid van Moolenbroek #include <sys/cdefs.h>
33*b636d99dSDavid van Moolenbroek #ifndef lint
34*b636d99dSDavid van Moolenbroek __RCSID("$NetBSD: print-ascii.c,v 1.5 2015/03/31 21:59:35 christos Exp $");
35*b636d99dSDavid van Moolenbroek #endif
36*b636d99dSDavid van Moolenbroek
37*b636d99dSDavid van Moolenbroek #define NETDISSECT_REWORKED
38*b636d99dSDavid van Moolenbroek #ifdef HAVE_CONFIG_H
39*b636d99dSDavid van Moolenbroek #include "config.h"
40*b636d99dSDavid van Moolenbroek #endif
41*b636d99dSDavid van Moolenbroek
42*b636d99dSDavid van Moolenbroek #include <tcpdump-stdinc.h>
43*b636d99dSDavid van Moolenbroek #include <stdio.h>
44*b636d99dSDavid van Moolenbroek
45*b636d99dSDavid van Moolenbroek #include "interface.h"
46*b636d99dSDavid van Moolenbroek
47*b636d99dSDavid van Moolenbroek #define ASCII_LINELENGTH 300
48*b636d99dSDavid van Moolenbroek #define HEXDUMP_BYTES_PER_LINE 16
49*b636d99dSDavid van Moolenbroek #define HEXDUMP_SHORTS_PER_LINE (HEXDUMP_BYTES_PER_LINE / 2)
50*b636d99dSDavid van Moolenbroek #define HEXDUMP_HEXSTUFF_PER_SHORT 5 /* 4 hex digits and a space */
51*b636d99dSDavid van Moolenbroek #define HEXDUMP_HEXSTUFF_PER_LINE \
52*b636d99dSDavid van Moolenbroek (HEXDUMP_HEXSTUFF_PER_SHORT * HEXDUMP_SHORTS_PER_LINE)
53*b636d99dSDavid van Moolenbroek
54*b636d99dSDavid van Moolenbroek void
ascii_print(netdissect_options * ndo,const u_char * cp,u_int length)55*b636d99dSDavid van Moolenbroek ascii_print(netdissect_options *ndo,
56*b636d99dSDavid van Moolenbroek const u_char *cp, u_int length)
57*b636d99dSDavid van Moolenbroek {
58*b636d99dSDavid van Moolenbroek u_int caplength;
59*b636d99dSDavid van Moolenbroek register u_char s;
60*b636d99dSDavid van Moolenbroek
61*b636d99dSDavid van Moolenbroek caplength = (ndo->ndo_snapend >= cp) ? ndo->ndo_snapend - cp : 0;
62*b636d99dSDavid van Moolenbroek if (length > caplength)
63*b636d99dSDavid van Moolenbroek length = caplength;
64*b636d99dSDavid van Moolenbroek ND_PRINT((ndo, "\n"));
65*b636d99dSDavid van Moolenbroek while (length > 0) {
66*b636d99dSDavid van Moolenbroek s = *cp++;
67*b636d99dSDavid van Moolenbroek length--;
68*b636d99dSDavid van Moolenbroek if (s == '\r') {
69*b636d99dSDavid van Moolenbroek /*
70*b636d99dSDavid van Moolenbroek * Don't print CRs at the end of the line; they
71*b636d99dSDavid van Moolenbroek * don't belong at the ends of lines on UN*X,
72*b636d99dSDavid van Moolenbroek * and the standard I/O library will give us one
73*b636d99dSDavid van Moolenbroek * on Windows so we don't need to print one
74*b636d99dSDavid van Moolenbroek * ourselves.
75*b636d99dSDavid van Moolenbroek *
76*b636d99dSDavid van Moolenbroek * In the middle of a line, just print a '.'.
77*b636d99dSDavid van Moolenbroek */
78*b636d99dSDavid van Moolenbroek if (length > 1 && *cp != '\n')
79*b636d99dSDavid van Moolenbroek ND_PRINT((ndo, "."));
80*b636d99dSDavid van Moolenbroek } else {
81*b636d99dSDavid van Moolenbroek if (!ND_ISGRAPH(s) &&
82*b636d99dSDavid van Moolenbroek (s != '\t' && s != ' ' && s != '\n'))
83*b636d99dSDavid van Moolenbroek ND_PRINT((ndo, "."));
84*b636d99dSDavid van Moolenbroek else
85*b636d99dSDavid van Moolenbroek ND_PRINT((ndo, "%c", s));
86*b636d99dSDavid van Moolenbroek }
87*b636d99dSDavid van Moolenbroek }
88*b636d99dSDavid van Moolenbroek }
89*b636d99dSDavid van Moolenbroek
90*b636d99dSDavid van Moolenbroek void
hex_and_ascii_print_with_offset(netdissect_options * ndo,register const char * ident,register const u_char * cp,register u_int length,register u_int oset)91*b636d99dSDavid van Moolenbroek hex_and_ascii_print_with_offset(netdissect_options *ndo, register const char *ident,
92*b636d99dSDavid van Moolenbroek register const u_char *cp, register u_int length, register u_int oset)
93*b636d99dSDavid van Moolenbroek {
94*b636d99dSDavid van Moolenbroek u_int caplength;
95*b636d99dSDavid van Moolenbroek register u_int i;
96*b636d99dSDavid van Moolenbroek register int s1, s2;
97*b636d99dSDavid van Moolenbroek register int nshorts;
98*b636d99dSDavid van Moolenbroek char hexstuff[HEXDUMP_SHORTS_PER_LINE*HEXDUMP_HEXSTUFF_PER_SHORT+1], *hsp;
99*b636d99dSDavid van Moolenbroek char asciistuff[ASCII_LINELENGTH+1], *asp;
100*b636d99dSDavid van Moolenbroek
101*b636d99dSDavid van Moolenbroek caplength = (ndo->ndo_snapend >= cp) ? ndo->ndo_snapend - cp : 0;
102*b636d99dSDavid van Moolenbroek if (length > caplength)
103*b636d99dSDavid van Moolenbroek length = caplength;
104*b636d99dSDavid van Moolenbroek nshorts = length / sizeof(u_short);
105*b636d99dSDavid van Moolenbroek i = 0;
106*b636d99dSDavid van Moolenbroek hsp = hexstuff; asp = asciistuff;
107*b636d99dSDavid van Moolenbroek while (--nshorts >= 0) {
108*b636d99dSDavid van Moolenbroek s1 = *cp++;
109*b636d99dSDavid van Moolenbroek s2 = *cp++;
110*b636d99dSDavid van Moolenbroek (void)snprintf(hsp, sizeof(hexstuff) - (hsp - hexstuff),
111*b636d99dSDavid van Moolenbroek " %02x%02x", s1, s2);
112*b636d99dSDavid van Moolenbroek hsp += HEXDUMP_HEXSTUFF_PER_SHORT;
113*b636d99dSDavid van Moolenbroek *(asp++) = (ND_ISGRAPH(s1) ? s1 : '.');
114*b636d99dSDavid van Moolenbroek *(asp++) = (ND_ISGRAPH(s2) ? s2 : '.');
115*b636d99dSDavid van Moolenbroek i++;
116*b636d99dSDavid van Moolenbroek if (i >= HEXDUMP_SHORTS_PER_LINE) {
117*b636d99dSDavid van Moolenbroek *hsp = *asp = '\0';
118*b636d99dSDavid van Moolenbroek ND_PRINT((ndo, "%s0x%04x: %-*s %s",
119*b636d99dSDavid van Moolenbroek ident, oset, HEXDUMP_HEXSTUFF_PER_LINE,
120*b636d99dSDavid van Moolenbroek hexstuff, asciistuff));
121*b636d99dSDavid van Moolenbroek i = 0; hsp = hexstuff; asp = asciistuff;
122*b636d99dSDavid van Moolenbroek oset += HEXDUMP_BYTES_PER_LINE;
123*b636d99dSDavid van Moolenbroek }
124*b636d99dSDavid van Moolenbroek }
125*b636d99dSDavid van Moolenbroek if (length & 1) {
126*b636d99dSDavid van Moolenbroek s1 = *cp++;
127*b636d99dSDavid van Moolenbroek (void)snprintf(hsp, sizeof(hexstuff) - (hsp - hexstuff),
128*b636d99dSDavid van Moolenbroek " %02x", s1);
129*b636d99dSDavid van Moolenbroek hsp += 3;
130*b636d99dSDavid van Moolenbroek *(asp++) = (ND_ISGRAPH(s1) ? s1 : '.');
131*b636d99dSDavid van Moolenbroek ++i;
132*b636d99dSDavid van Moolenbroek }
133*b636d99dSDavid van Moolenbroek if (i > 0) {
134*b636d99dSDavid van Moolenbroek *hsp = *asp = '\0';
135*b636d99dSDavid van Moolenbroek ND_PRINT((ndo, "%s0x%04x: %-*s %s",
136*b636d99dSDavid van Moolenbroek ident, oset, HEXDUMP_HEXSTUFF_PER_LINE,
137*b636d99dSDavid van Moolenbroek hexstuff, asciistuff));
138*b636d99dSDavid van Moolenbroek }
139*b636d99dSDavid van Moolenbroek }
140*b636d99dSDavid van Moolenbroek
141*b636d99dSDavid van Moolenbroek void
hex_and_ascii_print(netdissect_options * ndo,register const char * ident,register const u_char * cp,register u_int length)142*b636d99dSDavid van Moolenbroek hex_and_ascii_print(netdissect_options *ndo, register const char *ident,
143*b636d99dSDavid van Moolenbroek register const u_char *cp, register u_int length)
144*b636d99dSDavid van Moolenbroek {
145*b636d99dSDavid van Moolenbroek hex_and_ascii_print_with_offset(ndo, ident, cp, length, 0);
146*b636d99dSDavid van Moolenbroek }
147*b636d99dSDavid van Moolenbroek
148*b636d99dSDavid van Moolenbroek /*
149*b636d99dSDavid van Moolenbroek * telnet_print() wants this. It is essentially default_print_unaligned()
150*b636d99dSDavid van Moolenbroek */
151*b636d99dSDavid van Moolenbroek void
hex_print_with_offset(netdissect_options * ndo,const char * ident,const u_char * cp,u_int length,u_int oset)152*b636d99dSDavid van Moolenbroek hex_print_with_offset(netdissect_options *ndo,
153*b636d99dSDavid van Moolenbroek const char *ident, const u_char *cp, u_int length,
154*b636d99dSDavid van Moolenbroek u_int oset)
155*b636d99dSDavid van Moolenbroek {
156*b636d99dSDavid van Moolenbroek u_int caplength;
157*b636d99dSDavid van Moolenbroek register u_int i, s;
158*b636d99dSDavid van Moolenbroek register int nshorts;
159*b636d99dSDavid van Moolenbroek
160*b636d99dSDavid van Moolenbroek caplength = (ndo->ndo_snapend >= cp) ? ndo->ndo_snapend - cp : 0;
161*b636d99dSDavid van Moolenbroek if (length > caplength)
162*b636d99dSDavid van Moolenbroek length = caplength;
163*b636d99dSDavid van Moolenbroek nshorts = (u_int) length / sizeof(u_short);
164*b636d99dSDavid van Moolenbroek i = 0;
165*b636d99dSDavid van Moolenbroek while (--nshorts >= 0) {
166*b636d99dSDavid van Moolenbroek if ((i++ % 8) == 0) {
167*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"%s0x%04x: ", ident, oset));
168*b636d99dSDavid van Moolenbroek oset += HEXDUMP_BYTES_PER_LINE;
169*b636d99dSDavid van Moolenbroek }
170*b636d99dSDavid van Moolenbroek s = *cp++;
171*b636d99dSDavid van Moolenbroek ND_PRINT((ndo," %02x%02x", s, *cp++));
172*b636d99dSDavid van Moolenbroek }
173*b636d99dSDavid van Moolenbroek if (length & 1) {
174*b636d99dSDavid van Moolenbroek if ((i % 8) == 0)
175*b636d99dSDavid van Moolenbroek ND_PRINT((ndo,"%s0x%04x: ", ident, oset));
176*b636d99dSDavid van Moolenbroek ND_PRINT((ndo," %02x", *cp));
177*b636d99dSDavid van Moolenbroek }
178*b636d99dSDavid van Moolenbroek }
179*b636d99dSDavid van Moolenbroek
180*b636d99dSDavid van Moolenbroek /*
181*b636d99dSDavid van Moolenbroek * just for completeness
182*b636d99dSDavid van Moolenbroek */
183*b636d99dSDavid van Moolenbroek void
hex_print(netdissect_options * ndo,const char * ident,const u_char * cp,u_int length)184*b636d99dSDavid van Moolenbroek hex_print(netdissect_options *ndo,const char *ident, const u_char *cp, u_int length)
185*b636d99dSDavid van Moolenbroek {
186*b636d99dSDavid van Moolenbroek hex_print_with_offset(ndo, ident, cp, length, 0);
187*b636d99dSDavid van Moolenbroek }
188*b636d99dSDavid van Moolenbroek
189*b636d99dSDavid van Moolenbroek #ifdef MAIN
190*b636d99dSDavid van Moolenbroek int
main(int argc,char * argv[])191*b636d99dSDavid van Moolenbroek main(int argc, char *argv[])
192*b636d99dSDavid van Moolenbroek {
193*b636d99dSDavid van Moolenbroek hex_print("\n\t", "Hello, World!\n", 14);
194*b636d99dSDavid van Moolenbroek printf("\n");
195*b636d99dSDavid van Moolenbroek hex_and_ascii_print("\n\t", "Hello, World!\n", 14);
196*b636d99dSDavid van Moolenbroek printf("\n");
197*b636d99dSDavid van Moolenbroek ascii_print("Hello, World!\n", 14);
198*b636d99dSDavid van Moolenbroek printf("\n");
199*b636d99dSDavid van Moolenbroek #define TMSG "Now is the winter of our discontent...\n"
200*b636d99dSDavid van Moolenbroek hex_print_with_offset("\n\t", TMSG, sizeof(TMSG) - 1, 0x100);
201*b636d99dSDavid van Moolenbroek printf("\n");
202*b636d99dSDavid van Moolenbroek hex_and_ascii_print_with_offset("\n\t", TMSG, sizeof(TMSG) - 1, 0x100);
203*b636d99dSDavid van Moolenbroek printf("\n");
204*b636d99dSDavid van Moolenbroek exit(0);
205*b636d99dSDavid van Moolenbroek }
206*b636d99dSDavid van Moolenbroek #endif /* MAIN */
207