#include "os.h"

#define ROTL(x,n)	(((x)<<n)|((x)>>(32-n)))

#define F0(x,y,z)	(0x5a827999 + ((z) ^ ((x) & ((y) ^ (z)))))
#define F1(x,y,z)	(0x6ed9eba1 + ((x) ^ (y) ^ (z)))
#define F2(x,y,z)	(0x8f1bbcdc + (((x) & (y)) | (((x) | (y)) & (z))))
#define F3(x,y,z)	(0xca62c1d6 + ((x) ^ (y) ^ (z)))

void
_sha1block(uchar *p, ulong len, u32int *s)
{
	u32int w[16], a, b, c, d, e;
	uchar *end;

	/* at this point, we have a multiple of 64 bytes */
	for(end = p+len; p < end;){
		a = s[0];
		b = s[1];
		c = s[2];
		d = s[3];
		e = s[4];

#define STEP(a,b,c,d,e,f,i) \
	if(i < 16) {\
		w[i] = p[0]<<24 | p[1]<<16 | p[2]<<8 | p[3]; \
		p += 4; \
	} else { \
		u32int x = w[(i-3)&15] ^ w[(i-8)&15] ^ w[(i-14)&15] ^ w[(i-16)&15]; \
		w[i&15] = ROTL(x, 1); \
	} \
	e += ROTL(a, 5) + w[i&15] + f(b,c,d); \
	b = ROTL(b, 30);

		STEP(a,b,c,d,e,F0,0);
		STEP(e,a,b,c,d,F0,1);
		STEP(d,e,a,b,c,F0,2);
		STEP(c,d,e,a,b,F0,3);
		STEP(b,c,d,e,a,F0,4);
	
		STEP(a,b,c,d,e,F0,5);
		STEP(e,a,b,c,d,F0,6);
		STEP(d,e,a,b,c,F0,7);
		STEP(c,d,e,a,b,F0,8);
		STEP(b,c,d,e,a,F0,9);
	
		STEP(a,b,c,d,e,F0,10);
		STEP(e,a,b,c,d,F0,11);
		STEP(d,e,a,b,c,F0,12);
		STEP(c,d,e,a,b,F0,13);
		STEP(b,c,d,e,a,F0,14);
	
		STEP(a,b,c,d,e,F0,15);
		STEP(e,a,b,c,d,F0,16);
		STEP(d,e,a,b,c,F0,17);
		STEP(c,d,e,a,b,F0,18);
		STEP(b,c,d,e,a,F0,19);
	
		STEP(a,b,c,d,e,F1,20);
		STEP(e,a,b,c,d,F1,21);
		STEP(d,e,a,b,c,F1,22);
		STEP(c,d,e,a,b,F1,23);
		STEP(b,c,d,e,a,F1,24);
	
		STEP(a,b,c,d,e,F1,25);
		STEP(e,a,b,c,d,F1,26);
		STEP(d,e,a,b,c,F1,27);
		STEP(c,d,e,a,b,F1,28);
		STEP(b,c,d,e,a,F1,29);
	
		STEP(a,b,c,d,e,F1,30);
		STEP(e,a,b,c,d,F1,31);
		STEP(d,e,a,b,c,F1,32);
		STEP(c,d,e,a,b,F1,33);
		STEP(b,c,d,e,a,F1,34);
	
		STEP(a,b,c,d,e,F1,35);
		STEP(e,a,b,c,d,F1,36);
		STEP(d,e,a,b,c,F1,37);
		STEP(c,d,e,a,b,F1,38);
		STEP(b,c,d,e,a,F1,39);
	
		STEP(a,b,c,d,e,F2,40);
		STEP(e,a,b,c,d,F2,41);
		STEP(d,e,a,b,c,F2,42);
		STEP(c,d,e,a,b,F2,43);
		STEP(b,c,d,e,a,F2,44);
	
		STEP(a,b,c,d,e,F2,45);
		STEP(e,a,b,c,d,F2,46);
		STEP(d,e,a,b,c,F2,47);
		STEP(c,d,e,a,b,F2,48);
		STEP(b,c,d,e,a,F2,49);
	
		STEP(a,b,c,d,e,F2,50);
		STEP(e,a,b,c,d,F2,51);
		STEP(d,e,a,b,c,F2,52);
		STEP(c,d,e,a,b,F2,53);
		STEP(b,c,d,e,a,F2,54);
	
		STEP(a,b,c,d,e,F2,55);
		STEP(e,a,b,c,d,F2,56);
		STEP(d,e,a,b,c,F2,57);
		STEP(c,d,e,a,b,F2,58);
		STEP(b,c,d,e,a,F2,59);
	
		STEP(a,b,c,d,e,F3,60);
		STEP(e,a,b,c,d,F3,61);
		STEP(d,e,a,b,c,F3,62);
		STEP(c,d,e,a,b,F3,63);
		STEP(b,c,d,e,a,F3,64);
	
		STEP(a,b,c,d,e,F3,65);
		STEP(e,a,b,c,d,F3,66);
		STEP(d,e,a,b,c,F3,67);
		STEP(c,d,e,a,b,F3,68);
		STEP(b,c,d,e,a,F3,69);
	
		STEP(a,b,c,d,e,F3,70);
		STEP(e,a,b,c,d,F3,71);
		STEP(d,e,a,b,c,F3,72);
		STEP(c,d,e,a,b,F3,73);
		STEP(b,c,d,e,a,F3,74);
	
		STEP(a,b,c,d,e,F3,75);
		STEP(e,a,b,c,d,F3,76);
		STEP(d,e,a,b,c,F3,77);
		STEP(c,d,e,a,b,F3,78);
		STEP(b,c,d,e,a,F3,79);

		s[0] += a;
		s[1] += b;
		s[2] += c;
		s[3] += d;
		s[4] += e;
	}
}