Annotation of embedaddon/strongswan/src/libstrongswan/plugins/rc2/rc2_crypter.c, revision 1.1
1.1 ! misho 1: /*
! 2: * Copyright (C) 2013 Tobias Brunner
! 3: * HSR Hochschule fuer Technik Rapperswil
! 4: *
! 5: * This program is free software; you can redistribute it and/or modify it
! 6: * under the terms of the GNU General Public License as published by the
! 7: * Free Software Foundation; either version 2 of the License, or (at your
! 8: * option) any later version. See <http://www.fsf.org/copyleft/gpl.txt>.
! 9: *
! 10: * This program is distributed in the hope that it will be useful, but
! 11: * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
! 12: * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
! 13: * for more details.
! 14: */
! 15:
! 16: #include "rc2_crypter.h"
! 17:
! 18: typedef struct private_rc2_crypter_t private_rc2_crypter_t;
! 19:
! 20: #define RC2_BLOCK_SIZE 8
! 21:
! 22: #define ROL16(x, k) ({ uint16_t _x = (x); (_x << (k)) | (_x >> (16 - (k))); })
! 23: #define ROR16(x, k) ({ uint16_t _x = (x); (_x >> (k)) | (_x << (16 - (k))); })
! 24:
! 25: #define GET16(x) ({ u_char *_x = (x); (uint16_t)_x[0] | ((uint16_t)_x[1] << 8); })
! 26: #define PUT16(x, v) ({ u_char *_x = (x); uint16_t _v = (v); _x[0] = _v, _x[1] = _v >> 8; })
! 27:
! 28: /**
! 29: * Private data of rc2_crypter_t
! 30: */
! 31: struct private_rc2_crypter_t {
! 32:
! 33: /**
! 34: * Public interface
! 35: */
! 36: rc2_crypter_t public;
! 37:
! 38: /**
! 39: * The expanded key in 16-bit words
! 40: */
! 41: uint16_t K[64];
! 42:
! 43: /**
! 44: * Key size in bytes
! 45: */
! 46: size_t T;
! 47:
! 48: /**
! 49: * Effective key size in bits
! 50: */
! 51: size_t T1;
! 52: };
! 53:
! 54: /**
! 55: * PITABLE
! 56: */
! 57: static const u_char PITABLE[256] =
! 58: {
! 59: 0xd9, 0x78, 0xf9, 0xc4, 0x19, 0xdd, 0xb5, 0xed,
! 60: 0x28, 0xe9, 0xfd, 0x79, 0x4a, 0xa0, 0xd8, 0x9d,
! 61: 0xc6, 0x7e, 0x37, 0x83, 0x2b, 0x76, 0x53, 0x8e,
! 62: 0x62, 0x4c, 0x64, 0x88, 0x44, 0x8b, 0xfb, 0xa2,
! 63: 0x17, 0x9a, 0x59, 0xf5, 0x87, 0xb3, 0x4f, 0x13,
! 64: 0x61, 0x45, 0x6d, 0x8d, 0x09, 0x81, 0x7d, 0x32,
! 65: 0xbd, 0x8f, 0x40, 0xeb, 0x86, 0xb7, 0x7b, 0x0b,
! 66: 0xf0, 0x95, 0x21, 0x22, 0x5c, 0x6b, 0x4e, 0x82,
! 67: 0x54, 0xd6, 0x65, 0x93, 0xce, 0x60, 0xb2, 0x1c,
! 68: 0x73, 0x56, 0xc0, 0x14, 0xa7, 0x8c, 0xf1, 0xdc,
! 69: 0x12, 0x75, 0xca, 0x1f, 0x3b, 0xbe, 0xe4, 0xd1,
! 70: 0x42, 0x3d, 0xd4, 0x30, 0xa3, 0x3c, 0xb6, 0x26,
! 71: 0x6f, 0xbf, 0x0e, 0xda, 0x46, 0x69, 0x07, 0x57,
! 72: 0x27, 0xf2, 0x1d, 0x9b, 0xbc, 0x94, 0x43, 0x03,
! 73: 0xf8, 0x11, 0xc7, 0xf6, 0x90, 0xef, 0x3e, 0xe7,
! 74: 0x06, 0xc3, 0xd5, 0x2f, 0xc8, 0x66, 0x1e, 0xd7,
! 75: 0x08, 0xe8, 0xea, 0xde, 0x80, 0x52, 0xee, 0xf7,
! 76: 0x84, 0xaa, 0x72, 0xac, 0x35, 0x4d, 0x6a, 0x2a,
! 77: 0x96, 0x1a, 0xd2, 0x71, 0x5a, 0x15, 0x49, 0x74,
! 78: 0x4b, 0x9f, 0xd0, 0x5e, 0x04, 0x18, 0xa4, 0xec,
! 79: 0xc2, 0xe0, 0x41, 0x6e, 0x0f, 0x51, 0xcb, 0xcc,
! 80: 0x24, 0x91, 0xaf, 0x50, 0xa1, 0xf4, 0x70, 0x39,
! 81: 0x99, 0x7c, 0x3a, 0x85, 0x23, 0xb8, 0xb4, 0x7a,
! 82: 0xfc, 0x02, 0x36, 0x5b, 0x25, 0x55, 0x97, 0x31,
! 83: 0x2d, 0x5d, 0xfa, 0x98, 0xe3, 0x8a, 0x92, 0xae,
! 84: 0x05, 0xdf, 0x29, 0x10, 0x67, 0x6c, 0xba, 0xc9,
! 85: 0xd3, 0x00, 0xe6, 0xcf, 0xe1, 0x9e, 0xa8, 0x2c,
! 86: 0x63, 0x16, 0x01, 0x3f, 0x58, 0xe2, 0x89, 0xa9,
! 87: 0x0d, 0x38, 0x34, 0x1b, 0xab, 0x33, 0xff, 0xb0,
! 88: 0xbb, 0x48, 0x0c, 0x5f, 0xb9, 0xb1, 0xcd, 0x2e,
! 89: 0xc5, 0xf3, 0xdb, 0x47, 0xe5, 0xa5, 0x9c, 0x77,
! 90: 0x0a, 0xa6, 0x20, 0x68, 0xfe, 0x7f, 0xc1, 0xad,
! 91: };
! 92:
! 93: /**
! 94: * Encrypt a single block of data
! 95: */
! 96: static void encrypt_block(private_rc2_crypter_t *this, u_char R[])
! 97: {
! 98: register uint16_t R0, R1, R2, R3, *Kj;
! 99: int rounds = 3, mix = 5;
! 100:
! 101: R0 = GET16(R);
! 102: R1 = GET16(R + 2);
! 103: R2 = GET16(R + 4);
! 104: R3 = GET16(R + 6);
! 105: Kj = &this->K[0];
! 106:
! 107: /* 5 mix, mash, 6 mix, mash, 5 mix */
! 108: while (TRUE)
! 109: {
! 110: /* mix */
! 111: R0 = ROL16(R0 + *(Kj++) + (R3 & R2) + (~R3 & R1), 1);
! 112: R1 = ROL16(R1 + *(Kj++) + (R0 & R3) + (~R0 & R2), 2);
! 113: R2 = ROL16(R2 + *(Kj++) + (R1 & R0) + (~R1 & R3), 3);
! 114: R3 = ROL16(R3 + *(Kj++) + (R2 & R1) + (~R2 & R0), 5);
! 115:
! 116: if (--mix == 0)
! 117: {
! 118: if (--rounds == 0)
! 119: {
! 120: break;
! 121: }
! 122: mix = (rounds == 2) ? 6 : 5;
! 123: /* mash */
! 124: R0 += this->K[R3 & 63];
! 125: R1 += this->K[R0 & 63];
! 126: R2 += this->K[R1 & 63];
! 127: R3 += this->K[R2 & 63];
! 128: }
! 129: }
! 130:
! 131: PUT16(R, R0);
! 132: PUT16(R + 2, R1);
! 133: PUT16(R + 4, R2);
! 134: PUT16(R + 6, R3);
! 135: }
! 136:
! 137: /**
! 138: * Decrypt a single block of data.
! 139: */
! 140: static void decrypt_block(private_rc2_crypter_t *this, u_char R[])
! 141: {
! 142: register uint16_t R0, R1, R2, R3, *Kj;
! 143: int rounds = 3, mix = 5;
! 144:
! 145: R0 = GET16(R);
! 146: R1 = GET16(R + 2);
! 147: R2 = GET16(R + 4);
! 148: R3 = GET16(R + 6);
! 149: Kj = &this->K[63];
! 150:
! 151: /* 5 r-mix, r-mash, 6 r-mix, r-mash, 5 r-mix */
! 152: while (TRUE)
! 153: {
! 154: /* r-mix */
! 155: R3 = ROR16(R3, 5);
! 156: R3 = R3 - *(Kj--) - (R2 & R1) - (~R2 & R0);
! 157: R2 = ROR16(R2, 3);
! 158: R2 = R2 - *(Kj--) - (R1 & R0) - (~R1 & R3);
! 159: R1 = ROR16(R1, 2);
! 160: R1 = R1 - *(Kj--) - (R0 & R3) - (~R0 & R2);
! 161: R0 = ROR16(R0, 1);
! 162: R0 = R0 - *(Kj--) - (R3 & R2) - (~R3 & R1);
! 163:
! 164: if (--mix == 0)
! 165: {
! 166: if (--rounds == 0)
! 167: {
! 168: break;
! 169: }
! 170: mix = (rounds == 2) ? 6 : 5;
! 171: /* r-mash */
! 172: R3 -= this->K[R2 & 63];
! 173: R2 -= this->K[R1 & 63];
! 174: R1 -= this->K[R0 & 63];
! 175: R0 -= this->K[R3 & 63];
! 176: }
! 177: }
! 178:
! 179: PUT16(R, R0);
! 180: PUT16(R + 2, R1);
! 181: PUT16(R + 4, R2);
! 182: PUT16(R + 6, R3);
! 183: }
! 184:
! 185: METHOD(crypter_t, decrypt, bool,
! 186: private_rc2_crypter_t *this, chunk_t data, chunk_t iv, chunk_t *decrypted)
! 187: {
! 188: uint8_t *in, *out, *prev;
! 189:
! 190: if (data.len % RC2_BLOCK_SIZE || iv.len != RC2_BLOCK_SIZE)
! 191: {
! 192: return FALSE;
! 193: }
! 194:
! 195: in = data.ptr + data.len - RC2_BLOCK_SIZE;
! 196: out = data.ptr;
! 197: if (decrypted)
! 198: {
! 199: *decrypted = chunk_alloc(data.len);
! 200: out = decrypted->ptr;
! 201: }
! 202: out += data.len - RC2_BLOCK_SIZE;
! 203:
! 204: prev = in;
! 205: for (; in >= data.ptr; in -= RC2_BLOCK_SIZE, out -= RC2_BLOCK_SIZE)
! 206: {
! 207: if (decrypted)
! 208: {
! 209: memcpy(out, in, RC2_BLOCK_SIZE);
! 210: }
! 211: decrypt_block(this, out);
! 212: prev -= RC2_BLOCK_SIZE;
! 213: if (prev < data.ptr)
! 214: {
! 215: prev = iv.ptr;
! 216: }
! 217: memxor(out, prev, RC2_BLOCK_SIZE);
! 218: }
! 219: return TRUE;
! 220: }
! 221:
! 222: METHOD(crypter_t, encrypt, bool,
! 223: private_rc2_crypter_t *this, chunk_t data, chunk_t iv, chunk_t *encrypted)
! 224: {
! 225: uint8_t *in, *out, *end, *prev;
! 226:
! 227: if (data.len % RC2_BLOCK_SIZE || iv.len != RC2_BLOCK_SIZE)
! 228: {
! 229: return FALSE;
! 230: }
! 231:
! 232: in = data.ptr;
! 233: end = data.ptr + data.len;
! 234: out = data.ptr;
! 235: if (encrypted)
! 236: {
! 237: *encrypted = chunk_alloc(data.len);
! 238: out = encrypted->ptr;
! 239: }
! 240:
! 241: prev = iv.ptr;
! 242: for (; in < end; in += RC2_BLOCK_SIZE, out += RC2_BLOCK_SIZE)
! 243: {
! 244: if (encrypted)
! 245: {
! 246: memcpy(out, in, RC2_BLOCK_SIZE);
! 247: }
! 248: memxor(out, prev, RC2_BLOCK_SIZE);
! 249: encrypt_block(this, out);
! 250: prev = out;
! 251: }
! 252: return TRUE;
! 253: }
! 254:
! 255: METHOD(crypter_t, get_block_size, size_t,
! 256: private_rc2_crypter_t *this)
! 257: {
! 258: return RC2_BLOCK_SIZE;
! 259: }
! 260:
! 261: METHOD(crypter_t, get_iv_size, size_t,
! 262: private_rc2_crypter_t *this)
! 263: {
! 264: return RC2_BLOCK_SIZE;
! 265: }
! 266:
! 267: METHOD(crypter_t, get_key_size, size_t,
! 268: private_rc2_crypter_t *this)
! 269: {
! 270: return this->T;
! 271: }
! 272:
! 273: METHOD(crypter_t, set_key, bool,
! 274: private_rc2_crypter_t *this, chunk_t key)
! 275: {
! 276: uint8_t L[128], T8, TM, idx;
! 277: int i;
! 278:
! 279: if (key.len != this->T)
! 280: {
! 281: return FALSE;
! 282: }
! 283: for (i = 0; i < key.len; i++)
! 284: {
! 285: L[i] = key.ptr[i];
! 286: }
! 287: for (; i < 128; i++)
! 288: {
! 289: idx = L[i-1] + L[i-key.len];
! 290: L[i] = PITABLE[idx];
! 291: }
! 292: T8 = (this->T1 + 7) / 8;
! 293: TM = ~(0xff << (8 - (8*T8 - this->T1)));
! 294: L[128-T8] = PITABLE[L[128-T8] & TM];
! 295: for (i = 127-T8; i >= 0; i--)
! 296: {
! 297: idx = L[i+1] ^ L[i+T8];
! 298: L[i] = PITABLE[idx];
! 299: }
! 300: for (i = 0; i < 64; i++)
! 301: {
! 302: this->K[i] = GET16(&L[i << 1]);
! 303: }
! 304: memwipe(L, sizeof(L));
! 305: return TRUE;
! 306: }
! 307:
! 308: METHOD(crypter_t, destroy, void,
! 309: private_rc2_crypter_t *this)
! 310: {
! 311: memwipe(this->K, sizeof(this->K));
! 312: free(this);
! 313: }
! 314:
! 315: /*
! 316: * Described in header
! 317: */
! 318: rc2_crypter_t *rc2_crypter_create(encryption_algorithm_t algo, size_t key_size)
! 319: {
! 320: private_rc2_crypter_t *this;
! 321: size_t effective;
! 322:
! 323: if (algo != ENCR_RC2_CBC)
! 324: {
! 325: return NULL;
! 326: }
! 327: key_size = max(1, key_size);
! 328: effective = RC2_EFFECTIVE_KEY_LEN(key_size);
! 329: key_size = min(128, RC2_KEY_LEN(key_size));
! 330: effective = max(1, min(1024, effective ?: key_size * 8));
! 331:
! 332: INIT(this,
! 333: .public = {
! 334: .crypter = {
! 335: .encrypt = _encrypt,
! 336: .decrypt = _decrypt,
! 337: .get_block_size = _get_block_size,
! 338: .get_iv_size = _get_iv_size,
! 339: .get_key_size = _get_key_size,
! 340: .set_key = _set_key,
! 341: .destroy = _destroy,
! 342: },
! 343: },
! 344: .T = key_size,
! 345: .T1 = effective,
! 346: );
! 347:
! 348: return &this->public;
! 349: }
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>