auxFormat.c 3.54 KB
Newer Older
Zhao Xuefeng committed
1
#include"auxFormat.h"
Wentao Zhang committed
2

Wentao Zhang committed
3 4 5 6 7 8
void packU32FormatToThreePacket(u32 * out, u8 * in) {
	u32 t2 = U32BIG(((u32*)in)[0]);
	out[2] = t2; out[1] = t2 >> 1; out[0] = t2 >> 2;//temp2[0]  0;temp2[1]  1;temp2[2]  2;
	puckU32ToThree_1(out[0]);
	puckU32ToThree_1(out[1]);
	puckU32ToThree_1(out[2]);
Zhao Xuefeng committed
9
}
Wentao Zhang committed
10 11 12 13 14 15 16 17 18
void unpackU32FormatToThreePacket(u8 * out, u32 * in) {
	u32 temp0[3] = { 0 };
	temp0[0] = in[0] & 0x3ff;
	temp0[1] = in[1] & 0x7ff;
	temp0[2] = in[2] & 0x7ff;
	unpuckU32ToThree_1(temp0[0]);
	unpuckU32ToThree_1(temp0[1]);
	unpuckU32ToThree_1(temp0[2]);
	*(u32*)(out) = U32BIG(temp0[0]<<2 | temp0[1] << 1 | temp0[2]);
Zhao Xuefeng committed
19
}
Wentao Zhang committed
20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42

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
43
}
Wentao Zhang committed
44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72
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;
Zhao Xuefeng committed
73 74
	memcpy(out, t, 12 * sizeof(unsigned char));
}
Wentao Zhang committed
75

Wentao Zhang committed
76 77 78 79 80 81 82 83 84
unsigned char constant7Format[80] = {
/*constant7Format[127]: 12*6=72*/
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, };
Zhao Xuefeng committed
85 86 87
void P384(unsigned int *s, unsigned char *round, unsigned char lunNum) {
	u32 s_temp[12] = { 0 };
	u32 t1, t2, t3, t5, t6, t8, t9, t11;
Wentao Zhang committed
88
	unsigned char i;
Zhao Xuefeng committed
89
	for (i = 0; i < lunNum; i++) {
Wentao Zhang committed
90 91 92 93 94 95 96 97 98
		s[0] ^= (round[i] >> 6) & 0x3;
		s[1] ^= (round[i] >> 3) & 0x7;
		s[2] ^= round[i] & 0x7;
		sbox(s[0], s[3], s[6], s[9], s_temp[3], s_temp[6], s_temp[9]);
		sbox(s[1], s[4], s[7], s[10], s[3], s_temp[7], s_temp[10]);
		sbox(s[2], s[5], s[8], s[11], s[4], s_temp[8], s_temp[11]);
		s[5] = LOTR32(s_temp[3], 1);
		U96_BIT_LOTR32_8(s_temp[6], s_temp[7], s_temp[8], s[6], s[7], s[8]);
		U96_BIT_LOTR32_55(s_temp[9], s_temp[10], s_temp[11], s[9], s[10], s[11]);
Zhao Xuefeng committed
99 100
	}
}