Home | History | Annotate | Line # | Download | only in cast128
      1 /*	$NetBSD: cast128.c,v 1.10 2014/01/01 15:18:57 pgoyette Exp $	*/
      2 /*      $OpenBSD: cast.c,v 1.2 2000/06/06 06:49:47 deraadt Exp $       */
      3 
      4 /*
      5  *	CAST-128 in C
      6  *	Written by Steve Reid <sreid (at) sea-to-sky.net>
      7  *	100% Public Domain - no warranty
      8  *	Released 1997.10.11
      9  */
     10 
     11 #include <sys/cdefs.h>
     12 __KERNEL_RCSID(0, "$NetBSD: cast128.c,v 1.10 2014/01/01 15:18:57 pgoyette Exp $");
     13 
     14 #include <sys/types.h>
     15 #include <sys/errno.h>
     16 #include <sys/module.h>
     17 
     18 #include <crypto/cast128/cast128.h>
     19 #include <crypto/cast128/cast128sb.h>
     20 
     21 /* Macros to access 8-bit bytes out of a 32-bit word */
     22 #define U_INT8_Ta(x) ( (u_int8_t) (x>>24) )
     23 #define U_INT8_Tb(x) ( (u_int8_t) ((x>>16)&255) )
     24 #define U_INT8_Tc(x) ( (u_int8_t) ((x>>8)&255) )
     25 #define U_INT8_Td(x) ( (u_int8_t) ((x)&255) )
     26 
     27 /* Circular left shift */
     28 #define ROL(x, n) ( ((x)<<(n)) | ((x)>>(32-(n))) )
     29 
     30 /* CAST-128 uses three different round functions */
     31 #define F1(l, r, i) \
     32 	t = ROL(key->xkey[i] + r, key->xkey[i+16]); \
     33 	l ^= ((cast_sbox1[U_INT8_Ta(t)] ^ cast_sbox2[U_INT8_Tb(t)]) - \
     34 	 cast_sbox3[U_INT8_Tc(t)]) + cast_sbox4[U_INT8_Td(t)];
     35 #define F2(l, r, i) \
     36 	t = ROL(key->xkey[i] ^ r, key->xkey[i+16]); \
     37 	l ^= ((cast_sbox1[U_INT8_Ta(t)] - cast_sbox2[U_INT8_Tb(t)]) + \
     38 	 cast_sbox3[U_INT8_Tc(t)]) ^ cast_sbox4[U_INT8_Td(t)];
     39 #define F3(l, r, i) \
     40 	t = ROL(key->xkey[i] - r, key->xkey[i+16]); \
     41 	l ^= ((cast_sbox1[U_INT8_Ta(t)] + cast_sbox2[U_INT8_Tb(t)]) ^ \
     42 	 cast_sbox3[U_INT8_Tc(t)]) - cast_sbox4[U_INT8_Td(t)];
     43 
     44 
     45 /***** Encryption Function *****/
     46 
     47 void cast128_encrypt(const cast128_key* key, const u_int8_t* inblock,
     48     u_int8_t* outblock)
     49 {
     50 u_int32_t t, l, r;
     51 
     52 	/* Get inblock into l,r */
     53 	l = ((u_int32_t)inblock[0] << 24) | ((u_int32_t)inblock[1] << 16) |
     54 	 ((u_int32_t)inblock[2] << 8) | (u_int32_t)inblock[3];
     55 	r = ((u_int32_t)inblock[4] << 24) | ((u_int32_t)inblock[5] << 16) |
     56 	 ((u_int32_t)inblock[6] << 8) | (u_int32_t)inblock[7];
     57 	/* Do the work */
     58 	F1(l, r,  0);
     59 	F2(r, l,  1);
     60 	F3(l, r,  2);
     61 	F1(r, l,  3);
     62 	F2(l, r,  4);
     63 	F3(r, l,  5);
     64 	F1(l, r,  6);
     65 	F2(r, l,  7);
     66 	F3(l, r,  8);
     67 	F1(r, l,  9);
     68 	F2(l, r, 10);
     69 	F3(r, l, 11);
     70 	/* Only do full 16 rounds if key length > 80 bits */
     71 	if (key->rounds > 12) {
     72 		F1(l, r, 12);
     73 		F2(r, l, 13);
     74 		F3(l, r, 14);
     75 		F1(r, l, 15);
     76 	}
     77 	/* Put l,r into outblock */
     78 	outblock[0] = U_INT8_Ta(r);
     79 	outblock[1] = U_INT8_Tb(r);
     80 	outblock[2] = U_INT8_Tc(r);
     81 	outblock[3] = U_INT8_Td(r);
     82 	outblock[4] = U_INT8_Ta(l);
     83 	outblock[5] = U_INT8_Tb(l);
     84 	outblock[6] = U_INT8_Tc(l);
     85 	outblock[7] = U_INT8_Td(l);
     86 	/* Wipe clean */
     87 	t = l = r = 0;
     88 }
     89 
     90 
     91 /***** Decryption Function *****/
     92 
     93 void cast128_decrypt(const cast128_key* key, const u_int8_t* inblock,
     94     u_int8_t* outblock)
     95 {
     96 u_int32_t t, l, r;
     97 
     98 	/* Get inblock into l,r */
     99 	r = ((u_int32_t)inblock[0] << 24) | ((u_int32_t)inblock[1] << 16) |
    100 	 ((u_int32_t)inblock[2] << 8) | (u_int32_t)inblock[3];
    101 	l = ((u_int32_t)inblock[4] << 24) | ((u_int32_t)inblock[5] << 16) |
    102 	 ((u_int32_t)inblock[6] << 8) | (u_int32_t)inblock[7];
    103 	/* Do the work */
    104 	/* Only do full 16 rounds if key length > 80 bits */
    105 	if (key->rounds > 12) {
    106 		F1(r, l, 15);
    107 		F3(l, r, 14);
    108 		F2(r, l, 13);
    109 		F1(l, r, 12);
    110 	}
    111 	F3(r, l, 11);
    112 	F2(l, r, 10);
    113 	F1(r, l,  9);
    114 	F3(l, r,  8);
    115 	F2(r, l,  7);
    116 	F1(l, r,  6);
    117 	F3(r, l,  5);
    118 	F2(l, r,  4);
    119 	F1(r, l,  3);
    120 	F3(l, r,  2);
    121 	F2(r, l,  1);
    122 	F1(l, r,  0);
    123 	/* Put l,r into outblock */
    124 	outblock[0] = U_INT8_Ta(l);
    125 	outblock[1] = U_INT8_Tb(l);
    126 	outblock[2] = U_INT8_Tc(l);
    127 	outblock[3] = U_INT8_Td(l);
    128 	outblock[4] = U_INT8_Ta(r);
    129 	outblock[5] = U_INT8_Tb(r);
    130 	outblock[6] = U_INT8_Tc(r);
    131 	outblock[7] = U_INT8_Td(r);
    132 	/* Wipe clean */
    133 	t = l = r = 0;
    134 }
    135 
    136 
    137 /***** Key Schedual *****/
    138 
    139 void cast128_setkey(cast128_key* key, const u_int8_t* rawkey, int keybytes)
    140 {
    141 	u_int32_t t[4], z[4], x[4];
    142 	int i;
    143 
    144 	/* Set number of rounds to 12 or 16, depending on key length */
    145 	key->rounds = (keybytes <= 10 ? 12 : 16);
    146 
    147 	/* Copy key to workspace x */
    148 	for (i = 0; i < 4; i++) {
    149 		x[i] = 0;
    150 		t[i] = z[i] = 0;	/* XXX gcc */
    151 		if ((i*4+0) < keybytes) x[i] = (u_int32_t)rawkey[i*4+0] << 24;
    152 		if ((i*4+1) < keybytes) x[i] |= (u_int32_t)rawkey[i*4+1] << 16;
    153 		if ((i*4+2) < keybytes) x[i] |= (u_int32_t)rawkey[i*4+2] << 8;
    154 		if ((i*4+3) < keybytes) x[i] |= (u_int32_t)rawkey[i*4+3];
    155 	}
    156 	/* Generate 32 subkeys, four at a time */
    157 	for (i = 0; i < 32; i+=4) {
    158 		switch (i & 4) {
    159 		 case 0:
    160 			t[0] = z[0] = x[0] ^ cast_sbox5[U_INT8_Tb(x[3])] ^
    161 			 cast_sbox6[U_INT8_Td(x[3])] ^ cast_sbox7[U_INT8_Ta(x[3])] ^
    162 			 cast_sbox8[U_INT8_Tc(x[3])] ^ cast_sbox7[U_INT8_Ta(x[2])];
    163 			t[1] = z[1] = x[2] ^ cast_sbox5[U_INT8_Ta(z[0])] ^
    164 			 cast_sbox6[U_INT8_Tc(z[0])] ^ cast_sbox7[U_INT8_Tb(z[0])] ^
    165 			 cast_sbox8[U_INT8_Td(z[0])] ^ cast_sbox8[U_INT8_Tc(x[2])];
    166 			t[2] = z[2] = x[3] ^ cast_sbox5[U_INT8_Td(z[1])] ^
    167 			 cast_sbox6[U_INT8_Tc(z[1])] ^ cast_sbox7[U_INT8_Tb(z[1])] ^
    168 			 cast_sbox8[U_INT8_Ta(z[1])] ^ cast_sbox5[U_INT8_Tb(x[2])];
    169 			t[3] = z[3] = x[1] ^ cast_sbox5[U_INT8_Tc(z[2])] ^
    170 			 cast_sbox6[U_INT8_Tb(z[2])] ^ cast_sbox7[U_INT8_Td(z[2])] ^
    171 			 cast_sbox8[U_INT8_Ta(z[2])] ^ cast_sbox6[U_INT8_Td(x[2])];
    172 			break;
    173 		 case 4:
    174 			t[0] = x[0] = z[2] ^ cast_sbox5[U_INT8_Tb(z[1])] ^
    175 			 cast_sbox6[U_INT8_Td(z[1])] ^ cast_sbox7[U_INT8_Ta(z[1])] ^
    176 			 cast_sbox8[U_INT8_Tc(z[1])] ^ cast_sbox7[U_INT8_Ta(z[0])];
    177 			t[1] = x[1] = z[0] ^ cast_sbox5[U_INT8_Ta(x[0])] ^
    178 			 cast_sbox6[U_INT8_Tc(x[0])] ^ cast_sbox7[U_INT8_Tb(x[0])] ^
    179 			 cast_sbox8[U_INT8_Td(x[0])] ^ cast_sbox8[U_INT8_Tc(z[0])];
    180 			t[2] = x[2] = z[1] ^ cast_sbox5[U_INT8_Td(x[1])] ^
    181 			 cast_sbox6[U_INT8_Tc(x[1])] ^ cast_sbox7[U_INT8_Tb(x[1])] ^
    182 			 cast_sbox8[U_INT8_Ta(x[1])] ^ cast_sbox5[U_INT8_Tb(z[0])];
    183 			t[3] = x[3] = z[3] ^ cast_sbox5[U_INT8_Tc(x[2])] ^
    184 			 cast_sbox6[U_INT8_Tb(x[2])] ^ cast_sbox7[U_INT8_Td(x[2])] ^
    185 			 cast_sbox8[U_INT8_Ta(x[2])] ^ cast_sbox6[U_INT8_Td(z[0])];
    186 			break;
    187 		}
    188 		switch (i & 12) {
    189 		 case 0:
    190 		 case 12:
    191 			key->xkey[i+0] = cast_sbox5[U_INT8_Ta(t[2])] ^ cast_sbox6[U_INT8_Tb(t[2])] ^
    192 			 cast_sbox7[U_INT8_Td(t[1])] ^ cast_sbox8[U_INT8_Tc(t[1])];
    193 			key->xkey[i+1] = cast_sbox5[U_INT8_Tc(t[2])] ^ cast_sbox6[U_INT8_Td(t[2])] ^
    194 			 cast_sbox7[U_INT8_Tb(t[1])] ^ cast_sbox8[U_INT8_Ta(t[1])];
    195 			key->xkey[i+2] = cast_sbox5[U_INT8_Ta(t[3])] ^ cast_sbox6[U_INT8_Tb(t[3])] ^
    196 			 cast_sbox7[U_INT8_Td(t[0])] ^ cast_sbox8[U_INT8_Tc(t[0])];
    197 			key->xkey[i+3] = cast_sbox5[U_INT8_Tc(t[3])] ^ cast_sbox6[U_INT8_Td(t[3])] ^
    198 			 cast_sbox7[U_INT8_Tb(t[0])] ^ cast_sbox8[U_INT8_Ta(t[0])];
    199 			break;
    200 		 case 4:
    201 		 case 8:
    202 			key->xkey[i+0] = cast_sbox5[U_INT8_Td(t[0])] ^ cast_sbox6[U_INT8_Tc(t[0])] ^
    203 			 cast_sbox7[U_INT8_Ta(t[3])] ^ cast_sbox8[U_INT8_Tb(t[3])];
    204 			key->xkey[i+1] = cast_sbox5[U_INT8_Tb(t[0])] ^ cast_sbox6[U_INT8_Ta(t[0])] ^
    205 			 cast_sbox7[U_INT8_Tc(t[3])] ^ cast_sbox8[U_INT8_Td(t[3])];
    206 			key->xkey[i+2] = cast_sbox5[U_INT8_Td(t[1])] ^ cast_sbox6[U_INT8_Tc(t[1])] ^
    207 			 cast_sbox7[U_INT8_Ta(t[2])] ^ cast_sbox8[U_INT8_Tb(t[2])];
    208 			key->xkey[i+3] = cast_sbox5[U_INT8_Tb(t[1])] ^ cast_sbox6[U_INT8_Ta(t[1])] ^
    209 			 cast_sbox7[U_INT8_Tc(t[2])] ^ cast_sbox8[U_INT8_Td(t[2])];
    210 			break;
    211 		}
    212 		switch (i & 12) {
    213 		 case 0:
    214 			key->xkey[i+0] ^= cast_sbox5[U_INT8_Tc(z[0])];
    215 			key->xkey[i+1] ^= cast_sbox6[U_INT8_Tc(z[1])];
    216 			key->xkey[i+2] ^= cast_sbox7[U_INT8_Tb(z[2])];
    217 			key->xkey[i+3] ^= cast_sbox8[U_INT8_Ta(z[3])];
    218 			break;
    219 		 case 4:
    220 			key->xkey[i+0] ^= cast_sbox5[U_INT8_Ta(x[2])];
    221 			key->xkey[i+1] ^= cast_sbox6[U_INT8_Tb(x[3])];
    222 			key->xkey[i+2] ^= cast_sbox7[U_INT8_Td(x[0])];
    223 			key->xkey[i+3] ^= cast_sbox8[U_INT8_Td(x[1])];
    224 			break;
    225 		 case 8:
    226 			key->xkey[i+0] ^= cast_sbox5[U_INT8_Tb(z[2])];
    227 			key->xkey[i+1] ^= cast_sbox6[U_INT8_Ta(z[3])];
    228 			key->xkey[i+2] ^= cast_sbox7[U_INT8_Tc(z[0])];
    229 			key->xkey[i+3] ^= cast_sbox8[U_INT8_Tc(z[1])];
    230 			break;
    231 		 case 12:
    232 			key->xkey[i+0] ^= cast_sbox5[U_INT8_Td(x[0])];
    233 			key->xkey[i+1] ^= cast_sbox6[U_INT8_Td(x[1])];
    234 			key->xkey[i+2] ^= cast_sbox7[U_INT8_Ta(x[2])];
    235 			key->xkey[i+3] ^= cast_sbox8[U_INT8_Tb(x[3])];
    236 			break;
    237 		}
    238 		if (i >= 16) {
    239 			key->xkey[i+0] &= 31;
    240 			key->xkey[i+1] &= 31;
    241 			key->xkey[i+2] &= 31;
    242 			key->xkey[i+3] &= 31;
    243 		}
    244 	}
    245 	/* Wipe clean */
    246 	for (i = 0; i < 4; i++) {
    247 		t[i] = x[i] = z[i] = 0;
    248 	}
    249 }
    250 
    251 /* Made in Canada */
    252 
    253 #if defined(_KERNEL)
    254 
    255 MODULE(MODULE_CLASS_MISC, cast128, NULL);
    256 
    257 static int
    258 cast128_modcmd(modcmd_t cmd, void *opaque)
    259 {
    260 
    261 	switch (cmd) {
    262 	case MODULE_CMD_INIT:
    263 		return 0;
    264 	case MODULE_CMD_FINI:
    265 		return 0;
    266 	default:
    267 		return ENOTTY;
    268 	}
    269 }
    270 
    271 #endif /* defined(KERNEL) */
    272