auxFormat.c 2.51 KB
Newer Older
Zhao Xuefeng committed
1 2
#include"auxFormat.h"

Wentao Zhang committed
3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
void packU96FormatToThreePacket(u32 * out, u8 * in) {
	u32 temp0[3] = { 0 };
	u32 temp1[3] = { 0 };
	u32 temp2[3] = { 0 };
	u32 t1=U32BIG(((u32*)in)[0]);
	temp0[0] = t1; temp0[1] = t1 >> 1; temp0[2] = t1>> 2;
	puckU32ToThree_1(temp0[0]);
	puckU32ToThree_1(temp0[1]);
	puckU32ToThree_1(temp0[2]);
	t1=U32BIG(((u32*)in)[1]);
	temp1[0] = t1; temp1[1] = t1>>1; temp1[2] = t1 >> 2;
	puckU32ToThree_1(temp1[0]);
	puckU32ToThree_1(temp1[1]);
	puckU32ToThree_1(temp1[2]);
	t1=U32BIG(((u32*)in)[2]);
	temp2[0] = t1; temp2[1] =t1 >> 1; temp2[2] = t1>> 2;
	puckU32ToThree_1(temp2[0]);
	puckU32ToThree_1(temp2[1]);
	puckU32ToThree_1(temp2[2]);
	out[0] = (temp2[1]<<21)	|(temp1[0]<<10)	|temp0[2];
	out[1] = (temp2[0] << 21) | (temp1[2] << 11) | temp0[1];
	out[2] = (temp2[2] << 22) | (temp1[1] << 11) | temp0[0];
Zhao Xuefeng committed
25
}
Wentao Zhang committed
26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55
void unpackU96FormatToThreePacket(u8 * out, u32 * in) {
	u32 temp0[3] = { 0 };
	u32 temp1[3] = { 0 };
	u32 temp2[3] = { 0 };
	u32 t[3] = { 0 };
	u32 t0=in[0] ;
	u32 t1=in[1] ;
	u32 t2=in[2] ;
	temp0[0] = t2 & 0x7ff;
	temp0[1] = t1 & 0x7ff;
	temp0[2] = t0 & 0x3ff;
	temp1[0] = (t0>>10) & 0x7ff;
	temp1[1] = (t2 >>11 ) & 0x7ff;
	temp1[2] = (t1 >> 11) & 0x3ff;
	temp2[0] = t1 >> 21;
	temp2[1] = t0 >> 21;
	temp2[2] = t2 >> 22;
	unpuckU32ToThree_1(temp0[0]);
	unpuckU32ToThree_1(temp0[1]);
	unpuckU32ToThree_1(temp0[2]);
	t[0] = temp0[0] | temp0[1] << 1 | temp0[2] << 2;
	unpuckU32ToThree_1(temp1[0]);
	unpuckU32ToThree_1(temp1[1]);
	unpuckU32ToThree_1(temp1[2]);
	t[1] = temp1[0] | temp1[1] << 1 | temp1[2] << 2;
	unpuckU32ToThree_1(temp2[0]);
	unpuckU32ToThree_1(temp2[1]);
	unpuckU32ToThree_1(temp2[2]);
	t[2] = temp2[0] | temp2[1] << 1 | temp2[2] << 2;
	memcpy(out, t, 12 * sizeof(unsigned char));
Zhao Xuefeng committed
56
}
Wentao Zhang committed
57

Zhao Xuefeng committed
58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77
void P384(unsigned int *s, unsigned char *round, unsigned char lunNum) {
	u32 rci,t1,t2;
	unsigned char  i;
	for (i = 0; i < lunNum; i++) {
		rci=constant7Format[i];\
		P384_ARC_SC1(rci,s[3],s[6],s[9]);	\
		P384_2SC(s[1],s[4],s[7],s[10],s[2],s[5],s[8],s[11]);\
		P384_SR();\
	}
}
//12*7=84
unsigned char  constant7Format[80] = {
	/*constant7Format[127]:*/
	0x01,0x08,0x40,0x02,0x10,0x80,0x05,0x09,0x48,0x42,0x12,0x90,
	0x85,0x0c,0x41,0x0a,0x50,0x82,0x15,0x89,0x4d,0x4b,0x5a,0xd2,
	0x97,0x9c,0xc4,0x06,0x11,0x88,0x45,0x0b,0x58,0xc2,0x17,0x99,
	0xcd,0x4e,0x53,0x9a,0xd5,0x8e,0x54,0x83,0x1d,0xc9,0x4f,0x5b,
	0xda,0xd7,0x9e,0xd4,0x86,0x14,0x81,0x0d,0x49,0x4a,0x52,0x92,
	0x95,0x8c,0x44,0x03,0x18,0xc0,0x07,0x19,0xc8,0x47,0x1b,0xd8,
	0xc7,0x1e,0xd1,0x8f,0x5c,0xc3,0x1f,0xd9,};