Дешифровка в алгоритме RC5-16/4/4

#include "stdafx.h"
#include <stdio.h>
#include <conio.h>
#include <iostream>
#include <stdlib.h>
using namespace std;
typedef unsigned short WORD; /* тип для открытого/шифрованного текста */
#define w 16 /* размер слова в битах */
#define r 4 /* число раундов */
#define b 4 /* число байтов в ключе */
#define c 2 /* число слов в ключе, вычисляется по формуле ниже */
                                /* c = max(1,ceil(8*b/w)) */
#define t 10 /* размер таблицы для развернутого ключа S = 2*(r+1) */
WORD S[t]; /* таблица для развернутого ключа */
WORD P = 0xb7e1, Q = 0x9e37; /* константы Фи и Пи для нашего случая (w=16) */
#define ROTL(x,y) ( (x<<y) | (x>>(sizeof(WORD)*8-y)) )
#define ROTR(x,y) ( (x>>y) | (x<<(sizeof(WORD)*8-y)) )
 
/* зашифрование, на вход подается открытый текст
                            на выход - шифрованный*/
void RC5_ENCRYPT(WORD *pt, WORD *ct) 
{ 
    WORD i, A=pt[0]+S[0], B=pt[1]+S[1];
    for (i=1; i<=r; i++)
    {   
        A=ROTL(A^B,B)+S[2*i];
        B=ROTL(B^A,A)+S[2*i+1];
    }
    ct[0] = A; ct[1] = B;
}
/* дешифрование, на вход подается шифрованный текст
                            на выход - открытый*/
void RC5_DECRYPT(WORD *ct, WORD *pt)
{ 
    WORD i, B=ct[1], A=ct[0];
    for (i=r; i>0; i--)
    {
        B=ROTR(B-S[2*i+1],A)^A;
        A=ROTR(A-S[2*i],B)^B;
    }
    pt[1] = B-S[1]; pt[0] = A-S[0];
}
/* Развертывание ключа */
/* Инициализируем массивы L, S, затем смешиваем */
void RC5_SETUP(WORD *K)
{ 
    WORD j,i, k, u=w/8, A, B, L[c]; 
    for (i=b-1, L[c-1]=0; i!=-1; i--) 
        {
            L[i/u] = (L[i/u]<<8)+K[i];
            if(i==0) break;
        }
    for (S[0]=P,i=1; i<t; i++) S[i] = S[i-1]+Q;
    for (A=B=i=j=k=0; k<3*t; k++,i=(i+1)%t,j=(j+1)%c)
    { 
        A=S[i]=ROTL(S[i]+(A+B),3);
        B=L[j]=ROTL(L[j]+(A+B),(A+B));
    }
}
int _tmain(int argc, _TCHAR* argv[])
{
    WORD j, open_text_1[2], open_text_2[2], cipher_text[2] = {0,0},key[b];
    open_text_1[0]=2423; open_text_1[1]=36034;
    key[0]=1;key[1]=477;key[2]=956;key[3]=85;
    /* Развертывание ключа, шифрование и дешифрование */
    RC5_SETUP(key);
    RC5_ENCRYPT(open_text_1,cipher_text);
    RC5_DECRYPT(cipher_text,open_text_2);
    /* Выводим результат, сравниваем открытые тексты из процедур дешифрования и шифрования */
    cout<<"Key: ";
    for (j=0; j<b; j++) printf("%02.2X ",key[j]);
    cout<<endl;
    cout<<endl<<"Encryption:"<<endl;
    printf("Opentext   "); 
        printf("%.8lX",open_text_1[0]);
        printf(" %.8lX",open_text_1[1]);
    printf(" ---> Ciphertext "); 
        printf("%.8lX",cipher_text[0]);
        printf(" %.8lX",cipher_text[1]);
    cout<<endl<<endl;
    cout<<"Decryption:"<<endl;
    printf("Ciphertext "); 
        printf("%.8lX",cipher_text[0]);
        printf(" %.8lX",cipher_text[1]);
    printf(" ---> Opentext   "); 
        printf("%.8lX",open_text_2[0]);
        printf(" %.8lX",open_text_2[1]);
    getch();
    return 0;
}