xref: /minix3/external/bsd/tcpdump/dist/checksum.c (revision b636d99d91c3d54204248f643c14627405d4afd1)
1*b636d99dSDavid van Moolenbroek /*
2*b636d99dSDavid van Moolenbroek  * Copyright (c) 1998-2006 The TCPDUMP project
3*b636d99dSDavid van Moolenbroek  *
4*b636d99dSDavid van Moolenbroek  * Redistribution and use in source and binary forms, with or without
5*b636d99dSDavid van Moolenbroek  * modification, are permitted provided that: (1) source code
6*b636d99dSDavid van Moolenbroek  * distributions retain the above copyright notice and this paragraph
7*b636d99dSDavid van Moolenbroek  * in its entirety, and (2) distributions including binary code include
8*b636d99dSDavid van Moolenbroek  * the above copyright notice and this paragraph in its entirety in
9*b636d99dSDavid van Moolenbroek  * the documentation or other materials provided with the distribution.
10*b636d99dSDavid van Moolenbroek  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND
11*b636d99dSDavid van Moolenbroek  * WITHOUT ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, WITHOUT
12*b636d99dSDavid van Moolenbroek  * LIMITATION, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
13*b636d99dSDavid van Moolenbroek  * FOR A PARTICULAR PURPOSE.
14*b636d99dSDavid van Moolenbroek  *
15*b636d99dSDavid van Moolenbroek  * miscellaneous checksumming routines
16*b636d99dSDavid van Moolenbroek  *
17*b636d99dSDavid van Moolenbroek  * Original code by Hannes Gredler (hannes@juniper.net)
18*b636d99dSDavid van Moolenbroek  */
19*b636d99dSDavid van Moolenbroek 
20*b636d99dSDavid van Moolenbroek #include <sys/cdefs.h>
21*b636d99dSDavid van Moolenbroek #ifndef lint
22*b636d99dSDavid van Moolenbroek __RCSID("$NetBSD: checksum.c,v 1.5 2014/11/20 03:05:03 christos Exp $");
23*b636d99dSDavid van Moolenbroek #endif
24*b636d99dSDavid van Moolenbroek 
25*b636d99dSDavid van Moolenbroek #define NETDISSECT_REWORKED
26*b636d99dSDavid van Moolenbroek #ifdef HAVE_CONFIG_H
27*b636d99dSDavid van Moolenbroek #include "config.h"
28*b636d99dSDavid van Moolenbroek #endif
29*b636d99dSDavid van Moolenbroek 
30*b636d99dSDavid van Moolenbroek #include <tcpdump-stdinc.h>
31*b636d99dSDavid van Moolenbroek 
32*b636d99dSDavid van Moolenbroek #include <stdio.h>
33*b636d99dSDavid van Moolenbroek #include <stdlib.h>
34*b636d99dSDavid van Moolenbroek #include <string.h>
35*b636d99dSDavid van Moolenbroek #include <assert.h>
36*b636d99dSDavid van Moolenbroek 
37*b636d99dSDavid van Moolenbroek #include "interface.h"
38*b636d99dSDavid van Moolenbroek 
39*b636d99dSDavid van Moolenbroek /*
40*b636d99dSDavid van Moolenbroek  * CRC-10 table generated using the following Python snippet:
41*b636d99dSDavid van Moolenbroek 
42*b636d99dSDavid van Moolenbroek import sys
43*b636d99dSDavid van Moolenbroek 
44*b636d99dSDavid van Moolenbroek crc_table = []
45*b636d99dSDavid van Moolenbroek for i in range(256):
46*b636d99dSDavid van Moolenbroek 	accum = i << 2
47*b636d99dSDavid van Moolenbroek 	for j in range(8):
48*b636d99dSDavid van Moolenbroek 		accum <<= 1
49*b636d99dSDavid van Moolenbroek 		if accum & 0x400:
50*b636d99dSDavid van Moolenbroek 			accum ^= 0x633
51*b636d99dSDavid van Moolenbroek 	crc_table.append(accum)
52*b636d99dSDavid van Moolenbroek 
53*b636d99dSDavid van Moolenbroek for i in range(len(crc_table)/8):
54*b636d99dSDavid van Moolenbroek 	for j in range(8):
55*b636d99dSDavid van Moolenbroek 		sys.stdout.write("0x%04x, " % crc_table[i*8+j])
56*b636d99dSDavid van Moolenbroek 	sys.stdout.write("\n")
57*b636d99dSDavid van Moolenbroek 
58*b636d99dSDavid van Moolenbroek  */
59*b636d99dSDavid van Moolenbroek static const uint16_t crc10_table[256] =
60*b636d99dSDavid van Moolenbroek {
61*b636d99dSDavid van Moolenbroek 	0x0000, 0x0233, 0x0255, 0x0066, 0x0299, 0x00aa, 0x00cc, 0x02ff,
62*b636d99dSDavid van Moolenbroek 	0x0301, 0x0132, 0x0154, 0x0367, 0x0198, 0x03ab, 0x03cd, 0x01fe,
63*b636d99dSDavid van Moolenbroek 	0x0031, 0x0202, 0x0264, 0x0057, 0x02a8, 0x009b, 0x00fd, 0x02ce,
64*b636d99dSDavid van Moolenbroek 	0x0330, 0x0103, 0x0165, 0x0356, 0x01a9, 0x039a, 0x03fc, 0x01cf,
65*b636d99dSDavid van Moolenbroek 	0x0062, 0x0251, 0x0237, 0x0004, 0x02fb, 0x00c8, 0x00ae, 0x029d,
66*b636d99dSDavid van Moolenbroek 	0x0363, 0x0150, 0x0136, 0x0305, 0x01fa, 0x03c9, 0x03af, 0x019c,
67*b636d99dSDavid van Moolenbroek 	0x0053, 0x0260, 0x0206, 0x0035, 0x02ca, 0x00f9, 0x009f, 0x02ac,
68*b636d99dSDavid van Moolenbroek 	0x0352, 0x0161, 0x0107, 0x0334, 0x01cb, 0x03f8, 0x039e, 0x01ad,
69*b636d99dSDavid van Moolenbroek 	0x00c4, 0x02f7, 0x0291, 0x00a2, 0x025d, 0x006e, 0x0008, 0x023b,
70*b636d99dSDavid van Moolenbroek 	0x03c5, 0x01f6, 0x0190, 0x03a3, 0x015c, 0x036f, 0x0309, 0x013a,
71*b636d99dSDavid van Moolenbroek 	0x00f5, 0x02c6, 0x02a0, 0x0093, 0x026c, 0x005f, 0x0039, 0x020a,
72*b636d99dSDavid van Moolenbroek 	0x03f4, 0x01c7, 0x01a1, 0x0392, 0x016d, 0x035e, 0x0338, 0x010b,
73*b636d99dSDavid van Moolenbroek 	0x00a6, 0x0295, 0x02f3, 0x00c0, 0x023f, 0x000c, 0x006a, 0x0259,
74*b636d99dSDavid van Moolenbroek 	0x03a7, 0x0194, 0x01f2, 0x03c1, 0x013e, 0x030d, 0x036b, 0x0158,
75*b636d99dSDavid van Moolenbroek 	0x0097, 0x02a4, 0x02c2, 0x00f1, 0x020e, 0x003d, 0x005b, 0x0268,
76*b636d99dSDavid van Moolenbroek 	0x0396, 0x01a5, 0x01c3, 0x03f0, 0x010f, 0x033c, 0x035a, 0x0169,
77*b636d99dSDavid van Moolenbroek 	0x0188, 0x03bb, 0x03dd, 0x01ee, 0x0311, 0x0122, 0x0144, 0x0377,
78*b636d99dSDavid van Moolenbroek 	0x0289, 0x00ba, 0x00dc, 0x02ef, 0x0010, 0x0223, 0x0245, 0x0076,
79*b636d99dSDavid van Moolenbroek 	0x01b9, 0x038a, 0x03ec, 0x01df, 0x0320, 0x0113, 0x0175, 0x0346,
80*b636d99dSDavid van Moolenbroek 	0x02b8, 0x008b, 0x00ed, 0x02de, 0x0021, 0x0212, 0x0274, 0x0047,
81*b636d99dSDavid van Moolenbroek 	0x01ea, 0x03d9, 0x03bf, 0x018c, 0x0373, 0x0140, 0x0126, 0x0315,
82*b636d99dSDavid van Moolenbroek 	0x02eb, 0x00d8, 0x00be, 0x028d, 0x0072, 0x0241, 0x0227, 0x0014,
83*b636d99dSDavid van Moolenbroek 	0x01db, 0x03e8, 0x038e, 0x01bd, 0x0342, 0x0171, 0x0117, 0x0324,
84*b636d99dSDavid van Moolenbroek 	0x02da, 0x00e9, 0x008f, 0x02bc, 0x0043, 0x0270, 0x0216, 0x0025,
85*b636d99dSDavid van Moolenbroek 	0x014c, 0x037f, 0x0319, 0x012a, 0x03d5, 0x01e6, 0x0180, 0x03b3,
86*b636d99dSDavid van Moolenbroek 	0x024d, 0x007e, 0x0018, 0x022b, 0x00d4, 0x02e7, 0x0281, 0x00b2,
87*b636d99dSDavid van Moolenbroek 	0x017d, 0x034e, 0x0328, 0x011b, 0x03e4, 0x01d7, 0x01b1, 0x0382,
88*b636d99dSDavid van Moolenbroek 	0x027c, 0x004f, 0x0029, 0x021a, 0x00e5, 0x02d6, 0x02b0, 0x0083,
89*b636d99dSDavid van Moolenbroek 	0x012e, 0x031d, 0x037b, 0x0148, 0x03b7, 0x0184, 0x01e2, 0x03d1,
90*b636d99dSDavid van Moolenbroek 	0x022f, 0x001c, 0x007a, 0x0249, 0x00b6, 0x0285, 0x02e3, 0x00d0,
91*b636d99dSDavid van Moolenbroek 	0x011f, 0x032c, 0x034a, 0x0179, 0x0386, 0x01b5, 0x01d3, 0x03e0,
92*b636d99dSDavid van Moolenbroek 	0x021e, 0x002d, 0x004b, 0x0278, 0x0087, 0x02b4, 0x02d2, 0x00e1
93*b636d99dSDavid van Moolenbroek };
94*b636d99dSDavid van Moolenbroek 
95*b636d99dSDavid van Moolenbroek static void
init_crc10_table(void)96*b636d99dSDavid van Moolenbroek init_crc10_table(void)
97*b636d99dSDavid van Moolenbroek {
98*b636d99dSDavid van Moolenbroek #define CRC10_POLYNOMIAL 0x633
99*b636d99dSDavid van Moolenbroek     register int i, j;
100*b636d99dSDavid van Moolenbroek     register uint16_t accum;
101*b636d99dSDavid van Moolenbroek     uint16_t verify_crc10_table[256];
102*b636d99dSDavid van Moolenbroek 
103*b636d99dSDavid van Moolenbroek     for ( i = 0;  i < 256;  i++ )
104*b636d99dSDavid van Moolenbroek     {
105*b636d99dSDavid van Moolenbroek         accum = ((unsigned short) i << 2);
106*b636d99dSDavid van Moolenbroek         for ( j = 0;  j < 8;  j++ )
107*b636d99dSDavid van Moolenbroek         {
108*b636d99dSDavid van Moolenbroek             if ((accum <<= 1) & 0x400) accum ^= CRC10_POLYNOMIAL;
109*b636d99dSDavid van Moolenbroek         }
110*b636d99dSDavid van Moolenbroek         verify_crc10_table[i] = accum;
111*b636d99dSDavid van Moolenbroek     }
112*b636d99dSDavid van Moolenbroek     assert(memcmp(verify_crc10_table,
113*b636d99dSDavid van Moolenbroek 				  crc10_table,
114*b636d99dSDavid van Moolenbroek 				  sizeof(verify_crc10_table)) == 0);
115*b636d99dSDavid van Moolenbroek #undef CRC10_POLYNOMIAL
116*b636d99dSDavid van Moolenbroek }
117*b636d99dSDavid van Moolenbroek 
118*b636d99dSDavid van Moolenbroek uint16_t
verify_crc10_cksum(uint16_t accum,const u_char * p,int length)119*b636d99dSDavid van Moolenbroek verify_crc10_cksum(uint16_t accum, const u_char *p, int length)
120*b636d99dSDavid van Moolenbroek {
121*b636d99dSDavid van Moolenbroek     register int i;
122*b636d99dSDavid van Moolenbroek 
123*b636d99dSDavid van Moolenbroek     for ( i = 0;  i < length;  i++ )
124*b636d99dSDavid van Moolenbroek     {
125*b636d99dSDavid van Moolenbroek         accum = ((accum << 8) & 0x3ff)
126*b636d99dSDavid van Moolenbroek             ^ crc10_table[( accum >> 2) & 0xff]
127*b636d99dSDavid van Moolenbroek             ^ *p++;
128*b636d99dSDavid van Moolenbroek     }
129*b636d99dSDavid van Moolenbroek     return accum;
130*b636d99dSDavid van Moolenbroek }
131*b636d99dSDavid van Moolenbroek 
132*b636d99dSDavid van Moolenbroek /* precompute checksum tables */
133*b636d99dSDavid van Moolenbroek void
init_checksum(void)134*b636d99dSDavid van Moolenbroek init_checksum(void) {
135*b636d99dSDavid van Moolenbroek 
136*b636d99dSDavid van Moolenbroek     init_crc10_table();
137*b636d99dSDavid van Moolenbroek 
138*b636d99dSDavid van Moolenbroek }
139*b636d99dSDavid van Moolenbroek 
140*b636d99dSDavid van Moolenbroek /*
141*b636d99dSDavid van Moolenbroek  * Creates the OSI Fletcher checksum. See 8473-1, Appendix C, section C.3.
142*b636d99dSDavid van Moolenbroek  * The checksum field of the passed PDU does not need to be reset to zero.
143*b636d99dSDavid van Moolenbroek  */
144*b636d99dSDavid van Moolenbroek uint16_t
create_osi_cksum(const uint8_t * pptr,int checksum_offset,int length)145*b636d99dSDavid van Moolenbroek create_osi_cksum (const uint8_t *pptr, int checksum_offset, int length)
146*b636d99dSDavid van Moolenbroek {
147*b636d99dSDavid van Moolenbroek 
148*b636d99dSDavid van Moolenbroek     int x;
149*b636d99dSDavid van Moolenbroek     int y;
150*b636d99dSDavid van Moolenbroek     uint32_t mul;
151*b636d99dSDavid van Moolenbroek     uint32_t c0;
152*b636d99dSDavid van Moolenbroek     uint32_t c1;
153*b636d99dSDavid van Moolenbroek     uint16_t checksum;
154*b636d99dSDavid van Moolenbroek     int index;
155*b636d99dSDavid van Moolenbroek 
156*b636d99dSDavid van Moolenbroek     c0 = 0;
157*b636d99dSDavid van Moolenbroek     c1 = 0;
158*b636d99dSDavid van Moolenbroek 
159*b636d99dSDavid van Moolenbroek     for (index = 0; index < length; index++) {
160*b636d99dSDavid van Moolenbroek         /*
161*b636d99dSDavid van Moolenbroek          * Ignore the contents of the checksum field.
162*b636d99dSDavid van Moolenbroek          */
163*b636d99dSDavid van Moolenbroek         if (index == checksum_offset ||
164*b636d99dSDavid van Moolenbroek             index == checksum_offset+1) {
165*b636d99dSDavid van Moolenbroek             c1 += c0;
166*b636d99dSDavid van Moolenbroek             pptr++;
167*b636d99dSDavid van Moolenbroek         } else {
168*b636d99dSDavid van Moolenbroek             c0 = c0 + *(pptr++);
169*b636d99dSDavid van Moolenbroek             c1 += c0;
170*b636d99dSDavid van Moolenbroek         }
171*b636d99dSDavid van Moolenbroek     }
172*b636d99dSDavid van Moolenbroek 
173*b636d99dSDavid van Moolenbroek     c0 = c0 % 255;
174*b636d99dSDavid van Moolenbroek     c1 = c1 % 255;
175*b636d99dSDavid van Moolenbroek 
176*b636d99dSDavid van Moolenbroek     mul = (length - checksum_offset)*(c0);
177*b636d99dSDavid van Moolenbroek 
178*b636d99dSDavid van Moolenbroek     x = mul - c0 - c1;
179*b636d99dSDavid van Moolenbroek     y = c1 - mul - 1;
180*b636d99dSDavid van Moolenbroek 
181*b636d99dSDavid van Moolenbroek     if ( y >= 0 ) y++;
182*b636d99dSDavid van Moolenbroek     if ( x < 0 ) x--;
183*b636d99dSDavid van Moolenbroek 
184*b636d99dSDavid van Moolenbroek     x %= 255;
185*b636d99dSDavid van Moolenbroek     y %= 255;
186*b636d99dSDavid van Moolenbroek 
187*b636d99dSDavid van Moolenbroek 
188*b636d99dSDavid van Moolenbroek     if (x == 0) x = 255;
189*b636d99dSDavid van Moolenbroek     if (y == 0) y = 255;
190*b636d99dSDavid van Moolenbroek 
191*b636d99dSDavid van Moolenbroek     y &= 0x00FF;
192*b636d99dSDavid van Moolenbroek     checksum = ((x << 8) | y);
193*b636d99dSDavid van Moolenbroek 
194*b636d99dSDavid van Moolenbroek     return checksum;
195*b636d99dSDavid van Moolenbroek }
196