2015-12-04 14:47:52 +00:00
|
|
|
/**
|
2016-09-11 20:20:15 +00:00
|
|
|
* Author......: See docs/credits.txt
|
2015-12-04 14:47:52 +00:00
|
|
|
* License.....: MIT
|
|
|
|
*/
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
#define MAYBE_UNUSED
|
|
|
|
|
2017-08-16 18:27:17 +00:00
|
|
|
static u32 generate_cmask (const u32 value)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2016-11-01 12:01:15 +00:00
|
|
|
const u32 rmask = ((value & 0x40404040u) >> 1u)
|
|
|
|
& ~((value & 0x80808080u) >> 2u);
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2016-11-01 12:01:15 +00:00
|
|
|
const u32 hmask = (value & 0x1f1f1f1fu) + 0x05050505u;
|
|
|
|
const u32 lmask = (value & 0x1f1f1f1fu) + 0x1f1f1f1fu;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return rmask & ~hmask & lmask;
|
|
|
|
}
|
|
|
|
|
2017-08-16 18:27:17 +00:00
|
|
|
static void truncate_right (u32 buf0[4], u32 buf1[4], const u32 offset)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2016-11-01 12:01:15 +00:00
|
|
|
const u32 tmp = (1u << ((offset & 3u) * 8u)) - 1u;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2016-11-01 12:01:15 +00:00
|
|
|
switch (offset / 4)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2016-11-01 12:01:15 +00:00
|
|
|
case 0: buf0[0] &= tmp;
|
|
|
|
buf0[1] = 0;
|
|
|
|
buf0[2] = 0;
|
|
|
|
buf0[3] = 0;
|
|
|
|
buf1[0] = 0;
|
|
|
|
buf1[1] = 0;
|
|
|
|
buf1[2] = 0;
|
|
|
|
buf1[3] = 0;
|
|
|
|
break;
|
|
|
|
case 1: buf0[1] &= tmp;
|
|
|
|
buf0[2] = 0;
|
|
|
|
buf0[3] = 0;
|
|
|
|
buf1[0] = 0;
|
|
|
|
buf1[1] = 0;
|
|
|
|
buf1[2] = 0;
|
|
|
|
buf1[3] = 0;
|
|
|
|
break;
|
|
|
|
case 2: buf0[2] &= tmp;
|
|
|
|
buf0[3] = 0;
|
|
|
|
buf1[0] = 0;
|
|
|
|
buf1[1] = 0;
|
|
|
|
buf1[2] = 0;
|
|
|
|
buf1[3] = 0;
|
|
|
|
break;
|
|
|
|
case 3: buf0[3] &= tmp;
|
|
|
|
buf1[0] = 0;
|
|
|
|
buf1[1] = 0;
|
|
|
|
buf1[2] = 0;
|
|
|
|
buf1[3] = 0;
|
|
|
|
break;
|
|
|
|
case 4: buf1[0] &= tmp;
|
|
|
|
buf1[1] = 0;
|
|
|
|
buf1[2] = 0;
|
|
|
|
buf1[3] = 0;
|
|
|
|
break;
|
|
|
|
case 5: buf1[1] &= tmp;
|
|
|
|
buf1[2] = 0;
|
|
|
|
buf1[3] = 0;
|
|
|
|
break;
|
|
|
|
case 6: buf1[2] &= tmp;
|
|
|
|
buf1[3] = 0;
|
|
|
|
break;
|
|
|
|
case 7: buf1[3] &= tmp;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-08-16 18:27:17 +00:00
|
|
|
static void truncate_left (u32 buf0[4], u32 buf1[4], const u32 offset)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2016-11-01 12:01:15 +00:00
|
|
|
const u32 tmp = ~((1u << ((offset & 3u) * 8u)) - 1u);
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2016-11-01 12:01:15 +00:00
|
|
|
switch (offset / 4)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2016-11-01 12:01:15 +00:00
|
|
|
case 0: buf0[0] &= tmp;
|
|
|
|
break;
|
|
|
|
case 1: buf0[0] = 0;
|
|
|
|
buf0[1] &= tmp;
|
|
|
|
break;
|
|
|
|
case 2: buf0[0] = 0;
|
|
|
|
buf0[1] = 0;
|
|
|
|
buf0[2] &= tmp;
|
|
|
|
break;
|
|
|
|
case 3: buf0[0] = 0;
|
|
|
|
buf0[1] = 0;
|
|
|
|
buf0[2] = 0;
|
|
|
|
buf0[3] &= tmp;
|
|
|
|
break;
|
|
|
|
case 4: buf0[0] = 0;
|
|
|
|
buf0[1] = 0;
|
|
|
|
buf0[2] = 0;
|
|
|
|
buf0[3] = 0;
|
|
|
|
buf1[0] &= tmp;
|
|
|
|
break;
|
|
|
|
case 5: buf0[0] = 0;
|
|
|
|
buf0[1] = 0;
|
|
|
|
buf0[2] = 0;
|
|
|
|
buf0[3] = 0;
|
|
|
|
buf1[0] = 0;
|
|
|
|
buf1[1] &= tmp;
|
|
|
|
break;
|
|
|
|
case 6: buf0[0] = 0;
|
|
|
|
buf0[1] = 0;
|
|
|
|
buf0[2] = 0;
|
|
|
|
buf0[3] = 0;
|
|
|
|
buf1[0] = 0;
|
|
|
|
buf1[1] = 0;
|
|
|
|
buf1[2] &= tmp;
|
|
|
|
break;
|
|
|
|
case 7: buf0[0] = 0;
|
|
|
|
buf0[1] = 0;
|
|
|
|
buf0[2] = 0;
|
|
|
|
buf0[3] = 0;
|
|
|
|
buf1[0] = 0;
|
|
|
|
buf1[1] = 0;
|
|
|
|
buf1[2] = 0;
|
|
|
|
buf1[3] &= tmp;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-08-16 18:27:17 +00:00
|
|
|
static void lshift_block (const u32 in0[4], const u32 in1[4], u32 out0[4], u32 out1[4])
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2016-01-27 19:01:08 +00:00
|
|
|
out0[0] = amd_bytealign_S (in0[1], in0[0], 1);
|
|
|
|
out0[1] = amd_bytealign_S (in0[2], in0[1], 1);
|
|
|
|
out0[2] = amd_bytealign_S (in0[3], in0[2], 1);
|
|
|
|
out0[3] = amd_bytealign_S (in1[0], in0[3], 1);
|
|
|
|
out1[0] = amd_bytealign_S (in1[1], in1[0], 1);
|
|
|
|
out1[1] = amd_bytealign_S (in1[2], in1[1], 1);
|
|
|
|
out1[2] = amd_bytealign_S (in1[3], in1[2], 1);
|
|
|
|
out1[3] = amd_bytealign_S ( 0, in1[3], 1);
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
2017-08-16 18:27:17 +00:00
|
|
|
static void rshift_block (const u32 in0[4], const u32 in1[4], u32 out0[4], u32 out1[4])
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2016-01-27 19:01:08 +00:00
|
|
|
out1[3] = amd_bytealign_S (in1[3], in1[2], 3);
|
|
|
|
out1[2] = amd_bytealign_S (in1[2], in1[1], 3);
|
|
|
|
out1[1] = amd_bytealign_S (in1[1], in1[0], 3);
|
|
|
|
out1[0] = amd_bytealign_S (in1[0], in0[3], 3);
|
|
|
|
out0[3] = amd_bytealign_S (in0[3], in0[2], 3);
|
|
|
|
out0[2] = amd_bytealign_S (in0[2], in0[1], 3);
|
|
|
|
out0[1] = amd_bytealign_S (in0[1], in0[0], 3);
|
|
|
|
out0[0] = amd_bytealign_S (in0[0], 0, 3);
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
2017-08-16 18:27:17 +00:00
|
|
|
static void lshift_block_N (const u32 in0[4], const u32 in1[4], u32 out0[4], u32 out1[4], const u32 num)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
|
|
|
switch (num)
|
|
|
|
{
|
2015-12-15 11:04:22 +00:00
|
|
|
case 0: out0[0] = in0[0];
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[1] = in0[1];
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[2] = in0[2];
|
|
|
|
out0[3] = in0[3];
|
|
|
|
out1[0] = in1[0];
|
|
|
|
out1[1] = in1[1];
|
|
|
|
out1[2] = in1[2];
|
|
|
|
out1[3] = in1[3];
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 1: out0[0] = amd_bytealign_S (in0[1], in0[0], 1);
|
|
|
|
out0[1] = amd_bytealign_S (in0[2], in0[1], 1);
|
|
|
|
out0[2] = amd_bytealign_S (in0[3], in0[2], 1);
|
|
|
|
out0[3] = amd_bytealign_S (in1[0], in0[3], 1);
|
|
|
|
out1[0] = amd_bytealign_S (in1[1], in1[0], 1);
|
|
|
|
out1[1] = amd_bytealign_S (in1[2], in1[1], 1);
|
|
|
|
out1[2] = amd_bytealign_S (in1[3], in1[2], 1);
|
|
|
|
out1[3] = amd_bytealign_S ( 0, in1[3], 1);
|
|
|
|
break;
|
|
|
|
case 2: out0[0] = amd_bytealign_S (in0[1], in0[0], 2);
|
|
|
|
out0[1] = amd_bytealign_S (in0[2], in0[1], 2);
|
|
|
|
out0[2] = amd_bytealign_S (in0[3], in0[2], 2);
|
|
|
|
out0[3] = amd_bytealign_S (in1[0], in0[3], 2);
|
|
|
|
out1[0] = amd_bytealign_S (in1[1], in1[0], 2);
|
|
|
|
out1[1] = amd_bytealign_S (in1[2], in1[1], 2);
|
|
|
|
out1[2] = amd_bytealign_S (in1[3], in1[2], 2);
|
|
|
|
out1[3] = amd_bytealign_S ( 0, in1[3], 2);
|
|
|
|
break;
|
|
|
|
case 3: out0[0] = amd_bytealign_S (in0[1], in0[0], 3);
|
|
|
|
out0[1] = amd_bytealign_S (in0[2], in0[1], 3);
|
|
|
|
out0[2] = amd_bytealign_S (in0[3], in0[2], 3);
|
|
|
|
out0[3] = amd_bytealign_S (in1[0], in0[3], 3);
|
|
|
|
out1[0] = amd_bytealign_S (in1[1], in1[0], 3);
|
|
|
|
out1[1] = amd_bytealign_S (in1[2], in1[1], 3);
|
|
|
|
out1[2] = amd_bytealign_S (in1[3], in1[2], 3);
|
|
|
|
out1[3] = amd_bytealign_S ( 0, in1[3], 3);
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2015-12-15 11:04:22 +00:00
|
|
|
case 4: out0[0] = in0[1];
|
|
|
|
out0[1] = in0[2];
|
|
|
|
out0[2] = in0[3];
|
|
|
|
out0[3] = in1[0];
|
|
|
|
out1[0] = in1[1];
|
|
|
|
out1[1] = in1[2];
|
|
|
|
out1[2] = in1[3];
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 5: out0[0] = amd_bytealign_S (in0[2], in0[1], 1);
|
|
|
|
out0[1] = amd_bytealign_S (in0[3], in0[2], 1);
|
|
|
|
out0[2] = amd_bytealign_S (in1[0], in0[3], 1);
|
|
|
|
out0[3] = amd_bytealign_S (in1[1], in1[0], 1);
|
|
|
|
out1[0] = amd_bytealign_S (in1[2], in1[1], 1);
|
|
|
|
out1[1] = amd_bytealign_S (in1[3], in1[2], 1);
|
|
|
|
out1[2] = amd_bytealign_S ( 0, in1[3], 1);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 6: out0[0] = amd_bytealign_S (in0[2], in0[1], 2);
|
|
|
|
out0[1] = amd_bytealign_S (in0[3], in0[2], 2);
|
|
|
|
out0[2] = amd_bytealign_S (in1[0], in0[3], 2);
|
|
|
|
out0[3] = amd_bytealign_S (in1[1], in1[0], 2);
|
|
|
|
out1[0] = amd_bytealign_S (in1[2], in1[1], 2);
|
|
|
|
out1[1] = amd_bytealign_S (in1[3], in1[2], 2);
|
|
|
|
out1[2] = amd_bytealign_S ( 0, in1[3], 2);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 7: out0[0] = amd_bytealign_S (in0[2], in0[1], 3);
|
|
|
|
out0[1] = amd_bytealign_S (in0[3], in0[2], 3);
|
|
|
|
out0[2] = amd_bytealign_S (in1[0], in0[3], 3);
|
|
|
|
out0[3] = amd_bytealign_S (in1[1], in1[0], 3);
|
|
|
|
out1[0] = amd_bytealign_S (in1[2], in1[1], 3);
|
|
|
|
out1[1] = amd_bytealign_S (in1[3], in1[2], 3);
|
|
|
|
out1[2] = amd_bytealign_S ( 0, in1[3], 3);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2015-12-15 11:04:22 +00:00
|
|
|
case 8: out0[0] = in0[2];
|
|
|
|
out0[1] = in0[3];
|
|
|
|
out0[2] = in1[0];
|
|
|
|
out0[3] = in1[1];
|
|
|
|
out1[0] = in1[2];
|
|
|
|
out1[1] = in1[3];
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 9: out0[0] = amd_bytealign_S (in0[3], in0[2], 1);
|
|
|
|
out0[1] = amd_bytealign_S (in1[0], in0[3], 1);
|
|
|
|
out0[2] = amd_bytealign_S (in1[1], in1[0], 1);
|
|
|
|
out0[3] = amd_bytealign_S (in1[2], in1[1], 1);
|
|
|
|
out1[0] = amd_bytealign_S (in1[3], in1[2], 1);
|
|
|
|
out1[1] = amd_bytealign_S ( 0, in1[3], 1);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 10: out0[0] = amd_bytealign_S (in0[3], in0[2], 2);
|
|
|
|
out0[1] = amd_bytealign_S (in1[0], in0[3], 2);
|
|
|
|
out0[2] = amd_bytealign_S (in1[1], in1[0], 2);
|
|
|
|
out0[3] = amd_bytealign_S (in1[2], in1[1], 2);
|
|
|
|
out1[0] = amd_bytealign_S (in1[3], in1[2], 2);
|
|
|
|
out1[1] = amd_bytealign_S ( 0, in1[3], 2);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 11: out0[0] = amd_bytealign_S (in0[3], in0[2], 3);
|
|
|
|
out0[1] = amd_bytealign_S (in1[0], in0[3], 3);
|
|
|
|
out0[2] = amd_bytealign_S (in1[1], in1[0], 3);
|
|
|
|
out0[3] = amd_bytealign_S (in1[2], in1[1], 3);
|
|
|
|
out1[0] = amd_bytealign_S (in1[3], in1[2], 3);
|
|
|
|
out1[1] = amd_bytealign_S ( 0, in1[3], 3);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2015-12-15 11:04:22 +00:00
|
|
|
case 12: out0[0] = in0[3];
|
|
|
|
out0[1] = in1[0];
|
|
|
|
out0[2] = in1[1];
|
|
|
|
out0[3] = in1[2];
|
|
|
|
out1[0] = in1[3];
|
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 13: out0[0] = amd_bytealign_S (in1[0], in0[3], 1);
|
|
|
|
out0[1] = amd_bytealign_S (in1[1], in1[0], 1);
|
|
|
|
out0[2] = amd_bytealign_S (in1[2], in1[1], 1);
|
|
|
|
out0[3] = amd_bytealign_S (in1[3], in1[2], 1);
|
|
|
|
out1[0] = amd_bytealign_S ( 0, in1[3], 1);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 14: out0[0] = amd_bytealign_S (in1[0], in0[3], 2);
|
|
|
|
out0[1] = amd_bytealign_S (in1[1], in1[0], 2);
|
|
|
|
out0[2] = amd_bytealign_S (in1[2], in1[1], 2);
|
|
|
|
out0[3] = amd_bytealign_S (in1[3], in1[2], 2);
|
|
|
|
out1[0] = amd_bytealign_S ( 0, in1[3], 2);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 15: out0[0] = amd_bytealign_S (in1[0], in0[3], 3);
|
|
|
|
out0[1] = amd_bytealign_S (in1[1], in1[0], 3);
|
|
|
|
out0[2] = amd_bytealign_S (in1[2], in1[1], 3);
|
|
|
|
out0[3] = amd_bytealign_S (in1[3], in1[2], 3);
|
|
|
|
out1[0] = amd_bytealign_S ( 0, in1[3], 3);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2015-12-15 11:04:22 +00:00
|
|
|
case 16: out0[0] = in1[0];
|
|
|
|
out0[1] = in1[1];
|
|
|
|
out0[2] = in1[2];
|
|
|
|
out0[3] = in1[3];
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[0] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 17: out0[0] = amd_bytealign_S (in1[1], in1[0], 1);
|
|
|
|
out0[1] = amd_bytealign_S (in1[2], in1[1], 1);
|
|
|
|
out0[2] = amd_bytealign_S (in1[3], in1[2], 1);
|
|
|
|
out0[3] = amd_bytealign_S ( 0, in1[3], 1);
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[0] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 18: out0[0] = amd_bytealign_S (in1[1], in1[0], 2);
|
|
|
|
out0[1] = amd_bytealign_S (in1[2], in1[1], 2);
|
|
|
|
out0[2] = amd_bytealign_S (in1[3], in1[2], 2);
|
|
|
|
out0[3] = amd_bytealign_S ( 0, in1[3], 2);
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[0] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 19: out0[0] = amd_bytealign_S (in1[1], in1[0], 3);
|
|
|
|
out0[1] = amd_bytealign_S (in1[2], in1[1], 3);
|
|
|
|
out0[2] = amd_bytealign_S (in1[3], in1[2], 3);
|
|
|
|
out0[3] = amd_bytealign_S ( 0, in1[3], 3);
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[0] = 0;
|
|
|
|
out1[1] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2015-12-15 11:04:22 +00:00
|
|
|
case 20: out0[0] = in1[1];
|
|
|
|
out0[1] = in1[2];
|
|
|
|
out0[2] = in1[3];
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[3] = 0;
|
|
|
|
out1[0] = 0;
|
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 21: out0[0] = amd_bytealign_S (in1[2], in1[1], 1);
|
|
|
|
out0[1] = amd_bytealign_S (in1[3], in1[2], 1);
|
|
|
|
out0[2] = amd_bytealign_S ( 0, in1[3], 1);
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[3] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[0] = 0;
|
|
|
|
out1[1] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[3] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 22: out0[0] = amd_bytealign_S (in1[2], in1[1], 2);
|
|
|
|
out0[1] = amd_bytealign_S (in1[3], in1[2], 2);
|
|
|
|
out0[2] = amd_bytealign_S ( 0, in1[3], 2);
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[3] = 0;
|
|
|
|
out1[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[1] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 23: out0[0] = amd_bytealign_S (in1[2], in1[1], 3);
|
|
|
|
out0[1] = amd_bytealign_S (in1[3], in1[2], 3);
|
|
|
|
out0[2] = amd_bytealign_S ( 0, in1[3], 3);
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[0] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
|
|
|
break;
|
|
|
|
case 24: out0[0] = in1[2];
|
|
|
|
out0[1] = in1[3];
|
|
|
|
out0[2] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[3] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[0] = 0;
|
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 25: out0[0] = amd_bytealign_S (in1[3], in1[2], 1);
|
|
|
|
out0[1] = amd_bytealign_S ( 0, in1[3], 1);
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[3] = 0;
|
|
|
|
out1[0] = 0;
|
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 26: out0[0] = amd_bytealign_S (in1[3], in1[2], 2);
|
|
|
|
out0[1] = amd_bytealign_S ( 0, in1[3], 2);
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[2] = 0;
|
|
|
|
out0[3] = 0;
|
|
|
|
out1[0] = 0;
|
|
|
|
out1[1] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[3] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 27: out0[0] = amd_bytealign_S (in1[3], in1[2], 3);
|
|
|
|
out0[1] = amd_bytealign_S ( 0, in1[3], 3);
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[2] = 0;
|
|
|
|
out0[3] = 0;
|
|
|
|
out1[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[1] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
|
|
|
break;
|
|
|
|
case 28: out0[0] = in1[3];
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[2] = 0;
|
|
|
|
out0[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[0] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 29: out0[0] = amd_bytealign_S ( 0, in1[3], 1);
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[1] = 0;
|
|
|
|
out0[2] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[3] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[0] = 0;
|
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 30: out0[0] = amd_bytealign_S ( 0, in1[3], 2);
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[1] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[3] = 0;
|
|
|
|
out1[0] = 0;
|
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 31: out0[0] = amd_bytealign_S ( 0, in1[3], 3);
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[1] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[2] = 0;
|
|
|
|
out0[3] = 0;
|
|
|
|
out1[0] = 0;
|
|
|
|
out1[1] = 0;
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-08-16 18:27:17 +00:00
|
|
|
static void rshift_block_N (const u32 in0[4], const u32 in1[4], u32 out0[4], u32 out1[4], const u32 num)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
|
|
|
switch (num)
|
|
|
|
{
|
2016-01-16 12:34:54 +00:00
|
|
|
case 0: out1[3] = in1[3];
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[2] = in1[2];
|
2016-01-16 12:34:54 +00:00
|
|
|
out1[1] = in1[1];
|
|
|
|
out1[0] = in1[0];
|
|
|
|
out0[3] = in0[3];
|
|
|
|
out0[2] = in0[2];
|
|
|
|
out0[1] = in0[1];
|
|
|
|
out0[0] = in0[0];
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-07-25 19:51:04 +00:00
|
|
|
case 1: out1[3] = amd_bytealign_S (in1[3], in1[2], 3);
|
|
|
|
out1[2] = amd_bytealign_S (in1[2], in1[1], 3);
|
|
|
|
out1[1] = amd_bytealign_S (in1[1], in1[0], 3);
|
|
|
|
out1[0] = amd_bytealign_S (in1[0], in0[3], 3);
|
|
|
|
out0[3] = amd_bytealign_S (in0[3], in0[2], 3);
|
|
|
|
out0[2] = amd_bytealign_S (in0[2], in0[1], 3);
|
|
|
|
out0[1] = amd_bytealign_S (in0[1], in0[0], 3);
|
|
|
|
out0[0] = amd_bytealign_S (in0[0], 0, 3);
|
|
|
|
break;
|
|
|
|
case 2: out1[3] = amd_bytealign_S (in1[3], in1[2], 2);
|
|
|
|
out1[2] = amd_bytealign_S (in1[2], in1[1], 2);
|
|
|
|
out1[1] = amd_bytealign_S (in1[1], in1[0], 2);
|
|
|
|
out1[0] = amd_bytealign_S (in1[0], in0[3], 2);
|
|
|
|
out0[3] = amd_bytealign_S (in0[3], in0[2], 2);
|
|
|
|
out0[2] = amd_bytealign_S (in0[2], in0[1], 2);
|
|
|
|
out0[1] = amd_bytealign_S (in0[1], in0[0], 2);
|
|
|
|
out0[0] = amd_bytealign_S (in0[0], 0, 2);
|
|
|
|
break;
|
|
|
|
case 3: out1[3] = amd_bytealign_S (in1[3], in1[2], 1);
|
|
|
|
out1[2] = amd_bytealign_S (in1[2], in1[1], 1);
|
|
|
|
out1[1] = amd_bytealign_S (in1[1], in1[0], 1);
|
|
|
|
out1[0] = amd_bytealign_S (in1[0], in0[3], 1);
|
|
|
|
out0[3] = amd_bytealign_S (in0[3], in0[2], 1);
|
|
|
|
out0[2] = amd_bytealign_S (in0[2], in0[1], 1);
|
|
|
|
out0[1] = amd_bytealign_S (in0[1], in0[0], 1);
|
|
|
|
out0[0] = amd_bytealign_S (in0[0], 0, 1);
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-16 12:34:54 +00:00
|
|
|
case 4: out1[3] = in1[2];
|
|
|
|
out1[2] = in1[1];
|
|
|
|
out1[1] = in1[0];
|
|
|
|
out1[0] = in0[3];
|
|
|
|
out0[3] = in0[2];
|
|
|
|
out0[2] = in0[1];
|
|
|
|
out0[1] = in0[0];
|
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-07-25 19:51:04 +00:00
|
|
|
case 5: out1[3] = amd_bytealign_S (in1[2], in1[1], 3);
|
|
|
|
out1[2] = amd_bytealign_S (in1[1], in1[0], 3);
|
|
|
|
out1[1] = amd_bytealign_S (in1[0], in0[3], 3);
|
|
|
|
out1[0] = amd_bytealign_S (in0[3], in0[2], 3);
|
|
|
|
out0[3] = amd_bytealign_S (in0[2], in0[1], 3);
|
|
|
|
out0[2] = amd_bytealign_S (in0[1], in0[0], 3);
|
|
|
|
out0[1] = amd_bytealign_S (in0[0], 0, 3);
|
2016-01-16 12:34:54 +00:00
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-07-25 19:51:04 +00:00
|
|
|
case 6: out1[3] = amd_bytealign_S (in1[2], in1[1], 2);
|
|
|
|
out1[2] = amd_bytealign_S (in1[1], in1[0], 2);
|
|
|
|
out1[1] = amd_bytealign_S (in1[0], in0[3], 2);
|
|
|
|
out1[0] = amd_bytealign_S (in0[3], in0[2], 2);
|
|
|
|
out0[3] = amd_bytealign_S (in0[2], in0[1], 2);
|
|
|
|
out0[2] = amd_bytealign_S (in0[1], in0[0], 2);
|
|
|
|
out0[1] = amd_bytealign_S (in0[0], 0, 2);
|
2016-01-16 12:34:54 +00:00
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-07-25 19:51:04 +00:00
|
|
|
case 7: out1[3] = amd_bytealign_S (in1[2], in1[1], 1);
|
|
|
|
out1[2] = amd_bytealign_S (in1[1], in1[0], 1);
|
|
|
|
out1[1] = amd_bytealign_S (in1[0], in0[3], 1);
|
|
|
|
out1[0] = amd_bytealign_S (in0[3], in0[2], 1);
|
|
|
|
out0[3] = amd_bytealign_S (in0[2], in0[1], 1);
|
|
|
|
out0[2] = amd_bytealign_S (in0[1], in0[0], 1);
|
|
|
|
out0[1] = amd_bytealign_S (in0[0], 0, 1);
|
2016-01-16 12:34:54 +00:00
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-16 12:34:54 +00:00
|
|
|
case 8: out1[3] = in1[1];
|
|
|
|
out1[2] = in1[0];
|
|
|
|
out1[1] = in0[3];
|
|
|
|
out1[0] = in0[2];
|
|
|
|
out0[3] = in0[1];
|
|
|
|
out0[2] = in0[0];
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-07-25 19:51:04 +00:00
|
|
|
case 9: out1[3] = amd_bytealign_S (in1[1], in1[0], 3);
|
|
|
|
out1[2] = amd_bytealign_S (in1[0], in0[3], 3);
|
|
|
|
out1[1] = amd_bytealign_S (in0[3], in0[2], 3);
|
|
|
|
out1[0] = amd_bytealign_S (in0[2], in0[1], 3);
|
|
|
|
out0[3] = amd_bytealign_S (in0[1], in0[0], 3);
|
|
|
|
out0[2] = amd_bytealign_S (in0[0], 0, 3);
|
2016-01-16 12:34:54 +00:00
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-07-25 19:51:04 +00:00
|
|
|
case 10: out1[3] = amd_bytealign_S (in1[1], in1[0], 2);
|
|
|
|
out1[2] = amd_bytealign_S (in1[0], in0[3], 2);
|
|
|
|
out1[1] = amd_bytealign_S (in0[3], in0[2], 2);
|
|
|
|
out1[0] = amd_bytealign_S (in0[2], in0[1], 2);
|
|
|
|
out0[3] = amd_bytealign_S (in0[1], in0[0], 2);
|
|
|
|
out0[2] = amd_bytealign_S (in0[0], 0, 2);
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 11: out1[3] = amd_bytealign_S (in1[1], in1[0], 1);
|
|
|
|
out1[2] = amd_bytealign_S (in1[0], in0[3], 1);
|
|
|
|
out1[1] = amd_bytealign_S (in0[3], in0[2], 1);
|
|
|
|
out1[0] = amd_bytealign_S (in0[2], in0[1], 1);
|
|
|
|
out0[3] = amd_bytealign_S (in0[1], in0[0], 1);
|
|
|
|
out0[2] = amd_bytealign_S (in0[0], 0, 1);
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2015-12-15 11:04:22 +00:00
|
|
|
case 12: out1[3] = in1[0];
|
|
|
|
out1[2] = in0[3];
|
|
|
|
out1[1] = in0[2];
|
|
|
|
out1[0] = in0[1];
|
|
|
|
out0[3] = in0[0];
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 13: out1[3] = amd_bytealign_S (in1[0], in0[3], 3);
|
|
|
|
out1[2] = amd_bytealign_S (in0[3], in0[2], 3);
|
|
|
|
out1[1] = amd_bytealign_S (in0[2], in0[1], 3);
|
|
|
|
out1[0] = amd_bytealign_S (in0[1], in0[0], 3);
|
|
|
|
out0[3] = amd_bytealign_S (in0[0], 0, 3);
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 14: out1[3] = amd_bytealign_S (in1[0], in0[3], 2);
|
|
|
|
out1[2] = amd_bytealign_S (in0[3], in0[2], 2);
|
|
|
|
out1[1] = amd_bytealign_S (in0[2], in0[1], 2);
|
|
|
|
out1[0] = amd_bytealign_S (in0[1], in0[0], 2);
|
|
|
|
out0[3] = amd_bytealign_S (in0[0], 0, 2);
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 15: out1[3] = amd_bytealign_S (in1[0], in0[3], 1);
|
|
|
|
out1[2] = amd_bytealign_S (in0[3], in0[2], 1);
|
|
|
|
out1[1] = amd_bytealign_S (in0[2], in0[1], 1);
|
|
|
|
out1[0] = amd_bytealign_S (in0[1], in0[0], 1);
|
|
|
|
out0[3] = amd_bytealign_S (in0[0], 0, 1);
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[2] = 0;
|
|
|
|
out0[1] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
|
|
|
case 16: out1[3] = in0[3];
|
|
|
|
out1[2] = in0[2];
|
|
|
|
out1[1] = in0[1];
|
|
|
|
out1[0] = in0[0];
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[3] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[2] = 0;
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 17: out1[3] = amd_bytealign_S (in0[3], in0[2], 3);
|
|
|
|
out1[2] = amd_bytealign_S (in0[2], in0[1], 3);
|
|
|
|
out1[1] = amd_bytealign_S (in0[1], in0[0], 3);
|
|
|
|
out1[0] = amd_bytealign_S (in0[0], 0, 3);
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[3] = 0;
|
|
|
|
out0[2] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[1] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 18: out1[3] = amd_bytealign_S (in0[3], in0[2], 2);
|
|
|
|
out1[2] = amd_bytealign_S (in0[2], in0[1], 2);
|
|
|
|
out1[1] = amd_bytealign_S (in0[1], in0[0], 2);
|
|
|
|
out1[0] = amd_bytealign_S (in0[0], 0, 2);
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 19: out1[3] = amd_bytealign_S (in0[3], in0[2], 1);
|
|
|
|
out1[2] = amd_bytealign_S (in0[2], in0[1], 1);
|
|
|
|
out1[1] = amd_bytealign_S (in0[1], in0[0], 1);
|
|
|
|
out1[0] = amd_bytealign_S (in0[0], 0, 1);
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[3] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[2] = 0;
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
|
|
|
case 20: out1[3] = in0[2];
|
|
|
|
out1[2] = in0[1];
|
|
|
|
out1[1] = in0[0];
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[0] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[3] = 0;
|
|
|
|
out0[2] = 0;
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 21: out1[3] = amd_bytealign_S (in0[2], in0[1], 3);
|
|
|
|
out1[2] = amd_bytealign_S (in0[1], in0[0], 3);
|
|
|
|
out1[1] = amd_bytealign_S (in0[0], 0, 3);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[0] = 0;
|
|
|
|
out0[3] = 0;
|
|
|
|
out0[2] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[1] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 22: out1[3] = amd_bytealign_S (in0[2], in0[1], 2);
|
|
|
|
out1[2] = amd_bytealign_S (in0[1], in0[0], 2);
|
|
|
|
out1[1] = amd_bytealign_S (in0[0], 0, 2);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[0] = 0;
|
|
|
|
out0[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 23: out1[3] = amd_bytealign_S (in0[2], in0[1], 1);
|
|
|
|
out1[2] = amd_bytealign_S (in0[1], in0[0], 1);
|
|
|
|
out1[1] = amd_bytealign_S (in0[0], 0, 1);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[3] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[2] = 0;
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
|
|
|
case 24: out1[3] = in0[1];
|
|
|
|
out1[2] = in0[0];
|
|
|
|
out1[1] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[0] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[3] = 0;
|
|
|
|
out0[2] = 0;
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 25: out1[3] = amd_bytealign_S (in0[1], in0[0], 3);
|
|
|
|
out1[2] = amd_bytealign_S (in0[0], 0, 3);
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[1] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[0] = 0;
|
|
|
|
out0[3] = 0;
|
|
|
|
out0[2] = 0;
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 26: out1[3] = amd_bytealign_S (in0[1], in0[0], 2);
|
|
|
|
out1[2] = amd_bytealign_S (in0[0], 0, 2);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[1] = 0;
|
|
|
|
out1[0] = 0;
|
|
|
|
out0[3] = 0;
|
|
|
|
out0[2] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[1] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 27: out1[3] = amd_bytealign_S (in0[1], in0[0], 1);
|
|
|
|
out1[2] = amd_bytealign_S (in0[0], 0, 1);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[1] = 0;
|
|
|
|
out1[0] = 0;
|
|
|
|
out0[3] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
|
|
|
case 28: out1[3] = in0[0];
|
|
|
|
out1[2] = 0;
|
|
|
|
out1[1] = 0;
|
|
|
|
out1[0] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out0[3] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[2] = 0;
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 29: out1[3] = amd_bytealign_S (in0[0], 0, 3);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[2] = 0;
|
|
|
|
out1[1] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[0] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out0[3] = 0;
|
|
|
|
out0[2] = 0;
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 30: out1[3] = amd_bytealign_S (in0[0], 0, 2);
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[2] = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[1] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[0] = 0;
|
|
|
|
out0[3] = 0;
|
|
|
|
out0[2] = 0;
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
2016-01-27 19:01:08 +00:00
|
|
|
case 31: out1[3] = amd_bytealign_S (in0[0], 0, 1);
|
2015-12-04 14:47:52 +00:00
|
|
|
out1[2] = 0;
|
2015-12-15 11:04:22 +00:00
|
|
|
out1[1] = 0;
|
|
|
|
out1[0] = 0;
|
2016-07-25 19:51:04 +00:00
|
|
|
out0[3] = 0;
|
|
|
|
out0[2] = 0;
|
|
|
|
out0[1] = 0;
|
|
|
|
out0[0] = 0;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-16 18:27:17 +00:00
|
|
|
static void append_block1 (const u32 offset, u32 buf0[4], u32 buf1[4], const u32 src_r0)
|
2016-07-25 19:51:04 +00:00
|
|
|
{
|
2016-11-01 02:22:55 +00:00
|
|
|
// this version works with 1 byte append only
|
2016-11-01 12:01:15 +00:00
|
|
|
const u32 value = src_r0 & 0xff;
|
|
|
|
|
2017-08-27 14:47:21 +00:00
|
|
|
const u32 tmp = value << 0
|
|
|
|
| value << 8
|
|
|
|
| value << 16
|
|
|
|
| value << 24;
|
|
|
|
|
|
|
|
buf0[0] |= tmp & c_append_helper[offset][0];
|
|
|
|
buf0[1] |= tmp & c_append_helper[offset][1];
|
|
|
|
buf0[2] |= tmp & c_append_helper[offset][2];
|
|
|
|
buf0[3] |= tmp & c_append_helper[offset][3];
|
|
|
|
buf1[0] |= tmp & c_append_helper[offset][4];
|
|
|
|
buf1[1] |= tmp & c_append_helper[offset][5];
|
|
|
|
buf1[2] |= tmp & c_append_helper[offset][6];
|
|
|
|
buf1[3] |= tmp & c_append_helper[offset][7];
|
2016-07-25 19:51:04 +00:00
|
|
|
}
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-16 18:27:17 +00:00
|
|
|
static void append_block8 (const u32 offset, u32 buf0[4], u32 buf1[4], const u32 src_l0[4], const u32 src_l1[4], const u32 src_r0[4], const u32 src_r1[4])
|
2016-07-25 19:51:04 +00:00
|
|
|
{
|
2016-11-05 15:32:59 +00:00
|
|
|
u32 s0 = 0;
|
|
|
|
u32 s1 = 0;
|
|
|
|
u32 s2 = 0;
|
|
|
|
u32 s3 = 0;
|
|
|
|
u32 s4 = 0;
|
|
|
|
u32 s5 = 0;
|
|
|
|
u32 s6 = 0;
|
|
|
|
u32 s7 = 0;
|
2017-08-05 17:46:56 +00:00
|
|
|
|
2017-08-24 13:09:55 +00:00
|
|
|
#if defined IS_AMD_LEGACY || defined IS_GENERIC
|
2017-08-05 17:46:56 +00:00
|
|
|
const u32 src_r00 = swap32_S (src_r0[0]);
|
|
|
|
const u32 src_r01 = swap32_S (src_r0[1]);
|
|
|
|
const u32 src_r02 = swap32_S (src_r0[2]);
|
|
|
|
const u32 src_r03 = swap32_S (src_r0[3]);
|
|
|
|
const u32 src_r10 = swap32_S (src_r1[0]);
|
|
|
|
const u32 src_r11 = swap32_S (src_r1[1]);
|
|
|
|
const u32 src_r12 = swap32_S (src_r1[2]);
|
|
|
|
const u32 src_r13 = swap32_S (src_r1[3]);
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
switch (offset / 4)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2016-11-05 15:32:59 +00:00
|
|
|
case 0:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = amd_bytealign_S (src_r12, src_r13, offset);
|
|
|
|
s6 = amd_bytealign_S (src_r11, src_r12, offset);
|
|
|
|
s5 = amd_bytealign_S (src_r10, src_r11, offset);
|
|
|
|
s4 = amd_bytealign_S (src_r03, src_r10, offset);
|
|
|
|
s3 = amd_bytealign_S (src_r02, src_r03, offset);
|
|
|
|
s2 = amd_bytealign_S (src_r01, src_r02, offset);
|
|
|
|
s1 = amd_bytealign_S (src_r00, src_r01, offset);
|
|
|
|
s0 = amd_bytealign_S ( 0, src_r00, offset);
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
case 1:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = amd_bytealign_S (src_r11, src_r12, offset);
|
|
|
|
s6 = amd_bytealign_S (src_r10, src_r11, offset);
|
|
|
|
s5 = amd_bytealign_S (src_r03, src_r10, offset);
|
|
|
|
s4 = amd_bytealign_S (src_r02, src_r03, offset);
|
|
|
|
s3 = amd_bytealign_S (src_r01, src_r02, offset);
|
|
|
|
s2 = amd_bytealign_S (src_r00, src_r01, offset);
|
|
|
|
s1 = amd_bytealign_S ( 0, src_r00, offset);
|
2016-11-05 15:32:59 +00:00
|
|
|
s0 = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
case 2:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = amd_bytealign_S (src_r10, src_r11, offset);
|
|
|
|
s6 = amd_bytealign_S (src_r03, src_r10, offset);
|
|
|
|
s5 = amd_bytealign_S (src_r02, src_r03, offset);
|
|
|
|
s4 = amd_bytealign_S (src_r01, src_r02, offset);
|
|
|
|
s3 = amd_bytealign_S (src_r00, src_r01, offset);
|
|
|
|
s2 = amd_bytealign_S ( 0, src_r00, offset);
|
2016-11-05 15:32:59 +00:00
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
case 3:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = amd_bytealign_S (src_r03, src_r10, offset);
|
|
|
|
s6 = amd_bytealign_S (src_r02, src_r03, offset);
|
|
|
|
s5 = amd_bytealign_S (src_r01, src_r02, offset);
|
|
|
|
s4 = amd_bytealign_S (src_r00, src_r01, offset);
|
|
|
|
s3 = amd_bytealign_S ( 0, src_r00, offset);
|
2016-11-05 15:32:59 +00:00
|
|
|
s2 = 0;
|
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
2017-08-05 17:46:56 +00:00
|
|
|
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
case 4:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = amd_bytealign_S (src_r02, src_r03, offset);
|
|
|
|
s6 = amd_bytealign_S (src_r01, src_r02, offset);
|
|
|
|
s5 = amd_bytealign_S (src_r00, src_r01, offset);
|
|
|
|
s4 = amd_bytealign_S ( 0, src_r00, offset);
|
2016-11-05 15:32:59 +00:00
|
|
|
s3 = 0;
|
|
|
|
s2 = 0;
|
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
case 5:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = amd_bytealign_S (src_r01, src_r02, offset);
|
|
|
|
s6 = amd_bytealign_S (src_r00, src_r01, offset);
|
|
|
|
s5 = amd_bytealign_S ( 0, src_r00, offset);
|
2016-11-05 15:32:59 +00:00
|
|
|
s4 = 0;
|
|
|
|
s3 = 0;
|
|
|
|
s2 = 0;
|
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
case 6:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = amd_bytealign_S (src_r00, src_r01, offset);
|
|
|
|
s6 = amd_bytealign_S ( 0, src_r00, offset);
|
2016-11-05 15:32:59 +00:00
|
|
|
s5 = 0;
|
|
|
|
s4 = 0;
|
|
|
|
s3 = 0;
|
|
|
|
s2 = 0;
|
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
2016-01-19 19:54:25 +00:00
|
|
|
case 7:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = amd_bytealign_S ( 0, src_r00, offset);
|
2016-11-05 15:32:59 +00:00
|
|
|
s6 = 0;
|
|
|
|
s5 = 0;
|
|
|
|
s4 = 0;
|
|
|
|
s3 = 0;
|
|
|
|
s2 = 0;
|
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
}
|
|
|
|
|
2017-08-05 17:46:56 +00:00
|
|
|
s0 = swap32_S (s0);
|
|
|
|
s1 = swap32_S (s1);
|
|
|
|
s2 = swap32_S (s2);
|
|
|
|
s3 = swap32_S (s3);
|
|
|
|
s4 = swap32_S (s4);
|
|
|
|
s5 = swap32_S (s5);
|
|
|
|
s6 = swap32_S (s6);
|
|
|
|
s7 = swap32_S (s7);
|
2016-11-05 15:32:59 +00:00
|
|
|
#endif
|
|
|
|
|
2017-08-24 13:09:55 +00:00
|
|
|
#if defined IS_AMD_ROCM || defined IS_NV
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
const int offset_mod_4 = offset & 3;
|
|
|
|
|
|
|
|
const int offset_minus_4 = 4 - offset_mod_4;
|
|
|
|
|
2017-08-24 13:09:55 +00:00
|
|
|
#if defined IS_NV
|
2016-11-05 15:32:59 +00:00
|
|
|
const int selector = (0x76543210 >> (offset_minus_4 * 4)) & 0xffff;
|
2017-08-24 13:09:55 +00:00
|
|
|
#endif
|
|
|
|
|
2017-08-24 15:19:16 +00:00
|
|
|
#if defined IS_AMD_ROCM
|
2017-08-24 13:09:55 +00:00
|
|
|
const int selector = 0x0706050403020100 >> (offset_minus_4 * 8);
|
|
|
|
#endif
|
2016-11-05 15:32:59 +00:00
|
|
|
|
2017-08-05 17:46:56 +00:00
|
|
|
const u32 src_r00 = src_r0[0];
|
|
|
|
const u32 src_r01 = src_r0[1];
|
|
|
|
const u32 src_r02 = src_r0[2];
|
|
|
|
const u32 src_r03 = src_r0[3];
|
|
|
|
const u32 src_r10 = src_r1[0];
|
|
|
|
const u32 src_r11 = src_r1[1];
|
|
|
|
const u32 src_r12 = src_r1[2];
|
|
|
|
const u32 src_r13 = src_r1[3];
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
switch (offset / 4)
|
|
|
|
{
|
|
|
|
case 0:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = __byte_perm_S (src_r12, src_r13, selector);
|
|
|
|
s6 = __byte_perm_S (src_r11, src_r12, selector);
|
|
|
|
s5 = __byte_perm_S (src_r10, src_r11, selector);
|
|
|
|
s4 = __byte_perm_S (src_r03, src_r10, selector);
|
|
|
|
s3 = __byte_perm_S (src_r02, src_r03, selector);
|
|
|
|
s2 = __byte_perm_S (src_r01, src_r02, selector);
|
|
|
|
s1 = __byte_perm_S (src_r00, src_r01, selector);
|
|
|
|
s0 = __byte_perm_S ( 0, src_r00, selector);
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
case 1:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = __byte_perm_S (src_r11, src_r12, selector);
|
|
|
|
s6 = __byte_perm_S (src_r10, src_r11, selector);
|
|
|
|
s5 = __byte_perm_S (src_r03, src_r10, selector);
|
|
|
|
s4 = __byte_perm_S (src_r02, src_r03, selector);
|
|
|
|
s3 = __byte_perm_S (src_r01, src_r02, selector);
|
|
|
|
s2 = __byte_perm_S (src_r00, src_r01, selector);
|
|
|
|
s1 = __byte_perm_S ( 0, src_r00, selector);
|
2016-11-05 15:32:59 +00:00
|
|
|
s0 = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
case 2:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = __byte_perm_S (src_r10, src_r11, selector);
|
|
|
|
s6 = __byte_perm_S (src_r03, src_r10, selector);
|
|
|
|
s5 = __byte_perm_S (src_r02, src_r03, selector);
|
|
|
|
s4 = __byte_perm_S (src_r01, src_r02, selector);
|
|
|
|
s3 = __byte_perm_S (src_r00, src_r01, selector);
|
|
|
|
s2 = __byte_perm_S ( 0, src_r00, selector);
|
2016-11-05 15:32:59 +00:00
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
2016-01-19 19:54:25 +00:00
|
|
|
case 3:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = __byte_perm_S (src_r03, src_r10, selector);
|
|
|
|
s6 = __byte_perm_S (src_r02, src_r03, selector);
|
|
|
|
s5 = __byte_perm_S (src_r01, src_r02, selector);
|
|
|
|
s4 = __byte_perm_S (src_r00, src_r01, selector);
|
|
|
|
s3 = __byte_perm_S ( 0, src_r00, selector);
|
2016-11-05 15:32:59 +00:00
|
|
|
s2 = 0;
|
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
|
|
|
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
case 4:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = __byte_perm_S (src_r02, src_r03, selector);
|
|
|
|
s6 = __byte_perm_S (src_r01, src_r02, selector);
|
|
|
|
s5 = __byte_perm_S (src_r00, src_r01, selector);
|
|
|
|
s4 = __byte_perm_S ( 0, src_r00, selector);
|
2016-11-05 15:32:59 +00:00
|
|
|
s3 = 0;
|
|
|
|
s2 = 0;
|
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
case 5:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = __byte_perm_S (src_r01, src_r02, selector);
|
|
|
|
s6 = __byte_perm_S (src_r00, src_r01, selector);
|
|
|
|
s5 = __byte_perm_S ( 0, src_r00, selector);
|
2016-11-05 15:32:59 +00:00
|
|
|
s4 = 0;
|
|
|
|
s3 = 0;
|
|
|
|
s2 = 0;
|
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
2016-01-19 19:54:25 +00:00
|
|
|
break;
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
case 6:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = __byte_perm_S (src_r00, src_r01, selector);
|
|
|
|
s6 = __byte_perm_S ( 0, src_r00, selector);
|
2016-11-05 15:32:59 +00:00
|
|
|
s5 = 0;
|
|
|
|
s4 = 0;
|
|
|
|
s3 = 0;
|
|
|
|
s2 = 0;
|
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
|
|
|
break;
|
|
|
|
|
|
|
|
case 7:
|
2017-08-05 17:46:56 +00:00
|
|
|
s7 = __byte_perm_S ( 0, src_r00, selector);
|
2016-11-05 15:32:59 +00:00
|
|
|
s6 = 0;
|
|
|
|
s5 = 0;
|
|
|
|
s4 = 0;
|
|
|
|
s3 = 0;
|
|
|
|
s2 = 0;
|
|
|
|
s1 = 0;
|
|
|
|
s0 = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
break;
|
|
|
|
}
|
2017-08-05 17:46:56 +00:00
|
|
|
#endif
|
2016-11-05 15:32:59 +00:00
|
|
|
|
|
|
|
buf0[0] = src_l0[0] | s0;
|
|
|
|
buf0[1] = src_l0[1] | s1;
|
|
|
|
buf0[2] = src_l0[2] | s2;
|
|
|
|
buf0[3] = src_l0[3] | s3;
|
|
|
|
buf1[0] = src_l1[0] | s4;
|
|
|
|
buf1[1] = src_l1[1] | s5;
|
|
|
|
buf1[2] = src_l1[2] | s6;
|
|
|
|
buf1[3] = src_l1[3] | s7;
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
2017-08-16 18:27:17 +00:00
|
|
|
static void reverse_block (u32 in0[4], u32 in1[4], u32 out0[4], u32 out1[4], const u32 len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
|
|
|
rshift_block_N (in0, in1, out0, out1, 32 - len);
|
|
|
|
|
2015-12-15 11:04:22 +00:00
|
|
|
u32 tib40[4];
|
|
|
|
u32 tib41[4];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
tib40[0] = out1[3];
|
|
|
|
tib40[1] = out1[2];
|
|
|
|
tib40[2] = out1[1];
|
|
|
|
tib40[3] = out1[0];
|
|
|
|
tib41[0] = out0[3];
|
|
|
|
tib41[1] = out0[2];
|
|
|
|
tib41[2] = out0[1];
|
|
|
|
tib41[3] = out0[0];
|
|
|
|
|
2016-01-27 19:01:08 +00:00
|
|
|
out0[0] = swap32_S (tib40[0]);
|
|
|
|
out0[1] = swap32_S (tib40[1]);
|
|
|
|
out0[2] = swap32_S (tib40[2]);
|
|
|
|
out0[3] = swap32_S (tib40[3]);
|
|
|
|
out1[0] = swap32_S (tib41[0]);
|
|
|
|
out1[1] = swap32_S (tib41[1]);
|
|
|
|
out1[2] = swap32_S (tib41[2]);
|
|
|
|
out1[3] = swap32_S (tib41[3]);
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
static void exchange_byte (u32 *buf, const int off_src, const int off_dst)
|
|
|
|
{
|
|
|
|
u8 *ptr = (u8 *) buf;
|
|
|
|
|
|
|
|
const u8 tmp = ptr[off_src];
|
|
|
|
|
|
|
|
ptr[off_src] = ptr[off_dst];
|
|
|
|
ptr[off_dst] = tmp;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_lrest (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 13:09:55 +00:00
|
|
|
u32 t;
|
|
|
|
|
|
|
|
t = buf0[0]; buf0[0] = t | generate_cmask (t);
|
|
|
|
t = buf0[1]; buf0[1] = t | generate_cmask (t);
|
|
|
|
t = buf0[2]; buf0[2] = t | generate_cmask (t);
|
|
|
|
t = buf0[3]; buf0[3] = t | generate_cmask (t);
|
|
|
|
t = buf1[0]; buf1[0] = t | generate_cmask (t);
|
|
|
|
t = buf1[1]; buf1[1] = t | generate_cmask (t);
|
|
|
|
t = buf1[2]; buf1[2] = t | generate_cmask (t);
|
|
|
|
t = buf1[3]; buf1[3] = t | generate_cmask (t);
|
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_urest (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 13:09:55 +00:00
|
|
|
u32 t;
|
|
|
|
|
|
|
|
t = buf0[0]; buf0[0] = t & ~(generate_cmask (t));
|
|
|
|
t = buf0[1]; buf0[1] = t & ~(generate_cmask (t));
|
|
|
|
t = buf0[2]; buf0[2] = t & ~(generate_cmask (t));
|
|
|
|
t = buf0[3]; buf0[3] = t & ~(generate_cmask (t));
|
|
|
|
t = buf1[0]; buf1[0] = t & ~(generate_cmask (t));
|
|
|
|
t = buf1[1]; buf1[1] = t & ~(generate_cmask (t));
|
|
|
|
t = buf1[2]; buf1[2] = t & ~(generate_cmask (t));
|
|
|
|
t = buf1[3]; buf1[3] = t & ~(generate_cmask (t));
|
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_lrest_ufirst (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 13:09:55 +00:00
|
|
|
u32 t;
|
|
|
|
|
|
|
|
t = buf0[0]; buf0[0] = t | generate_cmask (t);
|
|
|
|
t = buf0[1]; buf0[1] = t | generate_cmask (t);
|
|
|
|
t = buf0[2]; buf0[2] = t | generate_cmask (t);
|
|
|
|
t = buf0[3]; buf0[3] = t | generate_cmask (t);
|
|
|
|
t = buf1[0]; buf1[0] = t | generate_cmask (t);
|
|
|
|
t = buf1[1]; buf1[1] = t | generate_cmask (t);
|
|
|
|
t = buf1[2]; buf1[2] = t | generate_cmask (t);
|
|
|
|
t = buf1[3]; buf1[3] = t | generate_cmask (t);
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 13:09:55 +00:00
|
|
|
t = buf0[0]; buf0[0] = t & ~(0x00000020 & generate_cmask (t));
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_urest_lfirst (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 13:09:55 +00:00
|
|
|
u32 t;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 13:09:55 +00:00
|
|
|
t = buf0[0]; buf0[0] = t & ~(generate_cmask (t));
|
|
|
|
t = buf0[1]; buf0[1] = t & ~(generate_cmask (t));
|
|
|
|
t = buf0[2]; buf0[2] = t & ~(generate_cmask (t));
|
|
|
|
t = buf0[3]; buf0[3] = t & ~(generate_cmask (t));
|
|
|
|
t = buf1[0]; buf1[0] = t & ~(generate_cmask (t));
|
|
|
|
t = buf1[1]; buf1[1] = t & ~(generate_cmask (t));
|
|
|
|
t = buf1[2]; buf1[2] = t & ~(generate_cmask (t));
|
|
|
|
t = buf1[3]; buf1[3] = t & ~(generate_cmask (t));
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 13:09:55 +00:00
|
|
|
t = buf0[0]; buf0[0] = t | (0x00000020 & generate_cmask (t));
|
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_trest (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 13:09:55 +00:00
|
|
|
u32 t;
|
|
|
|
|
|
|
|
t = buf0[0]; buf0[0] = t ^ generate_cmask (t);
|
|
|
|
t = buf0[1]; buf0[1] = t ^ generate_cmask (t);
|
|
|
|
t = buf0[2]; buf0[2] = t ^ generate_cmask (t);
|
|
|
|
t = buf0[3]; buf0[3] = t ^ generate_cmask (t);
|
|
|
|
t = buf1[0]; buf1[0] = t ^ generate_cmask (t);
|
|
|
|
t = buf1[1]; buf1[1] = t ^ generate_cmask (t);
|
|
|
|
t = buf1[2]; buf1[2] = t ^ generate_cmask (t);
|
|
|
|
t = buf1[3]; buf1[3] = t ^ generate_cmask (t);
|
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_toggle_at (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 t[8];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
t[0] = buf0[0];
|
|
|
|
t[1] = buf0[1];
|
|
|
|
t[2] = buf0[2];
|
|
|
|
t[3] = buf0[3];
|
|
|
|
t[4] = buf1[0];
|
|
|
|
t[5] = buf1[1];
|
|
|
|
t[6] = buf1[2];
|
|
|
|
t[7] = buf1[3];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
const u32 tmp = t[p0 / 4];
|
|
|
|
|
|
|
|
const u32 m = 0x20u << ((p0 & 3) * 8);
|
|
|
|
|
|
|
|
t[p0 / 4] = tmp ^ (m & generate_cmask (tmp));
|
|
|
|
|
|
|
|
buf0[0] = t[0];
|
|
|
|
buf0[1] = t[1];
|
|
|
|
buf0[2] = t[2];
|
|
|
|
buf0[3] = t[3];
|
|
|
|
buf1[0] = t[4];
|
|
|
|
buf1[1] = t[5];
|
|
|
|
buf1[2] = t[6];
|
|
|
|
buf1[3] = t[7];
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_reverse (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
|
|
|
reverse_block (buf0, buf1, buf0, buf1, in_len);
|
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_dupeword (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if ((in_len + in_len) >= 32) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
2016-01-19 19:54:25 +00:00
|
|
|
append_block8 (out_len, buf0, buf1, buf0, buf1, buf0, buf1);
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
out_len += in_len;
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_dupeword_times (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (((in_len * p0) + in_len) >= 32) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
2015-12-15 11:04:22 +00:00
|
|
|
u32 tib40[4];
|
|
|
|
u32 tib41[4];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
tib40[0] = buf0[0];
|
|
|
|
tib40[1] = buf0[1];
|
|
|
|
tib40[2] = buf0[2];
|
|
|
|
tib40[3] = buf0[3];
|
|
|
|
tib41[0] = buf1[0];
|
|
|
|
tib41[1] = buf1[1];
|
|
|
|
tib41[2] = buf1[2];
|
|
|
|
tib41[3] = buf1[3];
|
|
|
|
|
|
|
|
for (u32 i = 0; i < p0; i++)
|
|
|
|
{
|
|
|
|
append_block8 (out_len, buf0, buf1, buf0, buf1, tib40, tib41);
|
|
|
|
|
|
|
|
out_len += in_len;
|
|
|
|
}
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_reflect (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if ((in_len + in_len) >= 32) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
2016-11-12 15:30:21 +00:00
|
|
|
u32 tib40[4] = { 0 };
|
|
|
|
u32 tib41[4] = { 0 };
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
reverse_block (buf0, buf1, tib40, tib41, out_len);
|
|
|
|
|
|
|
|
append_block8 (out_len, buf0, buf1, buf0, buf1, tib40, tib41);
|
|
|
|
|
|
|
|
out_len += in_len;
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_append (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if ((in_len + 1) >= 32) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
|
|
|
append_block1 (out_len, buf0, buf1, p0);
|
|
|
|
|
|
|
|
out_len++;
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_prepend (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if ((in_len + 1) >= 32) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
|
|
|
rshift_block (buf0, buf1, buf0, buf1);
|
|
|
|
|
|
|
|
buf0[0] = buf0[0] | p0;
|
|
|
|
|
|
|
|
out_len++;
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_rotate_left (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (in_len == 0) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
const u32 in_len1 = in_len - 1;
|
|
|
|
|
2017-08-27 14:47:21 +00:00
|
|
|
const u32 tmp = buf0[0];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
lshift_block (buf0, buf1, buf0, buf1);
|
|
|
|
|
2017-08-27 14:47:21 +00:00
|
|
|
append_block1 (in_len1, buf0, buf1, tmp);
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_rotate_right (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (in_len == 0) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
const u32 in_len1 = in_len - 1;
|
|
|
|
|
|
|
|
const u32 sh = (in_len1 & 3) * 8;
|
|
|
|
|
2015-12-15 11:04:22 +00:00
|
|
|
u32 tmp = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-27 14:47:21 +00:00
|
|
|
tmp |= buf0[0] & c_append_helper[in_len1][0];
|
|
|
|
tmp |= buf0[1] & c_append_helper[in_len1][1];
|
|
|
|
tmp |= buf0[2] & c_append_helper[in_len1][2];
|
|
|
|
tmp |= buf0[3] & c_append_helper[in_len1][3];
|
|
|
|
tmp |= buf1[0] & c_append_helper[in_len1][4];
|
|
|
|
tmp |= buf1[1] & c_append_helper[in_len1][5];
|
|
|
|
tmp |= buf1[2] & c_append_helper[in_len1][6];
|
|
|
|
tmp |= buf1[3] & c_append_helper[in_len1][7];
|
2016-11-01 13:44:35 +00:00
|
|
|
|
|
|
|
tmp = (tmp >> sh) & 0xff;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
rshift_block (buf0, buf1, buf0, buf1);
|
|
|
|
|
|
|
|
buf0[0] |= tmp;
|
|
|
|
|
|
|
|
truncate_right (buf0, buf1, in_len);
|
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_delete_first (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (in_len == 0) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
const u32 in_len1 = in_len - 1;
|
|
|
|
|
|
|
|
lshift_block (buf0, buf1, buf0, buf1);
|
|
|
|
|
|
|
|
return in_len1;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_delete_last (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (in_len == 0) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
const u32 in_len1 = in_len - 1;
|
|
|
|
|
2016-11-01 13:50:54 +00:00
|
|
|
const u32 mask = (1 << ((in_len1 & 3) * 8)) - 1;
|
|
|
|
|
|
|
|
buf0[0] &= (in_len1 < 4) ? mask : 0xffffffff;
|
|
|
|
buf0[1] &= ((in_len1 >= 4) && (in_len1 < 8)) ? mask : 0xffffffff;
|
|
|
|
buf0[2] &= ((in_len1 >= 8) && (in_len1 < 12)) ? mask : 0xffffffff;
|
|
|
|
buf0[3] &= ((in_len1 >= 12) && (in_len1 < 16)) ? mask : 0xffffffff;
|
|
|
|
buf1[0] &= ((in_len1 >= 16) && (in_len1 < 20)) ? mask : 0xffffffff;
|
|
|
|
buf1[1] &= ((in_len1 >= 20) && (in_len1 < 24)) ? mask : 0xffffffff;
|
|
|
|
buf1[2] &= ((in_len1 >= 24) && (in_len1 < 28)) ? mask : 0xffffffff;
|
|
|
|
buf1[3] &= (in_len1 >= 28) ? mask : 0xffffffff;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len1;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_delete_at (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
2015-12-15 11:04:22 +00:00
|
|
|
u32 tib40[4];
|
|
|
|
u32 tib41[4];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
lshift_block (buf0, buf1, tib40, tib41);
|
|
|
|
|
|
|
|
const u32 ml = (1 << ((p0 & 3) * 8)) - 1;
|
|
|
|
const u32 mr = ~ml;
|
|
|
|
|
|
|
|
switch (p0 / 4)
|
|
|
|
{
|
|
|
|
case 0: buf0[0] = (buf0[0] & ml)
|
|
|
|
| (tib40[0] & mr);
|
|
|
|
buf0[1] = tib40[1];
|
|
|
|
buf0[2] = tib40[2];
|
|
|
|
buf0[3] = tib40[3];
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 1: buf0[1] = (buf0[1] & ml)
|
|
|
|
| (tib40[1] & mr);
|
|
|
|
buf0[2] = tib40[2];
|
|
|
|
buf0[3] = tib40[3];
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 2: buf0[2] = (buf0[2] & ml)
|
|
|
|
| (tib40[2] & mr);
|
|
|
|
buf0[3] = tib40[3];
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 3: buf0[3] = (buf0[3] & ml)
|
|
|
|
| (tib40[3] & mr);
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 4: buf1[0] = (buf1[0] & ml)
|
|
|
|
| (tib41[0] & mr);
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 5: buf1[1] = (buf1[1] & ml)
|
|
|
|
| (tib41[1] & mr);
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 6: buf1[2] = (buf1[2] & ml)
|
|
|
|
| (tib41[2] & mr);
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 7: buf1[3] = (buf1[3] & ml)
|
|
|
|
| (tib41[3] & mr);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
out_len--;
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_extract (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
if ((p0 + p1) > in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = p1;
|
|
|
|
|
|
|
|
lshift_block_N (buf0, buf1, buf0, buf1, p0);
|
|
|
|
|
|
|
|
truncate_right (buf0, buf1, out_len);
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_omit (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
if ((p0 + p1) > in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
2015-12-15 11:04:22 +00:00
|
|
|
u32 tib40[4];
|
|
|
|
u32 tib41[4];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
tib40[0] = 0;
|
|
|
|
tib40[1] = 0;
|
|
|
|
tib40[2] = 0;
|
|
|
|
tib40[3] = 0;
|
|
|
|
tib41[0] = 0;
|
|
|
|
tib41[1] = 0;
|
|
|
|
tib41[2] = 0;
|
|
|
|
tib41[3] = 0;
|
|
|
|
|
|
|
|
lshift_block_N (buf0, buf1, tib40, tib41, p1);
|
|
|
|
|
|
|
|
const u32 ml = (1 << ((p0 & 3) * 8)) - 1;
|
|
|
|
const u32 mr = ~ml;
|
|
|
|
|
|
|
|
switch (p0 / 4)
|
|
|
|
{
|
|
|
|
case 0: buf0[0] = (buf0[0] & ml)
|
|
|
|
| (tib40[0] & mr);
|
|
|
|
buf0[1] = tib40[1];
|
|
|
|
buf0[2] = tib40[2];
|
|
|
|
buf0[3] = tib40[3];
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 1: buf0[1] = (buf0[1] & ml)
|
|
|
|
| (tib40[1] & mr);
|
|
|
|
buf0[2] = tib40[2];
|
|
|
|
buf0[3] = tib40[3];
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 2: buf0[2] = (buf0[2] & ml)
|
|
|
|
| (tib40[2] & mr);
|
|
|
|
buf0[3] = tib40[3];
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 3: buf0[3] = (buf0[3] & ml)
|
|
|
|
| (tib40[3] & mr);
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 4: buf1[0] = (buf1[0] & ml)
|
|
|
|
| (tib41[0] & mr);
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 5: buf1[1] = (buf1[1] & ml)
|
|
|
|
| (tib41[1] & mr);
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 6: buf1[2] = (buf1[2] & ml)
|
|
|
|
| (tib41[2] & mr);
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 7: buf1[3] = (buf1[3] & ml)
|
|
|
|
| (tib41[3] & mr);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
out_len -= p1;
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_insert (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 > in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
if ((in_len + 1) >= 32) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
2015-12-15 11:04:22 +00:00
|
|
|
u32 tib40[4];
|
|
|
|
u32 tib41[4];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
rshift_block (buf0, buf1, tib40, tib41);
|
|
|
|
|
|
|
|
const u32 p1n = p1 << ((p0 & 3) * 8);
|
|
|
|
|
|
|
|
const u32 ml = (1 << ((p0 & 3) * 8)) - 1;
|
|
|
|
|
|
|
|
const u32 mr = 0xffffff00 << ((p0 & 3) * 8);
|
|
|
|
|
|
|
|
switch (p0 / 4)
|
|
|
|
{
|
|
|
|
case 0: buf0[0] = (buf0[0] & ml) | p1n | (tib40[0] & mr);
|
|
|
|
buf0[1] = tib40[1];
|
|
|
|
buf0[2] = tib40[2];
|
|
|
|
buf0[3] = tib40[3];
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 1: buf0[1] = (buf0[1] & ml) | p1n | (tib40[1] & mr);
|
|
|
|
buf0[2] = tib40[2];
|
|
|
|
buf0[3] = tib40[3];
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 2: buf0[2] = (buf0[2] & ml) | p1n | (tib40[2] & mr);
|
|
|
|
buf0[3] = tib40[3];
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 3: buf0[3] = (buf0[3] & ml) | p1n | (tib40[3] & mr);
|
|
|
|
buf1[0] = tib41[0];
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 4: buf1[0] = (buf1[0] & ml) | p1n | (tib41[0] & mr);
|
|
|
|
buf1[1] = tib41[1];
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 5: buf1[1] = (buf1[1] & ml) | p1n | (tib41[1] & mr);
|
|
|
|
buf1[2] = tib41[2];
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 6: buf1[2] = (buf1[2] & ml) | p1n | (tib41[2] & mr);
|
|
|
|
buf1[3] = tib41[3];
|
|
|
|
break;
|
|
|
|
case 7: buf1[3] = (buf1[3] & ml) | p1n | (tib41[3] & mr);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
out_len++;
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_overstrike (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
const u32 p1n = p1 << ((p0 & 3) * 8);
|
|
|
|
|
2016-01-14 19:54:41 +00:00
|
|
|
const u32 m = ~(0xffu << ((p0 & 3) * 8));
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 t[8];
|
|
|
|
|
|
|
|
t[0] = buf0[0];
|
|
|
|
t[1] = buf0[1];
|
|
|
|
t[2] = buf0[2];
|
|
|
|
t[3] = buf0[3];
|
|
|
|
t[4] = buf1[0];
|
|
|
|
t[5] = buf1[1];
|
|
|
|
t[6] = buf1[2];
|
|
|
|
t[7] = buf1[3];
|
|
|
|
|
|
|
|
const u32 tmp = t[p0 / 4];
|
|
|
|
|
|
|
|
t[p0 / 4] = (tmp & m) | p1n;
|
|
|
|
|
|
|
|
buf0[0] = t[0];
|
|
|
|
buf0[1] = t[1];
|
|
|
|
buf0[2] = t[2];
|
|
|
|
buf0[3] = t[3];
|
|
|
|
buf1[0] = t[4];
|
|
|
|
buf1[1] = t[5];
|
|
|
|
buf1[2] = t[6];
|
|
|
|
buf1[3] = t[7];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_truncate_at (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
truncate_right (buf0, buf1, p0);
|
|
|
|
|
|
|
|
return p0;
|
|
|
|
}
|
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
static u32 search_on_register (const u32 in, const u32 p0)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
u32 r = 0;
|
2017-08-23 22:49:46 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
if (__bfe_S (in, 0, 8) == p0) r |= 1;
|
|
|
|
if (__bfe_S (in, 8, 8) == p0) r |= 2;
|
|
|
|
if (__bfe_S (in, 16, 8) == p0) r |= 4;
|
|
|
|
if (__bfe_S (in, 24, 8) == p0) r |= 8;
|
2017-08-23 22:49:46 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
return r;
|
|
|
|
}
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
static u32 replace_on_register (const u32 in, const u32 r, const u32 p1)
|
|
|
|
{
|
|
|
|
u32 out = in;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
if (r & 1) out = (out & 0xffffff00) | (p1 << 0);
|
|
|
|
if (r & 2) out = (out & 0xffff00ff) | (p1 << 8);
|
|
|
|
if (r & 4) out = (out & 0xff00ffff) | (p1 << 16);
|
|
|
|
if (r & 8) out = (out & 0x00ffffff) | (p1 << 24);
|
2017-08-23 22:49:46 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
return out;
|
|
|
|
}
|
2017-08-23 22:49:46 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
static u32 rule_op_mangle_replace (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
|
|
|
{
|
|
|
|
const u32 r0 = search_on_register (buf0[0], p0);
|
|
|
|
const u32 r1 = search_on_register (buf0[1], p0);
|
|
|
|
const u32 r2 = search_on_register (buf0[2], p0);
|
|
|
|
const u32 r3 = search_on_register (buf0[3], p0);
|
|
|
|
const u32 r4 = search_on_register (buf1[0], p0);
|
|
|
|
const u32 r5 = search_on_register (buf1[1], p0);
|
|
|
|
const u32 r6 = search_on_register (buf1[2], p0);
|
|
|
|
const u32 r7 = search_on_register (buf1[3], p0);
|
|
|
|
|
|
|
|
const u32 rn = r0 + r1 + r2 + r3 + r4 + r5 + r6 + r7;
|
|
|
|
|
|
|
|
if (rn == 0) return in_len;
|
|
|
|
|
|
|
|
buf0[0] = replace_on_register (buf0[0], r0, p1);
|
|
|
|
buf0[1] = replace_on_register (buf0[1], r1, p1);
|
|
|
|
buf0[2] = replace_on_register (buf0[2], r2, p1);
|
|
|
|
buf0[3] = replace_on_register (buf0[3], r3, p1);
|
|
|
|
buf1[0] = replace_on_register (buf1[0], r4, p1);
|
|
|
|
buf1[1] = replace_on_register (buf1[1], r5, p1);
|
|
|
|
buf1[2] = replace_on_register (buf1[2], r6, p1);
|
|
|
|
buf1[3] = replace_on_register (buf1[3], r7, p1);
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_purgechar (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
const u32 r0 = search_on_register (buf0[0], p0);
|
|
|
|
const u32 r1 = search_on_register (buf0[1], p0);
|
|
|
|
const u32 r2 = search_on_register (buf0[2], p0);
|
|
|
|
const u32 r3 = search_on_register (buf0[3], p0);
|
|
|
|
const u32 r4 = search_on_register (buf1[0], p0);
|
|
|
|
const u32 r5 = search_on_register (buf1[1], p0);
|
|
|
|
const u32 r6 = search_on_register (buf1[2], p0);
|
|
|
|
const u32 r7 = search_on_register (buf1[3], p0);
|
|
|
|
|
|
|
|
const u32 rn = r0 + r1 + r2 + r3 + r4 + r5 + r6 + r7;
|
|
|
|
|
|
|
|
if (rn == 0) return in_len;
|
2017-08-23 22:49:46 +00:00
|
|
|
|
2016-07-25 20:54:07 +00:00
|
|
|
u32 out_len = 0;
|
|
|
|
|
|
|
|
u32 buf_in[8];
|
|
|
|
|
|
|
|
buf_in[0] = buf0[0];
|
|
|
|
buf_in[1] = buf0[1];
|
|
|
|
buf_in[2] = buf0[2];
|
|
|
|
buf_in[3] = buf0[3];
|
|
|
|
buf_in[4] = buf1[0];
|
|
|
|
buf_in[5] = buf1[1];
|
|
|
|
buf_in[6] = buf1[2];
|
|
|
|
buf_in[7] = buf1[3];
|
|
|
|
|
|
|
|
u32 buf_out[8] = { 0 };
|
|
|
|
|
|
|
|
u8 *in = (u8 *) buf_in;
|
|
|
|
u8 *out = (u8 *) buf_out;
|
|
|
|
|
|
|
|
for (u32 pos = 0; pos < in_len; pos++)
|
|
|
|
{
|
|
|
|
if (in[pos] == (u8) p0) continue;
|
|
|
|
|
|
|
|
out[out_len] = in[pos];
|
|
|
|
|
|
|
|
out_len++;
|
|
|
|
}
|
|
|
|
|
|
|
|
buf0[0] = buf_out[0];
|
|
|
|
buf0[1] = buf_out[1];
|
|
|
|
buf0[2] = buf_out[2];
|
|
|
|
buf0[3] = buf_out[3];
|
|
|
|
buf1[0] = buf_out[4];
|
|
|
|
buf1[1] = buf_out[5];
|
|
|
|
buf1[2] = buf_out[6];
|
|
|
|
buf1[3] = buf_out[7];
|
|
|
|
|
|
|
|
return out_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_dupechar_first (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if ( in_len == 0) return in_len;
|
|
|
|
if ((in_len + p0) >= 32) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
2015-12-15 11:04:22 +00:00
|
|
|
const u32 tmp = buf0[0] & 0xFF;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
const u32 tmp32 = tmp << 0
|
|
|
|
| tmp << 8
|
|
|
|
| tmp << 16
|
|
|
|
| tmp << 24;
|
|
|
|
|
2015-12-04 14:47:52 +00:00
|
|
|
rshift_block_N (buf0, buf1, buf0, buf1, p0);
|
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 t0[4] = { tmp32, tmp32, tmp32, tmp32 };
|
|
|
|
u32 t1[4] = { tmp32, tmp32, tmp32, tmp32 };
|
|
|
|
|
|
|
|
truncate_right (t0, t1, p0);
|
|
|
|
|
|
|
|
buf0[0] |= t0[0];
|
|
|
|
buf0[1] |= t0[1];
|
|
|
|
buf0[2] |= t0[2];
|
|
|
|
buf0[3] |= t0[3];
|
|
|
|
buf1[0] |= t1[0];
|
|
|
|
buf1[1] |= t1[1];
|
|
|
|
buf1[2] |= t1[2];
|
|
|
|
buf1[3] |= t1[3];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
out_len += p0;
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_dupechar_last (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if ( in_len == 0) return in_len;
|
|
|
|
if ((in_len + p0) >= 32) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
const u32 in_len1 = in_len - 1;
|
|
|
|
|
|
|
|
const u32 sh = (in_len1 & 3) * 8;
|
|
|
|
|
2015-12-15 11:04:22 +00:00
|
|
|
u32 tmp = 0;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-27 14:47:21 +00:00
|
|
|
tmp |= buf0[0] & c_append_helper[in_len1][0];
|
|
|
|
tmp |= buf0[1] & c_append_helper[in_len1][1];
|
|
|
|
tmp |= buf0[2] & c_append_helper[in_len1][2];
|
|
|
|
tmp |= buf0[3] & c_append_helper[in_len1][3];
|
|
|
|
tmp |= buf1[0] & c_append_helper[in_len1][4];
|
|
|
|
tmp |= buf1[1] & c_append_helper[in_len1][5];
|
|
|
|
tmp |= buf1[2] & c_append_helper[in_len1][6];
|
|
|
|
tmp |= buf1[3] & c_append_helper[in_len1][7];
|
2016-11-01 13:54:45 +00:00
|
|
|
|
|
|
|
tmp = (tmp >> sh) & 0xff;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
|
|
|
for (u32 i = 0; i < p0; i++)
|
|
|
|
{
|
|
|
|
append_block1 (out_len, buf0, buf1, tmp);
|
|
|
|
|
|
|
|
out_len++;
|
|
|
|
}
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_dupechar_all (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if ( in_len == 0) return in_len;
|
|
|
|
if ((in_len + in_len) >= 32) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
2015-12-15 11:04:22 +00:00
|
|
|
u32 tib40[4];
|
|
|
|
u32 tib41[4];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
tib40[0] = ((buf0[0] & 0x000000FF) << 0) | ((buf0[0] & 0x0000FF00) << 8);
|
|
|
|
tib40[1] = ((buf0[0] & 0x00FF0000) >> 16) | ((buf0[0] & 0xFF000000) >> 8);
|
|
|
|
tib40[2] = ((buf0[1] & 0x000000FF) << 0) | ((buf0[1] & 0x0000FF00) << 8);
|
|
|
|
tib40[3] = ((buf0[1] & 0x00FF0000) >> 16) | ((buf0[1] & 0xFF000000) >> 8);
|
|
|
|
tib41[0] = ((buf0[2] & 0x000000FF) << 0) | ((buf0[2] & 0x0000FF00) << 8);
|
|
|
|
tib41[1] = ((buf0[2] & 0x00FF0000) >> 16) | ((buf0[2] & 0xFF000000) >> 8);
|
|
|
|
tib41[2] = ((buf0[3] & 0x000000FF) << 0) | ((buf0[3] & 0x0000FF00) << 8);
|
|
|
|
tib41[3] = ((buf0[3] & 0x00FF0000) >> 16) | ((buf0[3] & 0xFF000000) >> 8);
|
|
|
|
|
|
|
|
buf0[0] = tib40[0] | (tib40[0] << 8);
|
|
|
|
buf0[1] = tib40[1] | (tib40[1] << 8);
|
|
|
|
buf0[2] = tib40[2] | (tib40[2] << 8);
|
|
|
|
buf0[3] = tib40[3] | (tib40[3] << 8);
|
|
|
|
buf1[0] = tib41[0] | (tib41[0] << 8);
|
|
|
|
buf1[1] = tib41[1] | (tib41[1] << 8);
|
|
|
|
buf1[2] = tib41[2] | (tib41[2] << 8);
|
|
|
|
buf1[3] = tib41[3] | (tib41[3] << 8);
|
|
|
|
|
|
|
|
out_len = out_len + out_len;
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_switch_first (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (in_len < 2) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
buf0[0] = (buf0[0] & 0xFFFF0000) | ((buf0[0] << 8) & 0x0000FF00) | ((buf0[0] >> 8) & 0x000000FF);
|
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_switch_last (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (in_len < 2) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 t[8];
|
|
|
|
|
|
|
|
t[0] = buf0[0];
|
|
|
|
t[1] = buf0[1];
|
|
|
|
t[2] = buf0[2];
|
|
|
|
t[3] = buf0[3];
|
|
|
|
t[4] = buf1[0];
|
|
|
|
t[5] = buf1[1];
|
|
|
|
t[6] = buf1[2];
|
|
|
|
t[7] = buf1[3];
|
|
|
|
|
|
|
|
exchange_byte (t, in_len - 2, in_len - 1);
|
|
|
|
|
|
|
|
buf0[0] = t[0];
|
|
|
|
buf0[1] = t[1];
|
|
|
|
buf0[2] = t[2];
|
|
|
|
buf0[3] = t[3];
|
|
|
|
buf1[0] = t[4];
|
|
|
|
buf1[1] = t[5];
|
|
|
|
buf1[2] = t[6];
|
|
|
|
buf1[3] = t[7];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_switch_at (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
|
|
|
if (p1 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 t[8];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
t[0] = buf0[0];
|
|
|
|
t[1] = buf0[1];
|
|
|
|
t[2] = buf0[2];
|
|
|
|
t[3] = buf0[3];
|
|
|
|
t[4] = buf1[0];
|
|
|
|
t[5] = buf1[1];
|
|
|
|
t[6] = buf1[2];
|
|
|
|
t[7] = buf1[3];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
exchange_byte (t, p0, p1);
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
buf0[0] = t[0];
|
|
|
|
buf0[1] = t[1];
|
|
|
|
buf0[2] = t[2];
|
|
|
|
buf0[3] = t[3];
|
|
|
|
buf1[0] = t[4];
|
|
|
|
buf1[1] = t[5];
|
|
|
|
buf1[2] = t[6];
|
|
|
|
buf1[3] = t[7];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_chr_shiftl (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2016-01-14 19:54:41 +00:00
|
|
|
const u32 mr = 0xffu << ((p0 & 3) * 8);
|
2015-12-04 14:47:52 +00:00
|
|
|
const u32 ml = ~mr;
|
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 t[8];
|
|
|
|
|
|
|
|
t[0] = buf0[0];
|
|
|
|
t[1] = buf0[1];
|
|
|
|
t[2] = buf0[2];
|
|
|
|
t[3] = buf0[3];
|
|
|
|
t[4] = buf1[0];
|
|
|
|
t[5] = buf1[1];
|
|
|
|
t[6] = buf1[2];
|
|
|
|
t[7] = buf1[3];
|
|
|
|
|
|
|
|
const u32 tmp = t[p0 / 4];
|
|
|
|
|
|
|
|
t[p0 / 4] = (tmp & ml) | (((tmp & mr) << 1) & mr);
|
|
|
|
|
|
|
|
buf0[0] = t[0];
|
|
|
|
buf0[1] = t[1];
|
|
|
|
buf0[2] = t[2];
|
|
|
|
buf0[3] = t[3];
|
|
|
|
buf1[0] = t[4];
|
|
|
|
buf1[1] = t[5];
|
|
|
|
buf1[2] = t[6];
|
|
|
|
buf1[3] = t[7];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_chr_shiftr (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2016-01-14 19:54:41 +00:00
|
|
|
const u32 mr = 0xffu << ((p0 & 3) * 8);
|
2015-12-04 14:47:52 +00:00
|
|
|
const u32 ml = ~mr;
|
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 t[8];
|
|
|
|
|
|
|
|
t[0] = buf0[0];
|
|
|
|
t[1] = buf0[1];
|
|
|
|
t[2] = buf0[2];
|
|
|
|
t[3] = buf0[3];
|
|
|
|
t[4] = buf1[0];
|
|
|
|
t[5] = buf1[1];
|
|
|
|
t[6] = buf1[2];
|
|
|
|
t[7] = buf1[3];
|
|
|
|
|
|
|
|
const u32 tmp = t[p0 / 4];
|
|
|
|
|
|
|
|
t[p0 / 4] = (tmp & ml) | (((tmp & mr) >> 1) & mr);
|
|
|
|
|
|
|
|
buf0[0] = t[0];
|
|
|
|
buf0[1] = t[1];
|
|
|
|
buf0[2] = t[2];
|
|
|
|
buf0[3] = t[3];
|
|
|
|
buf1[0] = t[4];
|
|
|
|
buf1[1] = t[5];
|
|
|
|
buf1[2] = t[6];
|
|
|
|
buf1[3] = t[7];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_chr_incr (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2016-01-14 19:54:41 +00:00
|
|
|
const u32 mr = 0xffu << ((p0 & 3) * 8);
|
2015-12-04 14:47:52 +00:00
|
|
|
const u32 ml = ~mr;
|
|
|
|
|
|
|
|
const u32 n = 0x01010101 & mr;
|
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 t[8];
|
|
|
|
|
|
|
|
t[0] = buf0[0];
|
|
|
|
t[1] = buf0[1];
|
|
|
|
t[2] = buf0[2];
|
|
|
|
t[3] = buf0[3];
|
|
|
|
t[4] = buf1[0];
|
|
|
|
t[5] = buf1[1];
|
|
|
|
t[6] = buf1[2];
|
|
|
|
t[7] = buf1[3];
|
|
|
|
|
|
|
|
const u32 tmp = t[p0 / 4];
|
|
|
|
|
|
|
|
t[p0 / 4] = (tmp & ml) | (((tmp & mr) + n) & mr);
|
|
|
|
|
|
|
|
buf0[0] = t[0];
|
|
|
|
buf0[1] = t[1];
|
|
|
|
buf0[2] = t[2];
|
|
|
|
buf0[3] = t[3];
|
|
|
|
buf1[0] = t[4];
|
|
|
|
buf1[1] = t[5];
|
|
|
|
buf1[2] = t[6];
|
|
|
|
buf1[3] = t[7];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_chr_decr (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2016-01-14 19:54:41 +00:00
|
|
|
const u32 mr = 0xffu << ((p0 & 3) * 8);
|
2015-12-04 14:47:52 +00:00
|
|
|
const u32 ml = ~mr;
|
|
|
|
|
|
|
|
const u32 n = 0x01010101 & mr;
|
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 t[8];
|
|
|
|
|
|
|
|
t[0] = buf0[0];
|
|
|
|
t[1] = buf0[1];
|
|
|
|
t[2] = buf0[2];
|
|
|
|
t[3] = buf0[3];
|
|
|
|
t[4] = buf1[0];
|
|
|
|
t[5] = buf1[1];
|
|
|
|
t[6] = buf1[2];
|
|
|
|
t[7] = buf1[3];
|
|
|
|
|
|
|
|
const u32 tmp = t[p0 / 4];
|
|
|
|
|
|
|
|
t[p0 / 4] = (tmp & ml) | (((tmp & mr) - n) & mr);
|
|
|
|
|
|
|
|
buf0[0] = t[0];
|
|
|
|
buf0[1] = t[1];
|
|
|
|
buf0[2] = t[2];
|
|
|
|
buf0[3] = t[3];
|
|
|
|
buf1[0] = t[4];
|
|
|
|
buf1[1] = t[5];
|
|
|
|
buf1[2] = t[6];
|
|
|
|
buf1[3] = t[7];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_replace_np1 (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if ((p0 + 1) >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 tib4x[8];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
lshift_block (buf0, buf1, tib4x + 0, tib4x + 4);
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2016-01-14 19:54:41 +00:00
|
|
|
const u32 mr = 0xffu << ((p0 & 3) * 8);
|
2015-12-04 14:47:52 +00:00
|
|
|
const u32 ml = ~mr;
|
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 t[8];
|
|
|
|
|
|
|
|
t[0] = buf0[0];
|
|
|
|
t[1] = buf0[1];
|
|
|
|
t[2] = buf0[2];
|
|
|
|
t[3] = buf0[3];
|
|
|
|
t[4] = buf1[0];
|
|
|
|
t[5] = buf1[1];
|
|
|
|
t[6] = buf1[2];
|
|
|
|
t[7] = buf1[3];
|
|
|
|
|
|
|
|
const u32 tmp = t[p0 / 4];
|
|
|
|
|
|
|
|
const u32 tmp2 = tib4x[p0 / 4];
|
|
|
|
|
|
|
|
t[p0 / 4] = (tmp & ml) | (tmp2 & mr);
|
|
|
|
|
|
|
|
buf0[0] = t[0];
|
|
|
|
buf0[1] = t[1];
|
|
|
|
buf0[2] = t[2];
|
|
|
|
buf0[3] = t[3];
|
|
|
|
buf1[0] = t[4];
|
|
|
|
buf1[1] = t[5];
|
|
|
|
buf1[2] = t[6];
|
|
|
|
buf1[3] = t[7];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_replace_nm1 (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 == 0) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 >= in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 tib4x[8];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
rshift_block (buf0, buf1, tib4x + 0, tib4x + 4);
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2016-01-14 19:54:41 +00:00
|
|
|
const u32 mr = 0xffu << ((p0 & 3) * 8);
|
2015-12-04 14:47:52 +00:00
|
|
|
const u32 ml = ~mr;
|
|
|
|
|
2017-08-23 22:49:46 +00:00
|
|
|
u32 t[8];
|
|
|
|
|
|
|
|
t[0] = buf0[0];
|
|
|
|
t[1] = buf0[1];
|
|
|
|
t[2] = buf0[2];
|
|
|
|
t[3] = buf0[3];
|
|
|
|
t[4] = buf1[0];
|
|
|
|
t[5] = buf1[1];
|
|
|
|
t[6] = buf1[2];
|
|
|
|
t[7] = buf1[3];
|
|
|
|
|
|
|
|
const u32 tmp = t[p0 / 4];
|
|
|
|
|
|
|
|
const u32 tmp2 = tib4x[p0 / 4];
|
|
|
|
|
|
|
|
t[p0 / 4] = (tmp & ml) | (tmp2 & mr);
|
|
|
|
|
|
|
|
buf0[0] = t[0];
|
|
|
|
buf0[1] = t[1];
|
|
|
|
buf0[2] = t[2];
|
|
|
|
buf0[3] = t[3];
|
|
|
|
buf1[0] = t[4];
|
|
|
|
buf1[1] = t[5];
|
|
|
|
buf1[2] = t[6];
|
|
|
|
buf1[3] = t[7];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_dupeblock_first (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 > in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
if ((in_len + p0) >= 32) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
2015-12-15 11:04:22 +00:00
|
|
|
u32 tib40[4];
|
|
|
|
u32 tib41[4];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
tib40[0] = buf0[0];
|
|
|
|
tib40[1] = buf0[1];
|
|
|
|
tib40[2] = buf0[2];
|
|
|
|
tib40[3] = buf0[3];
|
|
|
|
tib41[0] = buf1[0];
|
|
|
|
tib41[1] = buf1[1];
|
|
|
|
tib41[2] = buf1[2];
|
|
|
|
tib41[3] = buf1[3];
|
|
|
|
|
|
|
|
truncate_right (tib40, tib41, p0);
|
|
|
|
|
|
|
|
rshift_block_N (buf0, buf1, buf0, buf1, p0);
|
|
|
|
|
|
|
|
buf0[0] |= tib40[0];
|
|
|
|
buf0[1] |= tib40[1];
|
|
|
|
buf0[2] |= tib40[2];
|
|
|
|
buf0[3] |= tib40[3];
|
|
|
|
buf1[0] |= tib41[0];
|
|
|
|
buf1[1] |= tib41[1];
|
|
|
|
buf1[2] |= tib41[2];
|
|
|
|
buf1[3] |= tib41[3];
|
|
|
|
|
|
|
|
out_len += p0;
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-20 10:50:24 +00:00
|
|
|
static u32 rule_op_mangle_dupeblock_last (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
if (p0 > in_len) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
if ((in_len + p0) >= 32) return in_len;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
u32 tib40[4];
|
|
|
|
u32 tib41[4];
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
rshift_block_N (buf0, buf1, tib40, tib41, p0);
|
|
|
|
|
|
|
|
truncate_left (tib40, tib41, out_len);
|
|
|
|
|
|
|
|
buf0[0] |= tib40[0];
|
|
|
|
buf0[1] |= tib40[1];
|
|
|
|
buf0[2] |= tib40[2];
|
|
|
|
buf0[3] |= tib40[3];
|
|
|
|
buf1[0] |= tib41[0];
|
|
|
|
buf1[1] |= tib41[1];
|
|
|
|
buf1[2] |= tib41[2];
|
|
|
|
buf1[3] |= tib41[3];
|
|
|
|
|
|
|
|
out_len += p0;
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
static u32 toggle_on_register (const u32 in, const u32 r)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
2017-08-24 15:14:33 +00:00
|
|
|
u32 out = in;
|
2015-12-04 14:47:52 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
const u32 cmask = generate_cmask (out);
|
2017-08-23 22:49:46 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
if (r & 1) out = out ^ (0x00000020 & cmask);
|
|
|
|
if (r & 2) out = out ^ (0x00002000 & cmask);
|
|
|
|
if (r & 4) out = out ^ (0x00200000 & cmask);
|
|
|
|
if (r & 8) out = out ^ (0x20000000 & cmask);
|
2017-08-23 22:49:46 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
return out;
|
|
|
|
}
|
2017-08-23 22:49:46 +00:00
|
|
|
|
2017-08-24 15:14:33 +00:00
|
|
|
static u32 rule_op_mangle_title_sep (MAYBE_UNUSED const u32 p0, MAYBE_UNUSED const u32 p1, MAYBE_UNUSED u32 buf0[4], MAYBE_UNUSED u32 buf1[4], const u32 in_len)
|
|
|
|
{
|
|
|
|
if (in_len == 0) return in_len;
|
|
|
|
|
|
|
|
u32 r0 = search_on_register (buf0[0], p0);
|
|
|
|
u32 r1 = search_on_register (buf0[1], p0);
|
|
|
|
u32 r2 = search_on_register (buf0[2], p0);
|
|
|
|
u32 r3 = search_on_register (buf0[3], p0);
|
|
|
|
u32 r4 = search_on_register (buf1[0], p0);
|
|
|
|
u32 r5 = search_on_register (buf1[1], p0);
|
|
|
|
u32 r6 = search_on_register (buf1[2], p0);
|
|
|
|
u32 r7 = search_on_register (buf1[3], p0);
|
|
|
|
|
|
|
|
rule_op_mangle_lrest_ufirst (p0, p1, buf0, buf1, in_len);
|
|
|
|
|
|
|
|
const u32 rn = r0 + r1 + r2 + r3 + r4 + r5 + r6 + r7;
|
|
|
|
|
|
|
|
if (rn == 0) return in_len;
|
|
|
|
|
|
|
|
r0 <<= 1;
|
|
|
|
r1 <<= 1; r1 |= r0 >> 4;
|
|
|
|
r2 <<= 1; r2 |= r1 >> 4;
|
|
|
|
r3 <<= 1; r3 |= r2 >> 4;
|
|
|
|
r4 <<= 1; r4 |= r3 >> 4;
|
|
|
|
r5 <<= 1; r5 |= r4 >> 4;
|
|
|
|
r6 <<= 1; r6 |= r5 >> 4;
|
|
|
|
r7 <<= 1; r7 |= r6 >> 4;
|
|
|
|
|
|
|
|
buf0[0] = toggle_on_register (buf0[0], r0);
|
|
|
|
buf0[1] = toggle_on_register (buf0[1], r1);
|
|
|
|
buf0[2] = toggle_on_register (buf0[2], r2);
|
|
|
|
buf0[3] = toggle_on_register (buf0[3], r3);
|
|
|
|
buf1[0] = toggle_on_register (buf1[0], r0);
|
|
|
|
buf1[1] = toggle_on_register (buf1[1], r1);
|
|
|
|
buf1[2] = toggle_on_register (buf1[2], r2);
|
|
|
|
buf1[3] = toggle_on_register (buf1[3], r3);
|
2015-12-04 14:47:52 +00:00
|
|
|
|
|
|
|
return in_len;
|
|
|
|
}
|
|
|
|
|
2017-08-16 18:27:17 +00:00
|
|
|
static u32 apply_rule (const u32 name, const u32 p0, const u32 p1, u32 buf0[4], u32 buf1[4], const u32 in_len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
|
|
|
u32 out_len = in_len;
|
|
|
|
|
|
|
|
switch (name)
|
|
|
|
{
|
|
|
|
case RULE_OP_MANGLE_LREST: out_len = rule_op_mangle_lrest (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_UREST: out_len = rule_op_mangle_urest (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_LREST_UFIRST: out_len = rule_op_mangle_lrest_ufirst (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_UREST_LFIRST: out_len = rule_op_mangle_urest_lfirst (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_TREST: out_len = rule_op_mangle_trest (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_TOGGLE_AT: out_len = rule_op_mangle_toggle_at (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_REVERSE: out_len = rule_op_mangle_reverse (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_DUPEWORD: out_len = rule_op_mangle_dupeword (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_DUPEWORD_TIMES: out_len = rule_op_mangle_dupeword_times (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_REFLECT: out_len = rule_op_mangle_reflect (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_APPEND: out_len = rule_op_mangle_append (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_PREPEND: out_len = rule_op_mangle_prepend (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_ROTATE_LEFT: out_len = rule_op_mangle_rotate_left (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_ROTATE_RIGHT: out_len = rule_op_mangle_rotate_right (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_DELETE_FIRST: out_len = rule_op_mangle_delete_first (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_DELETE_LAST: out_len = rule_op_mangle_delete_last (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_DELETE_AT: out_len = rule_op_mangle_delete_at (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_EXTRACT: out_len = rule_op_mangle_extract (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_OMIT: out_len = rule_op_mangle_omit (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_INSERT: out_len = rule_op_mangle_insert (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_OVERSTRIKE: out_len = rule_op_mangle_overstrike (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_TRUNCATE_AT: out_len = rule_op_mangle_truncate_at (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_REPLACE: out_len = rule_op_mangle_replace (p0, p1, buf0, buf1, out_len); break;
|
2016-07-25 20:54:07 +00:00
|
|
|
case RULE_OP_MANGLE_PURGECHAR: out_len = rule_op_mangle_purgechar (p0, p1, buf0, buf1, out_len); break;
|
2015-12-04 14:47:52 +00:00
|
|
|
//case RULE_OP_MANGLE_TOGGLECASE_REC: out_len = rule_op_mangle_togglecase_rec (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_DUPECHAR_FIRST: out_len = rule_op_mangle_dupechar_first (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_DUPECHAR_LAST: out_len = rule_op_mangle_dupechar_last (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_DUPECHAR_ALL: out_len = rule_op_mangle_dupechar_all (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_SWITCH_FIRST: out_len = rule_op_mangle_switch_first (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_SWITCH_LAST: out_len = rule_op_mangle_switch_last (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_SWITCH_AT: out_len = rule_op_mangle_switch_at (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_CHR_SHIFTL: out_len = rule_op_mangle_chr_shiftl (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_CHR_SHIFTR: out_len = rule_op_mangle_chr_shiftr (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_CHR_INCR: out_len = rule_op_mangle_chr_incr (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_CHR_DECR: out_len = rule_op_mangle_chr_decr (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_REPLACE_NP1: out_len = rule_op_mangle_replace_np1 (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_REPLACE_NM1: out_len = rule_op_mangle_replace_nm1 (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_DUPEBLOCK_FIRST: out_len = rule_op_mangle_dupeblock_first (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_DUPEBLOCK_LAST: out_len = rule_op_mangle_dupeblock_last (p0, p1, buf0, buf1, out_len); break;
|
2017-04-30 13:23:39 +00:00
|
|
|
case RULE_OP_MANGLE_TITLE_SEP: out_len = rule_op_mangle_title_sep (p0, p1, buf0, buf1, out_len); break;
|
|
|
|
case RULE_OP_MANGLE_TITLE: out_len = rule_op_mangle_title_sep (' ', p1, buf0, buf1, out_len); break;
|
2015-12-04 14:47:52 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
|
|
|
|
2017-08-23 10:43:59 +00:00
|
|
|
static u32 apply_rules (__constant const u32 *cmds, u32 buf0[4], u32 buf1[4], const u32 len)
|
2015-12-04 14:47:52 +00:00
|
|
|
{
|
|
|
|
u32 out_len = len;
|
|
|
|
|
|
|
|
for (u32 i = 0; cmds[i] != 0; i++)
|
|
|
|
{
|
|
|
|
const u32 cmd = cmds[i];
|
|
|
|
|
|
|
|
const u32 name = (cmd >> 0) & 0xff;
|
|
|
|
const u32 p0 = (cmd >> 8) & 0xff;
|
|
|
|
const u32 p1 = (cmd >> 16) & 0xff;
|
|
|
|
|
|
|
|
out_len = apply_rule (name, p0, p1, buf0, buf1, out_len);
|
|
|
|
}
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
}
|
2016-01-21 15:47:38 +00:00
|
|
|
|
2017-08-23 10:46:14 +00:00
|
|
|
static u32x apply_rules_vect (const u32 pw_buf0[4], const u32 pw_buf1[4], const u32 pw_len, __constant const kernel_rule_t *rules_buf, const u32 il_pos, u32x buf0[4], u32x buf1[4])
|
2016-01-21 15:47:38 +00:00
|
|
|
{
|
|
|
|
#if VECT_SIZE == 1
|
|
|
|
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0] = pw_buf0[0];
|
|
|
|
buf0[1] = pw_buf0[1];
|
|
|
|
buf0[2] = pw_buf0[2];
|
|
|
|
buf0[3] = pw_buf0[3];
|
|
|
|
buf1[0] = pw_buf1[0];
|
|
|
|
buf1[1] = pw_buf1[1];
|
|
|
|
buf1[2] = pw_buf1[2];
|
|
|
|
buf1[3] = pw_buf1[3];
|
2016-01-21 15:47:38 +00:00
|
|
|
|
2016-11-01 12:01:15 +00:00
|
|
|
return apply_rules (rules_buf[il_pos].cmds, buf0, buf1, pw_len);
|
2016-01-21 15:47:38 +00:00
|
|
|
|
|
|
|
#else
|
|
|
|
|
2016-02-27 16:18:54 +00:00
|
|
|
u32x out_len = 0;
|
2016-01-21 15:47:38 +00:00
|
|
|
|
2016-05-09 19:32:12 +00:00
|
|
|
#ifdef _unroll
|
2016-01-21 15:47:38 +00:00
|
|
|
#pragma unroll
|
2016-05-09 19:32:12 +00:00
|
|
|
#endif
|
2016-01-21 15:47:38 +00:00
|
|
|
for (int i = 0; i < VECT_SIZE; i++)
|
|
|
|
{
|
|
|
|
u32 tmp0[4];
|
|
|
|
u32 tmp1[4];
|
|
|
|
|
|
|
|
tmp0[0] = pw_buf0[0];
|
|
|
|
tmp0[1] = pw_buf0[1];
|
|
|
|
tmp0[2] = pw_buf0[2];
|
|
|
|
tmp0[3] = pw_buf0[3];
|
|
|
|
tmp1[0] = pw_buf1[0];
|
|
|
|
tmp1[1] = pw_buf1[1];
|
|
|
|
tmp1[2] = pw_buf1[2];
|
|
|
|
tmp1[3] = pw_buf1[3];
|
|
|
|
|
2016-02-27 16:18:54 +00:00
|
|
|
const u32 tmp_len = apply_rules (rules_buf[il_pos + i].cmds, tmp0, tmp1, pw_len);
|
2016-01-21 15:47:38 +00:00
|
|
|
|
|
|
|
switch (i)
|
|
|
|
{
|
|
|
|
#if VECT_SIZE >= 2
|
|
|
|
case 0:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].s0 = tmp0[0];
|
|
|
|
buf0[1].s0 = tmp0[1];
|
|
|
|
buf0[2].s0 = tmp0[2];
|
|
|
|
buf0[3].s0 = tmp0[3];
|
|
|
|
buf1[0].s0 = tmp1[0];
|
|
|
|
buf1[1].s0 = tmp1[1];
|
|
|
|
buf1[2].s0 = tmp1[2];
|
|
|
|
buf1[3].s0 = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.s0 = tmp_len;
|
2016-01-21 15:47:38 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 1:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].s1 = tmp0[0];
|
|
|
|
buf0[1].s1 = tmp0[1];
|
|
|
|
buf0[2].s1 = tmp0[2];
|
|
|
|
buf0[3].s1 = tmp0[3];
|
|
|
|
buf1[0].s1 = tmp1[0];
|
|
|
|
buf1[1].s1 = tmp1[1];
|
|
|
|
buf1[2].s1 = tmp1[2];
|
|
|
|
buf1[3].s1 = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.s1 = tmp_len;
|
2016-01-21 15:47:38 +00:00
|
|
|
break;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if VECT_SIZE >= 4
|
|
|
|
case 2:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].s2 = tmp0[0];
|
|
|
|
buf0[1].s2 = tmp0[1];
|
|
|
|
buf0[2].s2 = tmp0[2];
|
|
|
|
buf0[3].s2 = tmp0[3];
|
|
|
|
buf1[0].s2 = tmp1[0];
|
|
|
|
buf1[1].s2 = tmp1[1];
|
|
|
|
buf1[2].s2 = tmp1[2];
|
|
|
|
buf1[3].s2 = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.s2 = tmp_len;
|
2016-01-21 15:47:38 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 3:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].s3 = tmp0[0];
|
|
|
|
buf0[1].s3 = tmp0[1];
|
|
|
|
buf0[2].s3 = tmp0[2];
|
|
|
|
buf0[3].s3 = tmp0[3];
|
|
|
|
buf1[0].s3 = tmp1[0];
|
|
|
|
buf1[1].s3 = tmp1[1];
|
|
|
|
buf1[2].s3 = tmp1[2];
|
|
|
|
buf1[3].s3 = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.s3 = tmp_len;
|
2016-01-21 15:47:38 +00:00
|
|
|
break;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if VECT_SIZE >= 8
|
|
|
|
case 4:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].s4 = tmp0[0];
|
|
|
|
buf0[1].s4 = tmp0[1];
|
|
|
|
buf0[2].s4 = tmp0[2];
|
|
|
|
buf0[3].s4 = tmp0[3];
|
|
|
|
buf1[0].s4 = tmp1[0];
|
|
|
|
buf1[1].s4 = tmp1[1];
|
|
|
|
buf1[2].s4 = tmp1[2];
|
|
|
|
buf1[3].s4 = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.s4 = tmp_len;
|
2016-01-21 15:47:38 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 5:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].s5 = tmp0[0];
|
|
|
|
buf0[1].s5 = tmp0[1];
|
|
|
|
buf0[2].s5 = tmp0[2];
|
|
|
|
buf0[3].s5 = tmp0[3];
|
|
|
|
buf1[0].s5 = tmp1[0];
|
|
|
|
buf1[1].s5 = tmp1[1];
|
|
|
|
buf1[2].s5 = tmp1[2];
|
|
|
|
buf1[3].s5 = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.s5 = tmp_len;
|
2016-01-21 15:47:38 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 6:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].s6 = tmp0[0];
|
|
|
|
buf0[1].s6 = tmp0[1];
|
|
|
|
buf0[2].s6 = tmp0[2];
|
|
|
|
buf0[3].s6 = tmp0[3];
|
|
|
|
buf1[0].s6 = tmp1[0];
|
|
|
|
buf1[1].s6 = tmp1[1];
|
|
|
|
buf1[2].s6 = tmp1[2];
|
|
|
|
buf1[3].s6 = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.s6 = tmp_len;
|
2016-01-21 15:47:38 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 7:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].s7 = tmp0[0];
|
|
|
|
buf0[1].s7 = tmp0[1];
|
|
|
|
buf0[2].s7 = tmp0[2];
|
|
|
|
buf0[3].s7 = tmp0[3];
|
|
|
|
buf1[0].s7 = tmp1[0];
|
|
|
|
buf1[1].s7 = tmp1[1];
|
|
|
|
buf1[2].s7 = tmp1[2];
|
|
|
|
buf1[3].s7 = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.s7 = tmp_len;
|
2016-01-21 15:47:38 +00:00
|
|
|
break;
|
|
|
|
#endif
|
2016-02-16 15:42:08 +00:00
|
|
|
|
|
|
|
#if VECT_SIZE >= 16
|
|
|
|
case 8:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].s8 = tmp0[0];
|
|
|
|
buf0[1].s8 = tmp0[1];
|
|
|
|
buf0[2].s8 = tmp0[2];
|
|
|
|
buf0[3].s8 = tmp0[3];
|
|
|
|
buf1[0].s8 = tmp1[0];
|
|
|
|
buf1[1].s8 = tmp1[1];
|
|
|
|
buf1[2].s8 = tmp1[2];
|
|
|
|
buf1[3].s8 = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.s8 = tmp_len;
|
2016-02-16 15:42:08 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 9:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].s9 = tmp0[0];
|
|
|
|
buf0[1].s9 = tmp0[1];
|
|
|
|
buf0[2].s9 = tmp0[2];
|
|
|
|
buf0[3].s9 = tmp0[3];
|
|
|
|
buf1[0].s9 = tmp1[0];
|
|
|
|
buf1[1].s9 = tmp1[1];
|
|
|
|
buf1[2].s9 = tmp1[2];
|
|
|
|
buf1[3].s9 = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.s9 = tmp_len;
|
2016-02-16 15:42:08 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 10:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].sa = tmp0[0];
|
|
|
|
buf0[1].sa = tmp0[1];
|
|
|
|
buf0[2].sa = tmp0[2];
|
|
|
|
buf0[3].sa = tmp0[3];
|
|
|
|
buf1[0].sa = tmp1[0];
|
|
|
|
buf1[1].sa = tmp1[1];
|
|
|
|
buf1[2].sa = tmp1[2];
|
|
|
|
buf1[3].sa = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.sa = tmp_len;
|
2016-02-16 15:42:08 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 11:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].sb = tmp0[0];
|
|
|
|
buf0[1].sb = tmp0[1];
|
|
|
|
buf0[2].sb = tmp0[2];
|
|
|
|
buf0[3].sb = tmp0[3];
|
|
|
|
buf1[0].sb = tmp1[0];
|
|
|
|
buf1[1].sb = tmp1[1];
|
|
|
|
buf1[2].sb = tmp1[2];
|
|
|
|
buf1[3].sb = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.sb = tmp_len;
|
2016-02-16 15:42:08 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 12:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].sc = tmp0[0];
|
|
|
|
buf0[1].sc = tmp0[1];
|
|
|
|
buf0[2].sc = tmp0[2];
|
|
|
|
buf0[3].sc = tmp0[3];
|
|
|
|
buf1[0].sc = tmp1[0];
|
|
|
|
buf1[1].sc = tmp1[1];
|
|
|
|
buf1[2].sc = tmp1[2];
|
|
|
|
buf1[3].sc = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.sc = tmp_len;
|
2016-02-16 15:42:08 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 13:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].sd = tmp0[0];
|
|
|
|
buf0[1].sd = tmp0[1];
|
|
|
|
buf0[2].sd = tmp0[2];
|
|
|
|
buf0[3].sd = tmp0[3];
|
|
|
|
buf1[0].sd = tmp1[0];
|
|
|
|
buf1[1].sd = tmp1[1];
|
|
|
|
buf1[2].sd = tmp1[2];
|
|
|
|
buf1[3].sd = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.sd = tmp_len;
|
2016-02-16 15:42:08 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 14:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].se = tmp0[0];
|
|
|
|
buf0[1].se = tmp0[1];
|
|
|
|
buf0[2].se = tmp0[2];
|
|
|
|
buf0[3].se = tmp0[3];
|
|
|
|
buf1[0].se = tmp1[0];
|
|
|
|
buf1[1].se = tmp1[1];
|
|
|
|
buf1[2].se = tmp1[2];
|
|
|
|
buf1[3].se = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.se = tmp_len;
|
2016-02-16 15:42:08 +00:00
|
|
|
break;
|
|
|
|
|
|
|
|
case 15:
|
2016-11-01 12:01:15 +00:00
|
|
|
buf0[0].sf = tmp0[0];
|
|
|
|
buf0[1].sf = tmp0[1];
|
|
|
|
buf0[2].sf = tmp0[2];
|
|
|
|
buf0[3].sf = tmp0[3];
|
|
|
|
buf1[0].sf = tmp1[0];
|
|
|
|
buf1[1].sf = tmp1[1];
|
|
|
|
buf1[2].sf = tmp1[2];
|
|
|
|
buf1[3].sf = tmp1[3];
|
2016-02-27 16:18:54 +00:00
|
|
|
out_len.sf = tmp_len;
|
2016-02-16 15:42:08 +00:00
|
|
|
break;
|
|
|
|
#endif
|
2016-01-21 15:47:38 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return out_len;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
}
|