Line | |
---|
1 | /* oneC_sum() - One complement's checksum Author: Kees J. Bot
|
---|
2 | * 8 May 1995
|
---|
3 | * See RFC 1071, "Computing the Internet checksum"
|
---|
4 | */
|
---|
5 |
|
---|
6 | #include <sys/types.h>
|
---|
7 | #include <net/gen/oneCsum.h>
|
---|
8 |
|
---|
9 | u16_t oneC_sum(U16_t prev, void *data, size_t size)
|
---|
10 | {
|
---|
11 | u8_t *dptr;
|
---|
12 | size_t n;
|
---|
13 | u16_t word;
|
---|
14 | u32_t sum;
|
---|
15 | int swap= 0;
|
---|
16 |
|
---|
17 | sum= prev;
|
---|
18 | dptr= data;
|
---|
19 | n= size;
|
---|
20 |
|
---|
21 | swap= ((size_t) dptr & 1);
|
---|
22 | if (swap) {
|
---|
23 | sum= ((sum & 0xFF) << 8) | ((sum & 0xFF00) >> 8);
|
---|
24 | if (n > 0) {
|
---|
25 | ((u8_t *) &word)[0]= 0;
|
---|
26 | ((u8_t *) &word)[1]= dptr[0];
|
---|
27 | sum+= (u32_t) word;
|
---|
28 | dptr+= 1;
|
---|
29 | n-= 1;
|
---|
30 | }
|
---|
31 | }
|
---|
32 |
|
---|
33 | while (n >= 8) {
|
---|
34 | sum+= (u32_t) ((u16_t *) dptr)[0]
|
---|
35 | + (u32_t) ((u16_t *) dptr)[1]
|
---|
36 | + (u32_t) ((u16_t *) dptr)[2]
|
---|
37 | + (u32_t) ((u16_t *) dptr)[3];
|
---|
38 | dptr+= 8;
|
---|
39 | n-= 8;
|
---|
40 | }
|
---|
41 |
|
---|
42 | while (n >= 2) {
|
---|
43 | sum+= (u32_t) ((u16_t *) dptr)[0];
|
---|
44 | dptr+= 2;
|
---|
45 | n-= 2;
|
---|
46 | }
|
---|
47 |
|
---|
48 | if (n > 0) {
|
---|
49 | ((u8_t *) &word)[0]= dptr[0];
|
---|
50 | ((u8_t *) &word)[1]= 0;
|
---|
51 | sum+= (u32_t) word;
|
---|
52 | }
|
---|
53 |
|
---|
54 | sum= (sum & 0xFFFF) + (sum >> 16);
|
---|
55 | if (sum > 0xFFFF) sum++;
|
---|
56 |
|
---|
57 | if (swap) {
|
---|
58 | sum= ((sum & 0xFF) << 8) | ((sum & 0xFF00) >> 8);
|
---|
59 | }
|
---|
60 | return sum;
|
---|
61 | }
|
---|
Note:
See
TracBrowser
for help on using the repository browser.