util/lxbios/compute_ip_checksum.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44

/*****************************************************************************\
 * compute_ip_checksum.c
 * $Id: compute_ip_checksum.c,v 1.1.1.1 2005/12/02 22:35:19 dsp_llnl Exp $
\*****************************************************************************/

#include <stdint.h>
#include "ip_checksum.h"

/* Note: The contents of this file were borrowed from the LinuxBIOS source
 *       code which may be obtained from http://www.linuxbios.org.
 *       Specifically, this code was obtained from LinuxBIOS version 1.0.0.8.
 */

unsigned long compute_ip_checksum(void *addr, unsigned long length)
{
        uint8_t *ptr;
        volatile union {
                uint8_t  byte[2];
                uint16_t word;
        } value;
        unsigned long sum;
        unsigned long i;
        /* In the most straight forward way possible,
         * compute an ip style checksum.
         */
        sum = 0;
        ptr = addr;
        for(i = 0; i < length; i++) {
                unsigned long value;
                value = ptr[i];
                if (i & 1) {
                        value <<= 8;
                }
                /* Add the new value */
                sum += value;
                /* Wrap around the carry */
                if (sum > 0xFFFF) {
                        sum = (sum + (sum >> 16)) & 0xFFFF;
                }
        }
        value.byte[0] = sum & 0xff;
        value.byte[1] = (sum >> 8) & 0xff;
        return (~value.word) & 0xFFFF;
}