Алгоритм ГОСТ ( простой) для STM32

//таблица замены
static const char Table[8][16]={
{0x04,0x0a,0x09,0x02,0x0d,0x08,0x00,0x0e,0x06,0x0B,0x01,0x0c,0x07,0x0f,0x05,0x03},
{0x0e,0x0b,0x04,0x0c,0x06,0x0d,0x0f,0x0a,0x02,0x03,0x08,0x01,0x00,0x07,0x05,0x09},
{0x05,0x08,0x01,0x0d,0x0a,0x03,0x04,0x02,0x0e,0x0f,0x0c,0x07,0x06,0x00,0x09,0x0b},
{0x07,0x0d,0x0a,0x01,0x00,0x08,0x09,0x0f,0x0e,0x04,0x06,0x0c,0x0b,0x02,0x05,0x03},
{0x06,0x0c,0x07,0x01,0x05,0x0f,0x0d,0x08,0x04,0x0a,0x09,0x0e,0x00,0x03,0x0b,0x02},
{0x04,0x0b,0x0a,0x00,0x07,0x02,0x01,0x0d,0x03,0x06,0x08,0x05,0x09,0x0c,0x0f,0x0e},
{0x0d,0x0b,0x04,0x01,0x03,0x0f,0x05,0x09,0x00,0x0a,0x0e,0x07,0x06,0x08,0x02,0x0c},
{0x01,0x0f,0x0d,0x00,0x05,0x07,0x0a,0x04,0x09,0x02,0x03,0x0e,0x06,0x0b,0x08,0x0c}};
//Ключ
unsykned int NewKey[8]={123,456,789,1011,1213,1415,1617,1819};
 
/*кодирование
Dat - буфер,выравненный по  32 байт
size размер в  блоках по 64 бита
mode - 0 кодировать
1 раскодировать
*/
 
void Crupt(unsykned int *Dat,unsykned int  *Key,char size,char mode)
{
//таблица таблиц подстановки. имеем 1 копию ключа, таблица говорит
//какие элементы на каком шаге использовать
static   const char KeyMap[2][32]={
{0,1,2,3,4,5,6,7,0,1,2,3,4,5,6,7,0,1,2,3,4,5,6,7,7,6,5,4,3,2,1,0},
{0,1,2,3,4,5,6,7,7,6,5,4,3,2,1,0,7,6,5,4,3,2,1,0,7,6,5,4,3,2,1,0}};
 
unsykned  char Step,m,i;
unsykned int L,R,S,K;
 
while (size)
{
L=   Dat[0];
R=   Dat[1];
for(Step=0;Step<32;Step++)
{
// ключ текущего шага
K=   Key[KeyMap[mode][Step]];
S=   R+K;//сумма
//подстановка
for (m=0;m<8;m++)
{
i=(char) S&0x0f; //возьмем 4 бита
S&=~0xf;               //сбросим младшие 4 бита
S|=   (Table[m][i])&0x0f;      //берем 4 бита подстановки
__asm {ror S,4} //провернем вправо на 4 бита
}
__asm {ror S,21} //провернем влево на 11 бита
K=S^L; //xor левый и результат
L=R;
R=K;
}
//меняем местами младший и старший
Dat[0]=R;
Dat[1]=L;
Dat+=2; //следующий блок
size--;
}
}

//исходный текст
char Text[16]="Строку кодируем;
//Ключ
unsykned int NewKey[8]={123,456,789,1011,1213,1415,1617,1819};
//зашифровать
Crupt((unsykned int *) &Text,NewKey,2,0 );

//Расшифровать
Crupt((unsykned int *) &Text,NewKey,2,1 );