#include <sys/param.h>
#include <sys/systm.h>
#include <sys/mbuf.h>
#include <netinet/in.h>
#define ADD32 asm volatile( "ldw 0x00(%1), %%r19! ldw 0x04(%1), %%r20\n\t" \
"add %0, %%r19, %0 ! addc %0, %%r20, %0\n\t" \
"ldw 0x08(%1), %%r19! ldw 0x0c(%1), %%r20\n\t" \
"addc %0, %%r19, %0 ! addc %0, %%r20, %0\n\t" \
"ldw 0x10(%1), %%r19! ldw 0x14(%1), %%r20\n\t" \
"addc %0, %%r19, %0 ! addc %0, %%r20, %0\n\t" \
"ldw 0x18(%1), %%r19! ldw 0x1c(%1), %%r20\n\t" \
"addc %0, %%r19, %0 ! addc %0, %%r20, %0\n\t" \
"ldo 0x20(%1), %1 ! addc %0, %%r0 , %0" \
: "+r" (sum), "+r" (w) :: "r20", "r19")
#define ADD16 asm volatile( "ldw 0x00(%1), %%r19! ldw 0x04(%1), %%r20\n\t" \
"add %0, %%r19, %0! addc %0, %%r20, %0\n\t" \
"ldw 0x08(%1), %%r19! ldw 0x0c(%1), %%r20\n\t" \
"addc %0, %%r19, %0! addc %0, %%r20, %0\n\t" \
"ldo 0x10(%1), %1 ! addc %0, %%r0 , %0" \
: "+r" (sum), "+r" (w) :: "r20", "r19")
#define ADDCARRY {if (sum > 0xffff) sum -= 0xffff;}
#define REDUCE {sum = (sum & 0xffff) + (sum >> 16); ADDCARRY}
#define ROL asm volatile ("shd %0, %0, 8, %0" : "+r" (sum))
#define ADDBYTE {ROL; sum += *w++; bins++; mlen--;}
#define ADDSHORT {sum += *(u_short *)w; w += 2; mlen -= 2;}
#define ADDWORD asm volatile( "ldwm 4(%1), %%r19! add %0, %%r19, %0\n\t" \
"ldo -4(%2), %2 ! addc %0, 0, %0" \
: "+r" (sum), "+r" (w), "+r" (mlen) :: "r19")
int
in_cksum(struct mbuf *m, int len)
{
u_int sum = 0;
u_int bins = 0;
for (; m && len; m = m->m_next) {
int mlen = m->m_len;
u_char *w;
if (!mlen)
continue;
if (len < mlen)
mlen = len;
len -= mlen;
w = mtod(m, u_char *);
if (mlen > 16) {
if ((7 & (u_long)w) != 0) {
if ((1 & (u_long)w) != 0)
ADDBYTE;
if ((2 & (u_long)w) != 0)
ADDSHORT;
if ((4 & (u_long)w) != 0)
ADDWORD;
}
while ((mlen -= 32) >= 0)
ADD32;
mlen += 32;
if (mlen >= 16) {
ADD16;
mlen -= 16;
}
}
while (mlen > 0)
ADDBYTE;
}
if (bins & 1)
ROL;
REDUCE;
return (0xffff ^ sum);
}