Linux Headquarters
[ Register ]
[ About us ] [ Home Page ]

Advertisement
[ Kernel ] [ Documentation ] [ Links ] [ Books ]

Advertisement

Kernel v2.6.25-rc7 /crypto/camellia.c

Filename:/crypto/camellia.c
Lines Added:554
Lines Deleted:1227
Also changed in: (Previous) 2.6.25-rc6  2.6.25-rc5  2.6.25-rc4  2.6.25-rc3  2.6.25-rc2  2.6.25-rc1 
(Following) 2.6.25-rc8  2.6.25-rc9  2.6.25  2.6.26-git1  2.6.26-git2  2.6.26-git3 

Location
[  2.6.25-rc7
  [  crypto
     o  camellia.c

Patch

diff --git a/crypto/camellia.c b/crypto/camellia.c
index 6877ecf..493fee7 100644
--- a/crypto/camellia.c
+++ b/crypto/camellia.c
@@ -36,176 +36,6 @@
 #include <linux/kernel.h>
 #include <linux/module.h>
 
-
-#define CAMELLIA_MIN_KEY_SIZE        16
-#define CAMELLIA_MAX_KEY_SIZE        32
-#define CAMELLIA_BLOCK_SIZE 16
-#define CAMELLIA_TABLE_BYTE_LEN 272
-#define CAMELLIA_TABLE_WORD_LEN (CAMELLIA_TABLE_BYTE_LEN / 4)
-
-typedef u32 KEY_TABLE_TYPE[CAMELLIA_TABLE_WORD_LEN];
-
-
-/* key constants */
-
-#define CAMELLIA_SIGMA1L (0xA09E667FL)
-#define CAMELLIA_SIGMA1R (0x3BCC908BL)
-#define CAMELLIA_SIGMA2L (0xB67AE858L)
-#define CAMELLIA_SIGMA2R (0x4CAA73B2L)
-#define CAMELLIA_SIGMA3L (0xC6EF372FL)
-#define CAMELLIA_SIGMA3R (0xE94F82BEL)
-#define CAMELLIA_SIGMA4L (0x54FF53A5L)
-#define CAMELLIA_SIGMA4R (0xF1D36F1CL)
-#define CAMELLIA_SIGMA5L (0x10E527FAL)
-#define CAMELLIA_SIGMA5R (0xDE682D1DL)
-#define CAMELLIA_SIGMA6L (0xB05688C2L)
-#define CAMELLIA_SIGMA6R (0xB3E6C1FDL)
-
-struct camellia_ctx {
-   int key_length;
-   KEY_TABLE_TYPE key_table;
-};
-
-
-/*
- *  macros
- */
-
-
-# define GETU32(pt) (((u32)(pt)[0] << 24)   \
-           ^ ((u32)(pt)[1] << 16)   \
-           ^ ((u32)(pt)[2] <<  8)   \
-           ^ ((u32)(pt)[3]))
-
-#define COPY4WORD(dst, src)         \
-    do {               \
-   (dst)[0]=(src)[0];         \
-   (dst)[1]=(src)[1];         \
-   (dst)[2]=(src)[2];         \
-   (dst)[3]=(src)[3];         \
-    }while(0)
-
-#define SWAP4WORD(word)            \
-    do {               \
-   CAMELLIA_SWAP4((word)[0]);      \
-   CAMELLIA_SWAP4((word)[1]);      \
-   CAMELLIA_SWAP4((word)[2]);      \
-   CAMELLIA_SWAP4((word)[3]);      \
-    }while(0)
-
-#define XOR4WORD(a, b)/* a = a ^ b */      \
-    do {               \
-   (a)[0]^=(b)[0];            \
-   (a)[1]^=(b)[1];            \
-   (a)[2]^=(b)[2];            \
-   (a)[3]^=(b)[3];            \
-    }while(0)
-
-#define XOR4WORD2(a, b, c)/* a = b ^ c */   \
-    do {               \
-   (a)[0]=(b)[0]^(c)[0];         \
-   (a)[1]=(b)[1]^(c)[1];         \
-   (a)[2]=(b)[2]^(c)[2];         \
-   (a)[3]=(b)[3]^(c)[3];         \
-    }while(0)
-
-#define CAMELLIA_SUBKEY_L(INDEX) (subkey[(INDEX)*2])
-#define CAMELLIA_SUBKEY_R(INDEX) (subkey[(INDEX)*2 + 1])
-
-/* rotation right shift 1byte */
-#define CAMELLIA_RR8(x) (((x) >> 8) + ((x) << 24))
-/* rotation left shift 1bit */
-#define CAMELLIA_RL1(x) (((x) << 1) + ((x) >> 31))
-/* rotation left shift 1byte */
-#define CAMELLIA_RL8(x) (((x) << 8) + ((x) >> 24))
-
-#define CAMELLIA_ROLDQ(ll, lr, rl, rr, w0, w1, bits)   \
-    do {                  \
-   w0 = ll;               \
-   ll = (ll << bits) + (lr >> (32 - bits));   \
-   lr = (lr << bits) + (rl >> (32 - bits));   \
-   rl = (rl << bits) + (rr >> (32 - bits));   \
-   rr = (rr << bits) + (w0 >> (32 - bits));   \
-    } while(0)
-
-#define CAMELLIA_ROLDQo32(ll, lr, rl, rr, w0, w1, bits)   \
-    do {                  \
-   w0 = ll;               \
-   w1 = lr;               \
-   ll = (lr << (bits - 32)) + (rl >> (64 - bits));   \
-   lr = (rl << (bits - 32)) + (rr >> (64 - bits));   \
-   rl = (rr << (bits - 32)) + (w0 >> (64 - bits));   \
-   rr = (w0 << (bits - 32)) + (w1 >> (64 - bits));   \
-    } while(0)
-
-#define CAMELLIA_SP1110(INDEX) (camellia_sp1110[(INDEX)])
-#define CAMELLIA_SP0222(INDEX) (camellia_sp0222[(INDEX)])
-#define CAMELLIA_SP3033(INDEX) (camellia_sp3033[(INDEX)])
-#define CAMELLIA_SP4404(INDEX) (camellia_sp4404[(INDEX)])
-
-#define CAMELLIA_F(xl, xr, kl, kr, yl, yr, il, ir, t0, t1)   \
-    do {                     \
-   il = xl ^ kl;                  \
-   ir = xr ^ kr;                  \
-   t0 = il >> 16;                  \
-   t1 = ir >> 16;                  \
-   yl = CAMELLIA_SP1110(ir & 0xff)            \
-       ^ CAMELLIA_SP0222((t1 >> 8) & 0xff)         \
-       ^ CAMELLIA_SP3033(t1 & 0xff)         \
-       ^ CAMELLIA_SP4404((ir >> 8) & 0xff);      \
-   yr = CAMELLIA_SP1110((t0 >> 8) & 0xff)         \
-       ^ CAMELLIA_SP0222(t0 & 0xff)         \
-       ^ CAMELLIA_SP3033((il >> 8) & 0xff)         \
-       ^ CAMELLIA_SP4404(il & 0xff);         \
-   yl ^= yr;                  \
-   yr = CAMELLIA_RR8(yr);               \
-   yr ^= yl;                  \
-    } while(0)
-
-
-/*
- * for speed up
- *
- */
-#define CAMELLIA_FLS(ll, lr, rl, rr, kll, klr, krl, krr, t0, t1, t2, t3) \
-    do {                        \
-   t0 = kll;                     \
-   t2 = krr;                     \
-   t0 &= ll;                     \
-   t2 |= rr;                     \
-   rl ^= t2;                     \
-   lr ^= CAMELLIA_RL1(t0);                  \
-   t3 = krl;                     \
-   t1 = klr;                     \
-   t3 &= rl;                     \
-   t1 |= lr;                     \
-   ll ^= t1;                     \
-   rr ^= CAMELLIA_RL1(t3);                  \
-    } while(0)
-
-#define CAMELLIA_ROUNDSM(xl, xr, kl, kr, yl, yr, il, ir, t0, t1)   \
-    do {                        \
-   ir =  CAMELLIA_SP1110(xr & 0xff);            \
-   il =  CAMELLIA_SP1110((xl>>24) & 0xff);            \
-   ir ^= CAMELLIA_SP0222((xr>>24) & 0xff);            \
-   il ^= CAMELLIA_SP0222((xl>>16) & 0xff);            \
-   ir ^= CAMELLIA_SP3033((xr>>16) & 0xff);            \
-   il ^= CAMELLIA_SP3033((xl>>8) & 0xff);            \
-   ir ^= CAMELLIA_SP4404((xr>>8) & 0xff);            \
-   il ^= CAMELLIA_SP4404(xl & 0xff);            \
-   il ^= kl;                     \
-   ir ^= il ^ kr;                     \
-   yl ^= ir;                     \
-   yr ^= CAMELLIA_RR8(il) ^ ir;               \
-    } while(0)
-
-/**
- * Stuff related to the Camellia key schedule
- */
-#define SUBL(x) subL[(x)]
-#define SUBR(x) subR[(x)]
-
-
 static const u32 camellia_sp1110[256] = {
    0x70707000,0x82828200,0x2c2c2c00,0xececec00,
    0xb3b3b300,0x27272700,0xc0c0c000,0xe5e5e500,
@@ -475,67 +305,348 @@ static const u32 camellia_sp4404[256] = {
 };
 
 
+#define CAMELLIA_MIN_KEY_SIZE        16
+#define CAMELLIA_MAX_KEY_SIZE        32
+#define CAMELLIA_BLOCK_SIZE          16
+#define CAMELLIA_TABLE_BYTE_LEN     272
+
+/*
+ * NB: L and R below stand for 'left' and 'right' as in written numbers.
+ * That is, in (xxxL,xxxR) pair xxxL holds most significant digits,
+ * _not_ least significant ones!
+ */
+
+
+/* key constants */
+
+#define CAMELLIA_SIGMA1L (0xA09E667FL)
+#define CAMELLIA_SIGMA1R (0x3BCC908BL)
+#define CAMELLIA_SIGMA2L (0xB67AE858L)
+#define CAMELLIA_SIGMA2R (0x4CAA73B2L)
+#define CAMELLIA_SIGMA3L (0xC6EF372FL)
+#define CAMELLIA_SIGMA3R (0xE94F82BEL)
+#define CAMELLIA_SIGMA4L (0x54FF53A5L)
+#define CAMELLIA_SIGMA4R (0xF1D36F1CL)
+#define CAMELLIA_SIGMA5L (0x10E527FAL)
+#define CAMELLIA_SIGMA5R (0xDE682D1DL)
+#define CAMELLIA_SIGMA6L (0xB05688C2L)
+#define CAMELLIA_SIGMA6R (0xB3E6C1FDL)
+
+/*
+ *  macros
+ */
+#define GETU32(v, pt) \
+    do { \
+   /* latest breed of gcc is clever enough to use move */ \
+   memcpy(&(v), (pt), 4); \
+   (v) = be32_to_cpu(v); \
+    } while(0)
+
+/* rotation right shift 1byte */
+#define ROR8(x) (((x) >> 8) + ((x) << 24))
+/* rotation left shift 1bit */
+#define ROL1(x) (((x) << 1) + ((x) >> 31))
+/* rotation left shift 1byte */
+#define ROL8(x) (((x) << 8) + ((x) >> 24))
+
+#define ROLDQ(ll, lr, rl, rr, w0, w1, bits)      \
+    do {                  \
+   w0 = ll;               \
+   ll = (ll << bits) + (lr >> (32 - bits));   \
+   lr = (lr << bits) + (rl >> (32 - bits));   \
+   rl = (rl << bits) + (rr >> (32 - bits));   \
+   rr = (rr << bits) + (w0 >> (32 - bits));   \
+    } while(0)
+
+#define ROLDQo32(ll, lr, rl, rr, w0, w1, bits)      \
+    do {                  \
+   w0 = ll;               \
+   w1 = lr;               \
+   ll = (lr << (bits - 32)) + (rl >> (64 - bits));   \
+   lr = (rl << (bits - 32)) + (rr >> (64 - bits));   \
+   rl = (rr << (bits - 32)) + (w0 >> (64 - bits));   \
+   rr = (w0 << (bits - 32)) + (w1 >> (64 - bits));   \
+    } while(0)
+
+#define CAMELLIA_F(xl, xr, kl, kr, yl, yr, il, ir, t0, t1)   \
+    do {                     \
+   il = xl ^ kl;                  \
+   ir = xr ^ kr;                  \
+   t0 = il >> 16;                  \
+   t1 = ir >> 16;                  \
+   yl = camellia_sp1110[(u8)(ir     )]         \
+      ^ camellia_sp0222[    (t1 >> 8)]         \
+      ^ camellia_sp3033[(u8)(t1     )]         \
+      ^ camellia_sp4404[(u8)(ir >> 8)];         \
+   yr = camellia_sp1110[    (t0 >> 8)]         \
+      ^ camellia_sp0222[(u8)(t0     )]         \
+      ^ camellia_sp3033[(u8)(il >> 8)]         \
+      ^ camellia_sp4404[(u8)(il     )];         \
+   yl ^= yr;                  \
+   yr = ROR8(yr);                  \
+   yr ^= yl;                  \
+    } while(0)
+
+#define SUBKEY_L(INDEX) (subkey[(INDEX)*2])
+#define SUBKEY_R(INDEX) (subkey[(INDEX)*2 + 1])
+
+static void camellia_setup_tail(u32 *subkey, u32 *subL, u32 *subR, int max)
+{
+   u32 dw, tl, tr;
+   u32 kw4l, kw4r;
+   int i;
+
+   /* absorb kw2 to other subkeys */
+   /* round 2 */
+   subL[3] ^= subL[1]; subR[3] ^= subR[1];
+   /* round 4 */
+   subL[5] ^= subL[1]; subR[5] ^= subR[1];
+   /* round 6 */
+   subL[7] ^= subL[1]; subR[7] ^= subR[1];
+   subL[1] ^= subR[1] & ~subR[9];
+   dw = subL[1] & subL[9],
+      subR[1] ^= ROL1(dw); /* modified for FLinv(kl2) */
+   /* round 8 */
+   subL[11] ^= subL[1]; subR[11] ^= subR[1];
+   /* round 10 */
+   subL[13] ^= subL[1]; subR[13] ^= subR[1];
+   /* round 12 */
+   subL[15] ^= subL[1]; subR[15] ^= subR[1];
+   subL[1] ^= subR[1] & ~subR[17];
+   dw = subL[1] & subL[17],
+      subR[1] ^= ROL1(dw); /* modified for FLinv(kl4) */
+   /* round 14 */
+   subL[19] ^= subL[1]; subR[19] ^= subR[1];
+   /* round 16 */
+   subL[21] ^= subL[1]; subR[21] ^= subR[1];
+   /* round 18 */
+   subL[23] ^= subL[1]; subR[23] ^= subR[1];
+   if (max == 24) {
+      /* kw3 */
+      subL[24] ^= subL[1]; subR[24] ^= subR[1];
+
+   /* absorb kw4 to other subkeys */
+      kw4l = subL[25]; kw4r = subR[25];
+   } else {
+      subL[1] ^= subR[1] & ~subR[25];
+      dw = subL[1] & subL[25],
+         subR[1] ^= ROL1(dw); /* modified for FLinv(kl6) */
+      /* round 20 */
+      subL[27] ^= subL[1]; subR[27] ^= subR[1];
+      /* round 22 */
+      subL[29] ^= subL[1]; subR[29] ^= subR[1];
+      /* round 24 */
+      subL[31] ^= subL[1]; subR[31] ^= subR[1];
+      /* kw3 */
+      subL[32] ^= subL[1]; subR[32] ^= subR[1];
+
+   /* absorb kw4 to other subkeys */
+      kw4l = subL[33]; kw4r = subR[33];
+      /* round 23 */
+      subL[30] ^= kw4l; subR[30] ^= kw4r;
+      /* round 21 */
+      subL[28] ^= kw4l; subR[28] ^= kw4r;
+      /* round 19 */
+      subL[26] ^= kw4l; subR[26] ^= kw4r;
+      kw4l ^= kw4r & ~subR[24];
+      dw = kw4l & subL[24],
+         kw4r ^= ROL1(dw); /* modified for FL(kl5) */
+   }
+   /* round 17 */
+   subL[22] ^= kw4l; subR[22] ^= kw4r;
+   /* round 15 */
+   subL[20] ^= kw4l; subR[20] ^= kw4r;
+   /* round 13 */
+   subL[18] ^= kw4l; subR[18] ^= kw4r;
+   kw4l ^= kw4r & ~subR[16];
+   dw = kw4l & subL[16],
+      kw4r ^= ROL1(dw); /* modified for FL(kl3) */
+   /* round 11 */
+   subL[14] ^= kw4l; subR[14] ^= kw4r;
+   /* round 9 */
+   subL[12] ^= kw4l; subR[12] ^= kw4r;
+   /* round 7 */
+   subL[10] ^= kw4l; subR[10] ^= kw4r;
+   kw4l ^= kw4r & ~subR[8];
+   dw = kw4l & subL[8],
+      kw4r ^= ROL1(dw); /* modified for FL(kl1) */
+   /* round 5 */
+   subL[6] ^= kw4l; subR[6] ^= kw4r;
+   /* round 3 */
+   subL[4] ^= kw4l; subR[4] ^= kw4r;
+   /* round 1 */
+   subL[2] ^= kw4l; subR[2] ^= kw4r;
+   /* kw1 */
+   subL[0] ^= kw4l; subR[0] ^= kw4r;
+
+   /* key XOR is end of F-function */
+   SUBKEY_L(0) = subL[0] ^ subL[2];/* kw1 */
+   SUBKEY_R(0) = subR[0] ^ subR[2];
+   SUBKEY_L(2) = subL[3];       /* round 1 */
+   SUBKEY_R(2) = subR[3];
+   SUBKEY_L(3) = subL[2] ^ subL[4]; /* round 2 */
+   SUBKEY_R(3) = subR[2] ^ subR[4];
+   SUBKEY_L(4) = subL[3] ^ subL[5]; /* round 3 */
+   SUBKEY_R(4) = subR[3] ^ subR[5];
+   SUBKEY_L(5) = subL[4] ^ subL[6]; /* round 4 */
+   SUBKEY_R(5) = subR[4] ^ subR[6];
+   SUBKEY_L(6) = subL[5] ^ subL[7]; /* round 5 */
+   SUBKEY_R(6) = subR[5] ^ subR[7];
+   tl = subL[10] ^ (subR[10] & ~subR[8]);
+   dw = tl & subL[8],  /* FL(kl1) */
+      tr = subR[10] ^ ROL1(dw);
+   SUBKEY_L(7) = subL[6] ^ tl; /* round 6 */
+   SUBKEY_R(7) = subR[6] ^ tr;
+   SUBKEY_L(8) = subL[8];       /* FL(kl1) */
+   SUBKEY_R(8) = subR[8];
+   SUBKEY_L(9) = subL[9];       /* FLinv(kl2) */
+   SUBKEY_R(9) = subR[9];
+   tl = subL[7] ^ (subR[7] & ~subR[9]);
+   dw = tl & subL[9],  /* FLinv(kl2) */
+      tr = subR[7] ^ ROL1(dw);
+   SUBKEY_L(10) = tl ^ subL[11]; /* round 7 */
+   SUBKEY_R(10) = tr ^ subR[11];
+   SUBKEY_L(11) = subL[10] ^ subL[12]; /* round 8 */
+   SUBKEY_R(11) = subR[10] ^ subR[12];
+   SUBKEY_L(12) = subL[11] ^ subL[13]; /* round 9 */
+   SUBKEY_R(12) = subR[11] ^ subR[13];
+   SUBKEY_L(13) = subL[12] ^ subL[14]; /* round 10 */
+   SUBKEY_R(13) = subR[12] ^ subR[14];
+   SUBKEY_L(14) = subL[13] ^ subL[15]; /* round 11 */
+   SUBKEY_R(14) = subR[13] ^ subR[15];
+   tl = subL[18] ^ (subR[18] & ~subR[16]);
+   dw = tl & subL[16], /* FL(kl3) */
+      tr = subR[18] ^ ROL1(dw);
+   SUBKEY_L(15) = subL[14] ^ tl; /* round 12 */
+   SUBKEY_R(15) = subR[14] ^ tr;
+   SUBKEY_L(16) = subL[16];     /* FL(kl3) */
+   SUBKEY_R(16) = subR[16];
+   SUBKEY_L(17) = subL[17];     /* FLinv(kl4) */
+   SUBKEY_R(17) = subR[17];
+   tl = subL[15] ^ (subR[15] & ~subR[17]);
+   dw = tl & subL[17], /* FLinv(kl4) */
+      tr = subR[15] ^ ROL1(dw);
+   SUBKEY_L(18) = tl ^ subL[19]; /* round 13 */
+   SUBKEY_R(18) = tr ^ subR[19];
+   SUBKEY_L(19) = subL[18] ^ subL[20]; /* round 14 */
+   SUBKEY_R(19) = subR[18] ^ subR[20];
+   SUBKEY_L(20) = subL[19] ^ subL[21]; /* round 15 */
+   SUBKEY_R(20) = subR[19] ^ subR[21];
+   SUBKEY_L(21) = subL[20] ^ subL[22]; /* round 16 */
+   SUBKEY_R(21) = subR[20] ^ subR[22];
+   SUBKEY_L(22) = subL[21] ^ subL[23]; /* round 17 */
+   SUBKEY_R(22) = subR[21] ^ subR[23];
+   if (max == 24) {
+      SUBKEY_L(23) = subL[22];     /* round 18 */
+      SUBKEY_R(23) = subR[22];
+      SUBKEY_L(24) = subL[24] ^ subL[23]; /* kw3 */
+      SUBKEY_R(24) = subR[24] ^ subR[23];
+   } else {
+      tl = subL[26] ^ (subR[26] & ~subR[24]);
+      dw = tl & subL[24], /* FL(kl5) */
+         tr = subR[26] ^ ROL1(dw);
+      SUBKEY_L(23) = subL[22] ^ tl; /* round 18 */
+      SUBKEY_R(23) = subR[22] ^ tr;
+      SUBKEY_L(24) = subL[24];     /* FL(kl5) */
+      SUBKEY_R(24) = subR[24];
+      SUBKEY_L(25) = subL[25];     /* FLinv(kl6) */
+      SUBKEY_R(25) = subR[25];
+      tl = subL[23] ^ (subR[23] & ~subR[25]);
+      dw = tl & subL[25], /* FLinv(kl6) */
+         tr = subR[23] ^ ROL1(dw);
+      SUBKEY_L(26) = tl ^ subL[27]; /* round 19 */
+      SUBKEY_R(26) = tr ^ subR[27];
+      SUBKEY_L(27) = subL[26] ^ subL[28]; /* round 20 */
+      SUBKEY_R(27) = subR[26] ^ subR[28];
+      SUBKEY_L(28) = subL[27] ^ subL[29]; /* round 21 */
+      SUBKEY_R(28) = subR[27] ^ subR[29];
+      SUBKEY_L(29) = subL[28] ^ subL[30]; /* round 22 */
+      SUBKEY_R(29) = subR[28] ^ subR[30];
+      SUBKEY_L(30) = subL[29] ^ subL[31]; /* round 23 */
+      SUBKEY_R(30) = subR[29] ^ subR[31];
+      SUBKEY_L(31) = subL[30];     /* round 24 */
+      SUBKEY_R(31) = subR[30];
+      SUBKEY_L(32) = subL[32] ^ subL[31]; /* kw3 */
+      SUBKEY_R(32) = subR[32] ^ subR[31];
+   }
+
+   /* apply the inverse of the last half of P-function */
+   i = 2;
+   do {
+      dw = SUBKEY_L(i + 0) ^ SUBKEY_R(i + 0); dw = ROL8(dw);/* round 1 */
+      SUBKEY_R(i + 0) = SUBKEY_L(i + 0) ^ dw; SUBKEY_L(i + 0) = dw;
+      dw = SUBKEY_L(i + 1) ^ SUBKEY_R(i + 1); dw = ROL8(dw);/* round 2 */
+      SUBKEY_R(i + 1) = SUBKEY_L(i + 1) ^ dw; SUBKEY_L(i + 1) = dw;
+      dw = SUBKEY_L(i + 2) ^ SUBKEY_R(i + 2); dw = ROL8(dw);/* round 3 */
+      SUBKEY_R(i + 2) = SUBKEY_L(i + 2) ^ dw; SUBKEY_L(i + 2) = dw;
+      dw = SUBKEY_L(i + 3) ^ SUBKEY_R(i + 3); dw = ROL8(dw);/* round 4 */
+      SUBKEY_R(i + 3) = SUBKEY_L(i + 3) ^ dw; SUBKEY_L(i + 3) = dw;
+      dw = SUBKEY_L(i + 4) ^ SUBKEY_R(i + 4); dw = ROL8(dw);/* round 5 */
+      SUBKEY_R(i + 4) = SUBKEY_L(i + 4) ^ dw; SUBKEY_L(i + 4) = dw;
+      dw = SUBKEY_L(i + 5) ^ SUBKEY_R(i + 5); dw = ROL8(dw);/* round 6 */
+      SUBKEY_R(i + 5) = SUBKEY_L(i + 5) ^ dw; SUBKEY_L(i + 5) = dw;
+      i += 8;
+   } while (i < max);
+}
 
 static void camellia_setup128(const unsigned char *key, u32 *subkey)
 {
    u32 kll, klr, krl, krr;
    u32 il, ir, t0, t1, w0, w1;
-   u32 kw4l, kw4r, dw, tl, tr;
    u32 subL[26];
    u32 subR[26];
 
    /**
-    *  k == kll || klr || krl || krr (|| is concatination)
-    */
-   kll = GETU32(key     );
-   klr = GETU32(key +  4);
-   krl = GETU32(key +  8);
-   krr = GETU32(key + 12);
-   /**
-    * generate KL dependent subkeys
+    *  k == kll || klr || krl || krr (|| is concatenation)
     */
+   GETU32(kll, key     );
+   GETU32(klr, key +  4);
+   GETU32(krl, key +  8);
+   GETU32(krr, key + 12);
+
+   /* generate KL dependent subkeys */
    /* kw1 */
-   SUBL(0) = kll; SUBR(0) = klr;
+   subL[0] = kll; subR[0] = klr;
    /* kw2 */
-   SUBL(1) = krl; SUBR(1) = krr;
+   subL[1] = krl; subR[1] = krr;
    /* rotation left shift 15bit */
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 15);
+   ROLDQ(kll, klr, krl, krr, w0, w1, 15);
    /* k3 */
-   SUBL(4) = kll; SUBR(4) = klr;
+   subL[4] = kll; subR[4] = klr;
    /* k4 */
-   SUBL(5) = krl; SUBR(5) = krr;
+   subL[5] = krl; subR[5] = krr;
    /* rotation left shift 15+30bit */
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 30);
+   ROLDQ(kll, klr, krl, krr, w0, w1, 30);
    /* k7 */
-   SUBL(10) = kll; SUBR(10) = klr;
+   subL[10] = kll; subR[10] = klr;
    /* k8 */
-   SUBL(11) = krl; SUBR(11) = krr;
+   subL[11] = krl; subR[11] = krr;
    /* rotation left shift 15+30+15bit */
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 15);
+   ROLDQ(kll, klr, krl, krr, w0, w1, 15);
    /* k10 */
-   SUBL(13) = krl; SUBR(13) = krr;
+   subL[13] = krl; subR[13] = krr;
    /* rotation left shift 15+30+15+17 bit */
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 17);
+   ROLDQ(kll, klr, krl, krr, w0, w1, 17);
    /* kl3 */
-   SUBL(16) = kll; SUBR(16) = klr;
+   subL[16] = kll; subR[16] = klr;
    /* kl4 */
-   SUBL(17) = krl; SUBR(17) = krr;
+   subL[17] = krl; subR[17] = krr;
    /* rotation left shift 15+30+15+17+17 bit */
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 17);
+   ROLDQ(kll, klr, krl, krr, w0, w1, 17);
    /* k13 */
-   SUBL(18) = kll; SUBR(18) = klr;
+   subL[18] = kll; subR[18] = klr;
    /* k14 */
-   SUBL(19) = krl; SUBR(19) = krr;
+   subL[19] = krl; subR[19] = krr;
    /* rotation left shift 15+30+15+17+17+17 bit */
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 17);
+   ROLDQ(kll, klr, krl, krr, w0, w1, 17);
    /* k17 */
-   SUBL(22) = kll; SUBR(22) = klr;
+   subL[22] = kll; subR[22] = klr;
    /* k18 */
-   SUBL(23) = krl; SUBR(23) = krr;
+   subL[23] = krl; subR[23] = krr;
 
    /* generate KA */
-   kll = SUBL(0); klr = SUBR(0);
-   krl = SUBL(1); krr = SUBR(1);
+   kll = subL[0]; klr = subR[0];
+   krl = subL[1]; krr = subR[1];
    CAMELLIA_F(kll, klr,
          CAMELLIA_SIGMA1L, CAMELLIA_SIGMA1R,
          w0, w1, il, ir, t0, t1);
@@ -555,306 +666,108 @@ static void camellia_setup128(const unsigned char *key, u32 *subkey)
 
    /* generate KA dependent subkeys */
    /* k1, k2 */
-   SUBL(2) = kll; SUBR(2) = klr;
-   SUBL(3) = krl; SUBR(3) = krr;
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 15);
+   subL[2] = kll; subR[2] = klr;
+   subL[3] = krl; subR[3] = krr;
+   ROLDQ(kll, klr, krl, krr, w0, w1, 15);
    /* k5,k6 */
-   SUBL(6) = kll; SUBR(6) = klr;
-   SUBL(7) = krl; SUBR(7) = krr;
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 15);
+   subL[6] = kll; subR[6] = klr;
+   subL[7] = krl; subR[7] = krr;
+   ROLDQ(kll, klr, krl, krr, w0, w1, 15);
    /* kl1, kl2 */
-   SUBL(8) = kll; SUBR(8) = klr;
-   SUBL(9) = krl; SUBR(9) = krr;
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 15);
+   subL[8] = kll; subR[8] = klr;
+   subL[9] = krl; subR[9] = krr;
+   ROLDQ(kll, klr, krl, krr, w0, w1, 15);
    /* k9 */
-   SUBL(12) = kll; SUBR(12) = klr;
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 15);
+   subL[12] = kll; subR[12] = klr;
+   ROLDQ(kll, klr, krl, krr, w0, w1, 15);
    /* k11, k12 */
-   SUBL(14) = kll; SUBR(14) = klr;
-   SUBL(15) = krl; SUBR(15) = krr;
-   CAMELLIA_ROLDQo32(kll, klr, krl, krr, w0, w1, 34);
+   subL[14] = kll; subR[14] = klr;
+   subL[15] = krl; subR[15] = krr;
+   ROLDQo32(kll, klr, krl, krr, w0, w1, 34);
    /* k15, k16 */
-   SUBL(20) = kll; SUBR(20) = klr;
-   SUBL(21) = krl; SUBR(21) = krr;
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 17);
+   subL[20] = kll; subR[20] = klr;
+   subL[21] = krl; subR[21] = krr;
+   ROLDQ(kll, klr, krl, krr, w0, w1, 17);
    /* kw3, kw4 */
-   SUBL(24) = kll; SUBR(24) = klr;
-   SUBL(25) = krl; SUBR(25) = krr;
+   subL[24] = kll; subR[24] = klr;
+   subL[25] = krl; subR[25] = krr;
 
-
-   /* absorb kw2 to other subkeys */
-   /* round 2 */
-   SUBL(3) ^= SUBL(1); SUBR(3) ^= SUBR(1);
-   /* round 4 */
-   SUBL(5) ^= SUBL(1); SUBR(5) ^= SUBR(1);
-   /* round 6 */
-   SUBL(7) ^= SUBL(1); SUBR(7) ^= SUBR(1);
-   SUBL(1) ^= SUBR(1) & ~SUBR(9);
-   dw = SUBL(1) & SUBL(9),
-      SUBR(1) ^= CAMELLIA_RL1(dw); /* modified for FLinv(kl2) */
-   /* round 8 */
-   SUBL(11) ^= SUBL(1); SUBR(11) ^= SUBR(1);
-   /* round 10 */
-   SUBL(13) ^= SUBL(1); SUBR(13) ^= SUBR(1);
-   /* round 12 */
-   SUBL(15) ^= SUBL(1); SUBR(15) ^= SUBR(1);
-   SUBL(1) ^= SUBR(1) & ~SUBR(17);
-   dw = SUBL(1) & SUBL(17),
-      SUBR(1) ^= CAMELLIA_RL1(dw); /* modified for FLinv(kl4) */
-   /* round 14 */
-   SUBL(19) ^= SUBL(1); SUBR(19) ^= SUBR(1);
-   /* round 16 */
-   SUBL(21) ^= SUBL(1); SUBR(21) ^= SUBR(1);
-   /* round 18 */
-   SUBL(23) ^= SUBL(1); SUBR(23) ^= SUBR(1);
-   /* kw3 */
-   SUBL(24) ^= SUBL(1); SUBR(24) ^= SUBR(1);
-
-   /* absorb kw4 to other subkeys */
-   kw4l = SUBL(25); kw4r = SUBR(25);
-   /* round 17 */
-   SUBL(22) ^= kw4l; SUBR(22) ^= kw4r;
-   /* round 15 */
-   SUBL(20) ^= kw4l; SUBR(20) ^= kw4r;
-   /* round 13 */
-   SUBL(18) ^= kw4l; SUBR(18) ^= kw4r;
-   kw4l ^= kw4r & ~SUBR(16);
-   dw = kw4l & SUBL(16),
-      kw4r ^= CAMELLIA_RL1(dw); /* modified for FL(kl3) */
-   /* round 11 */
-   SUBL(14) ^= kw4l; SUBR(14) ^= kw4r;
-   /* round 9 */
-   SUBL(12) ^= kw4l; SUBR(12) ^= kw4r;
-   /* round 7 */
-   SUBL(10) ^= kw4l; SUBR(10) ^= kw4r;
-   kw4l ^= kw4r & ~SUBR(8);
-   dw = kw4l & SUBL(8),
-      kw4r ^= CAMELLIA_RL1(dw); /* modified for FL(kl1) */
-   /* round 5 */
-   SUBL(6) ^= kw4l; SUBR(6) ^= kw4r;
-   /* round 3 */
-   SUBL(4) ^= kw4l; SUBR(4) ^= kw4r;
-   /* round 1 */
-   SUBL(2) ^= kw4l; SUBR(2) ^= kw4r;
-   /* kw1 */
-   SUBL(0) ^= kw4l; SUBR(0) ^= kw4r;
-
-
-   /* key XOR is end of F-function */
-   CAMELLIA_SUBKEY_L(0) = SUBL(0) ^ SUBL(2);/* kw1 */
-   CAMELLIA_SUBKEY_R(0) = SUBR(0) ^ SUBR(2);
-   CAMELLIA_SUBKEY_L(2) = SUBL(3);       /* round 1 */
-   CAMELLIA_SUBKEY_R(2) = SUBR(3);
-   CAMELLIA_SUBKEY_L(3) = SUBL(2) ^ SUBL(4); /* round 2 */
-   CAMELLIA_SUBKEY_R(3) = SUBR(2) ^ SUBR(4);
-   CAMELLIA_SUBKEY_L(4) = SUBL(3) ^ SUBL(5); /* round 3 */
-   CAMELLIA_SUBKEY_R(4) = SUBR(3) ^ SUBR(5);
-   CAMELLIA_SUBKEY_L(5) = SUBL(4) ^ SUBL(6); /* round 4 */
-   CAMELLIA_SUBKEY_R(5) = SUBR(4) ^ SUBR(6);
-   CAMELLIA_SUBKEY_L(6) = SUBL(5) ^ SUBL(7); /* round 5 */
-   CAMELLIA_SUBKEY_R(6) = SUBR(5) ^ SUBR(7);
-   tl = SUBL(10) ^ (SUBR(10) & ~SUBR(8));
-   dw = tl & SUBL(8),  /* FL(kl1) */
-      tr = SUBR(10) ^ CAMELLIA_RL1(dw);
-   CAMELLIA_SUBKEY_L(7) = SUBL(6) ^ tl; /* round 6 */
-   CAMELLIA_SUBKEY_R(7) = SUBR(6) ^ tr;
-   CAMELLIA_SUBKEY_L(8) = SUBL(8);       /* FL(kl1) */
-   CAMELLIA_SUBKEY_R(8) = SUBR(8);
-   CAMELLIA_SUBKEY_L(9) = SUBL(9);       /* FLinv(kl2) */
-   CAMELLIA_SUBKEY_R(9) = SUBR(9);
-   tl = SUBL(7) ^ (SUBR(7) & ~SUBR(9));
-   dw = tl & SUBL(9),  /* FLinv(kl2) */
-      tr = SUBR(7) ^ CAMELLIA_RL1(dw);
-   CAMELLIA_SUBKEY_L(10) = tl ^ SUBL(11); /* round 7 */
-   CAMELLIA_SUBKEY_R(10) = tr ^ SUBR(11);
-   CAMELLIA_SUBKEY_L(11) = SUBL(10) ^ SUBL(12); /* round 8 */
-   CAMELLIA_SUBKEY_R(11) = SUBR(10) ^ SUBR(12);
-   CAMELLIA_SUBKEY_L(12) = SUBL(11) ^ SUBL(13); /* round 9 */
-   CAMELLIA_SUBKEY_R(12) = SUBR(11) ^ SUBR(13);
-   CAMELLIA_SUBKEY_L(13) = SUBL(12) ^ SUBL(14); /* round 10 */
-   CAMELLIA_SUBKEY_R(13) = SUBR(12) ^ SUBR(14);
-   CAMELLIA_SUBKEY_L(14) = SUBL(13) ^ SUBL(15); /* round 11 */
-   CAMELLIA_SUBKEY_R(14) = SUBR(13) ^ SUBR(15);
-   tl = SUBL(18) ^ (SUBR(18) & ~SUBR(16));
-   dw = tl & SUBL(16), /* FL(kl3) */
-      tr = SUBR(18) ^ CAMELLIA_RL1(dw);
-   CAMELLIA_SUBKEY_L(15) = SUBL(14) ^ tl; /* round 12 */
-   CAMELLIA_SUBKEY_R(15) = SUBR(14) ^ tr;
-   CAMELLIA_SUBKEY_L(16) = SUBL(16);     /* FL(kl3) */
-   CAMELLIA_SUBKEY_R(16) = SUBR(16);
-   CAMELLIA_SUBKEY_L(17) = SUBL(17);     /* FLinv(kl4) */
-   CAMELLIA_SUBKEY_R(17) = SUBR(17);
-   tl = SUBL(15) ^ (SUBR(15) & ~SUBR(17));
-   dw = tl & SUBL(17), /* FLinv(kl4) */
-      tr = SUBR(15) ^ CAMELLIA_RL1(dw);
-   CAMELLIA_SUBKEY_L(18) = tl ^ SUBL(19); /* round 13 */
-   CAMELLIA_SUBKEY_R(18) = tr ^ SUBR(19);
-   CAMELLIA_SUBKEY_L(19) = SUBL(18) ^ SUBL(20); /* round 14 */
-   CAMELLIA_SUBKEY_R(19) = SUBR(18) ^ SUBR(20);
-   CAMELLIA_SUBKEY_L(20) = SUBL(19) ^ SUBL(21); /* round 15 */
-   CAMELLIA_SUBKEY_R(20) = SUBR(19) ^ SUBR(21);
-   CAMELLIA_SUBKEY_L(21) = SUBL(20) ^ SUBL(22); /* round 16 */
-   CAMELLIA_SUBKEY_R(21) = SUBR(20) ^ SUBR(22);
-   CAMELLIA_SUBKEY_L(22) = SUBL(21) ^ SUBL(23); /* round 17 */
-   CAMELLIA_SUBKEY_R(22) = SUBR(21) ^ SUBR(23);
-   CAMELLIA_SUBKEY_L(23) = SUBL(22);     /* round 18 */
-   CAMELLIA_SUBKEY_R(23) = SUBR(22);
-   CAMELLIA_SUBKEY_L(24) = SUBL(24) ^ SUBL(23); /* kw3 */
-   CAMELLIA_SUBKEY_R(24) = SUBR(24) ^ SUBR(23);
-
-   /* apply the inverse of the last half of P-function */
-   dw = CAMELLIA_SUBKEY_L(2) ^ CAMELLIA_SUBKEY_R(2),
-      dw = CAMELLIA_RL8(dw);/* round 1 */
-   CAMELLIA_SUBKEY_R(2) = CAMELLIA_SUBKEY_L(2) ^ dw,
-      CAMELLIA_SUBKEY_L(2) = dw;
-   dw = CAMELLIA_SUBKEY_L(3) ^ CAMELLIA_SUBKEY_R(3),
-      dw = CAMELLIA_RL8(dw);/* round 2 */
-   CAMELLIA_SUBKEY_R(3) = CAMELLIA_SUBKEY_L(3) ^ dw,
-      CAMELLIA_SUBKEY_L(3) = dw;
-   dw = CAMELLIA_SUBKEY_L(4) ^ CAMELLIA_SUBKEY_R(4),
-      dw = CAMELLIA_RL8(dw);/* round 3 */
-   CAMELLIA_SUBKEY_R(4) = CAMELLIA_SUBKEY_L(4) ^ dw,
-      CAMELLIA_SUBKEY_L(4) = dw;
-   dw = CAMELLIA_SUBKEY_L(5) ^ CAMELLIA_SUBKEY_R(5),
-      dw = CAMELLIA_RL8(dw);/* round 4 */
-   CAMELLIA_SUBKEY_R(5) = CAMELLIA_SUBKEY_L(5) ^ dw,
-      CAMELLIA_SUBKEY_L(5) = dw;
-   dw = CAMELLIA_SUBKEY_L(6) ^ CAMELLIA_SUBKEY_R(6),
-      dw = CAMELLIA_RL8(dw);/* round 5 */
-   CAMELLIA_SUBKEY_R(6) = CAMELLIA_SUBKEY_L(6) ^ dw,
-      CAMELLIA_SUBKEY_L(6) = dw;
-   dw = CAMELLIA_SUBKEY_L(7) ^ CAMELLIA_SUBKEY_R(7),
-      dw = CAMELLIA_RL8(dw);/* round 6 */
-   CAMELLIA_SUBKEY_R(7) = CAMELLIA_SUBKEY_L(7) ^ dw,
-      CAMELLIA_SUBKEY_L(7) = dw;
-   dw = CAMELLIA_SUBKEY_L(10) ^ CAMELLIA_SUBKEY_R(10),
-      dw = CAMELLIA_RL8(dw);/* round 7 */
-   CAMELLIA_SUBKEY_R(10) = CAMELLIA_SUBKEY_L(10) ^ dw,
-      CAMELLIA_SUBKEY_L(10) = dw;
-   dw = CAMELLIA_SUBKEY_L(11) ^ CAMELLIA_SUBKEY_R(11),
-      dw = CAMELLIA_RL8(dw);/* round 8 */
-   CAMELLIA_SUBKEY_R(11) = CAMELLIA_SUBKEY_L(11) ^ dw,
-      CAMELLIA_SUBKEY_L(11) = dw;
-   dw = CAMELLIA_SUBKEY_L(12) ^ CAMELLIA_SUBKEY_R(12),
-      dw = CAMELLIA_RL8(dw);/* round 9 */
-   CAMELLIA_SUBKEY_R(12) = CAMELLIA_SUBKEY_L(12) ^ dw,
-      CAMELLIA_SUBKEY_L(12) = dw;
-   dw = CAMELLIA_SUBKEY_L(13) ^ CAMELLIA_SUBKEY_R(13),
-      dw = CAMELLIA_RL8(dw);/* round 10 */
-   CAMELLIA_SUBKEY_R(13) = CAMELLIA_SUBKEY_L(13) ^ dw,
-      CAMELLIA_SUBKEY_L(13) = dw;
-   dw = CAMELLIA_SUBKEY_L(14) ^ CAMELLIA_SUBKEY_R(14),
-      dw = CAMELLIA_RL8(dw);/* round 11 */
-   CAMELLIA_SUBKEY_R(14) = CAMELLIA_SUBKEY_L(14) ^ dw,
-      CAMELLIA_SUBKEY_L(14) = dw;
-   dw = CAMELLIA_SUBKEY_L(15) ^ CAMELLIA_SUBKEY_R(15),
-      dw = CAMELLIA_RL8(dw);/* round 12 */
-   CAMELLIA_SUBKEY_R(15) = CAMELLIA_SUBKEY_L(15) ^ dw,
-      CAMELLIA_SUBKEY_L(15) = dw;
-   dw = CAMELLIA_SUBKEY_L(18) ^ CAMELLIA_SUBKEY_R(18),
-      dw = CAMELLIA_RL8(dw);/* round 13 */
-   CAMELLIA_SUBKEY_R(18) = CAMELLIA_SUBKEY_L(18) ^ dw,
-      CAMELLIA_SUBKEY_L(18) = dw;
-   dw = CAMELLIA_SUBKEY_L(19) ^ CAMELLIA_SUBKEY_R(19),
-      dw = CAMELLIA_RL8(dw);/* round 14 */
-   CAMELLIA_SUBKEY_R(19) = CAMELLIA_SUBKEY_L(19) ^ dw,
-      CAMELLIA_SUBKEY_L(19) = dw;
-   dw = CAMELLIA_SUBKEY_L(20) ^ CAMELLIA_SUBKEY_R(20),
-      dw = CAMELLIA_RL8(dw);/* round 15 */
-   CAMELLIA_SUBKEY_R(20) = CAMELLIA_SUBKEY_L(20) ^ dw,
-      CAMELLIA_SUBKEY_L(20) = dw;
-   dw = CAMELLIA_SUBKEY_L(21) ^ CAMELLIA_SUBKEY_R(21),
-      dw = CAMELLIA_RL8(dw);/* round 16 */
-   CAMELLIA_SUBKEY_R(21) = CAMELLIA_SUBKEY_L(21) ^ dw,
-      CAMELLIA_SUBKEY_L(21) = dw;
-   dw = CAMELLIA_SUBKEY_L(22) ^ CAMELLIA_SUBKEY_R(22),
-      dw = CAMELLIA_RL8(dw);/* round 17 */
-   CAMELLIA_SUBKEY_R(22) = CAMELLIA_SUBKEY_L(22) ^ dw,
-      CAMELLIA_SUBKEY_L(22) = dw;
-   dw = CAMELLIA_SUBKEY_L(23) ^ CAMELLIA_SUBKEY_R(23),
-      dw = CAMELLIA_RL8(dw);/* round 18 */
-   CAMELLIA_SUBKEY_R(23) = CAMELLIA_SUBKEY_L(23) ^ dw,
-      CAMELLIA_SUBKEY_L(23) = dw;
-
-   return;
+   camellia_setup_tail(subkey, subL, subR, 24);
 }
 
-
 static void camellia_setup256(const unsigned char *key, u32 *subkey)
 {
-   u32 kll,klr,krl,krr;           /* left half of key */
-   u32 krll,krlr,krrl,krrr;       /* right half of key */
+   u32 kll, klr, krl, krr;        /* left half of key */
+   u32 krll, krlr, krrl, krrr;    /* right half of key */
    u32 il, ir, t0, t1, w0, w1;    /* temporary variables */
-   u32 kw4l, kw4r, dw, tl, tr;
    u32 subL[34];
    u32 subR[34];
 
    /**
     *  key = (kll || klr || krl || krr || krll || krlr || krrl || krrr)
-    *  (|| is concatination)
+    *  (|| is concatenation)
     */
-
-   kll  = GETU32(key     );
-   klr  = GETU32(key +  4);
-   krl  = GETU32(key +  8);
-   krr  = GETU32(key + 12);
-   krll = GETU32(key + 16);
-   krlr = GETU32(key + 20);
-   krrl = GETU32(key + 24);
-   krrr = GETU32(key + 28);
+   GETU32(kll,  key     );
+   GETU32(klr,  key +  4);
+   GETU32(krl,  key +  8);
+   GETU32(krr,  key + 12);
+   GETU32(krll, key + 16);
+   GETU32(krlr, key + 20);
+   GETU32(krrl, key + 24);
+   GETU32(krrr, key + 28);
 
    /* generate KL dependent subkeys */
    /* kw1 */
-   SUBL(0) = kll; SUBR(0) = klr;
+   subL[0] = kll; subR[0] = klr;
    /* kw2 */
-   SUBL(1) = krl; SUBR(1) = krr;
-   CAMELLIA_ROLDQo32(kll, klr, krl, krr, w0, w1, 45);
+   subL[1] = krl; subR[1] = krr;
+   ROLDQo32(kll, klr, krl, krr, w0, w1, 45);
    /* k9 */
-   SUBL(12) = kll; SUBR(12) = klr;
+   subL[12] = kll; subR[12] = klr;
    /* k10 */
-   SUBL(13) = krl; SUBR(13) = krr;
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 15);
+   subL[13] = krl; subR[13] = krr;
+   ROLDQ(kll, klr, krl, krr, w0, w1, 15);
    /* kl3 */
-   SUBL(16) = kll; SUBR(16) = klr;
+   subL[16] = kll; subR[16] = klr;
    /* kl4 */
-   SUBL(17) = krl; SUBR(17) = krr;
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 17);
+   subL[17] = krl; subR[17] = krr;
+   ROLDQ(kll, klr, krl, krr, w0, w1, 17);
    /* k17 */
-   SUBL(22) = kll; SUBR(22) = klr;
+   subL[22] = kll; subR[22] = klr;
    /* k18 */
-   SUBL(23) = krl; SUBR(23) = krr;
-   CAMELLIA_ROLDQo32(kll, klr, krl, krr, w0, w1, 34);
+   subL[23] = krl; subR[23] = krr;
+   ROLDQo32(kll, klr, krl, krr, w0, w1, 34);
    /* k23 */
-   SUBL(30) = kll; SUBR(30) = klr;
+   subL[30] = kll; subR[30] = klr;
    /* k24 */
-   SUBL(31) = krl; SUBR(31) = krr;
+   subL[31] = krl; subR[31] = krr;
 
    /* generate KR dependent subkeys */
-   CAMELLIA_ROLDQ(krll, krlr, krrl, krrr, w0, w1, 15);
+   ROLDQ(krll, krlr, krrl, krrr, w0, w1, 15);
    /* k3 */
-   SUBL(4) = krll; SUBR(4) = krlr;
+   subL[4] = krll; subR[4] = krlr;
    /* k4 */
-   SUBL(5) = krrl; SUBR(5) = krrr;
-   CAMELLIA_ROLDQ(krll, krlr, krrl, krrr, w0, w1, 15);
+   subL[5] = krrl; subR[5] = krrr;
+   ROLDQ(krll, krlr, krrl, krrr, w0, w1, 15);
    /* kl1 */
-   SUBL(8) = krll; SUBR(8) = krlr;
+   subL[8] = krll; subR[8] = krlr;
    /* kl2 */
-   SUBL(9) = krrl; SUBR(9) = krrr;
-   CAMELLIA_ROLDQ(krll, krlr, krrl, krrr, w0, w1, 30);
+   subL[9] = krrl; subR[9] = krrr;
+   ROLDQ(krll, krlr, krrl, krrr, w0, w1, 30);
    /* k13 */
-   SUBL(18) = krll; SUBR(18) = krlr;
+   subL[18] = krll; subR[18] = krlr;
    /* k14 */
-   SUBL(19) = krrl; SUBR(19) = krrr;
-   CAMELLIA_ROLDQo32(krll, krlr, krrl, krrr, w0, w1, 34);
+   subL[19] = krrl; subR[19] = krrr;
+   ROLDQo32(krll, krlr, krrl, krrr, w0, w1, 34);
    /* k19 */
-   SUBL(26) = krll; SUBR(26) = krlr;
+   subL[26] = krll; subR[26] = krlr;
    /* k20 */
-   SUBL(27) = krrl; SUBR(27) = krrr;
-   CAMELLIA_ROLDQo32(krll, krlr, krrl, krrr, w0, w1, 34);
+   subL[27] = krrl; subR[27] = krrr;
+   ROLDQo32(krll, krlr, krrl, krrr, w0, w1, 34);
 
    /* generate KA */
-   kll = SUBL(0) ^ krll; klr = SUBR(0) ^ krlr;
-   krl = SUBL(1) ^ krrl; krr = SUBR(1) ^ krrr;
+   kll = subL[0] ^ krll; klr = subR[0] ^ krlr;
+   krl = subL[1] ^ krrl; krr = subR[1] ^ krrr;
    CAMELLIA_F(kll, klr,
          CAMELLIA_SIGMA1L, CAMELLIA_SIGMA1R,
          w0, w1, il, ir, t0, t1);
@@ -885,310 +798,50 @@ static void camellia_setup256(const unsigned char *key, u32 *subkey)
    krll ^= w0; krlr ^= w1;
 
    /* generate KA dependent subkeys */
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 15);
+   ROLDQ(kll, klr, krl, krr, w0, w1, 15);
    /* k5 */
-   SUBL(6) = kll; SUBR(6) = klr;
+   subL[6] = kll; subR[6] = klr;
    /* k6 */
-   SUBL(7) = krl; SUBR(7) = krr;
-   CAMELLIA_ROLDQ(kll, klr, krl, krr, w0, w1, 30);
+   subL[7] = krl; subR[7] = krr;
+   ROLDQ(kll, klr, krl, krr, w0, w1, 30);
    /* k11 */
-   SUBL(14) = kll; SUBR(14) = klr;
+   subL[14] = kll; subR[14] = klr;
    /* k12 */
-   SUBL(15) = krl; SUBR(15) = krr;
+   subL[15] = krl; subR[15] = krr;
    /* rotation left shift 32bit */
    /* kl5 */
-   SUBL(24) = klr; SUBR(24) = krl;
+   subL[24] = klr; subR[24] = krl;
    /* kl6 */
-   SUBL(25) = krr; SUBR(25) = kll;
+   subL[25] = krr; subR[25] = kll;
    /* rotation left shift 49 from k11,k12 -> k21,k22 */
-   CAMELLIA_ROLDQo32(kll, klr, krl, krr, w0, w1, 49);
+   ROLDQo32(kll, klr, krl, krr, w0, w1, 49);
    /* k21 */
-   SUBL(28) = kll; SUBR(28) = klr;
+   subL[28] = kll; subR[28] = klr;
    /* k22 */
-   SUBL(29) = krl; SUBR(29) = krr;
+   subL[29] = krl; subR[29] = krr;
 
    /* generate KB dependent subkeys */
    /* k1 */
-   SUBL(2) = krll; SUBR(2) = krlr;
+   subL[2] = krll; subR[2] = krlr;
    /* k2 */
-   SUBL(3) = krrl; SUBR(3) = krrr;
-   CAMELLIA_ROLDQ(krll, krlr, krrl, krrr, w0, w1, 30);
+   subL[3] = krrl; subR[3] = krrr;
+   ROLDQ(krll, krlr, krrl, krrr, w0, w1, 30);
    /* k7 */
-   SUBL(10) = krll; SUBR(10) = krlr;
+   subL[10] = krll; subR[10] = krlr;
    /* k8 */
-   SUBL(11) = krrl; SUBR(11) = krrr;
-   CAMELLIA_ROLDQ(krll, krlr, krrl, krrr, w0, w1, 30);
+   subL[11] = krrl; subR[11] = krrr;
+   ROLDQ(krll, krlr, krrl, krrr, w0, w1, 30);
    /* k15 */
-   SUBL(20) = krll; SUBR(20) = krlr;
+   subL[20] = krll; subR[20] = krlr;
    /* k16 */
-   SUBL(21) = krrl; SUBR(21) = krrr;
-   CAMELLIA_ROLDQo32(krll, krlr, krrl, krrr, w0, w1, 51);
+   subL[21] = krrl; subR[21] = krrr;
+   ROLDQo32(krll, krlr, krrl, krrr, w0, w1, 51);
    /* kw3 */
-   SUBL(32) = krll; SUBR(32) = krlr;
+   subL[32] = krll; subR[32] = krlr;
    /* kw4 */
-   SUBL(33) = krrl; SUBR(33) = krrr;
-
-   /* absorb kw2 to other subkeys */
-   /* round 2 */
-   SUBL(3) ^= SUBL(1); SUBR(3) ^= SUBR(1);
-   /* round 4 */
-   SUBL(5) ^= SUBL(1); SUBR(5) ^= SUBR(1);
-   /* round 6 */
-   SUBL(7) ^= SUBL(1); SUBR(7) ^= SUBR(1);
-   SUBL(1) ^= SUBR(1) & ~SUBR(9);
-   dw = SUBL(1) & SUBL(9),
-      SUBR(1) ^= CAMELLIA_RL1(dw); /* modified for FLinv(kl2) */
-   /* round 8 */
-   SUBL(11) ^= SUBL(1); SUBR(11) ^= SUBR(1);
-   /* round 10 */
-   SUBL(13) ^= SUBL(1); SUBR(13) ^= SUBR(1);
-   /* round 12 */
-   SUBL(15) ^= SUBL(1); SUBR(15) ^= SUBR(1);
-   SUBL(1) ^= SUBR(1) & ~SUBR(17);
-   dw = SUBL(1) & SUBL(17),
-      SUBR(1) ^= CAMELLIA_RL1(dw); /* modified for FLinv(kl4) */
-   /* round 14 */
-   SUBL(19) ^= SUBL(1); SUBR(19) ^= SUBR(1);
-   /* round 16 */
-   SUBL(21) ^= SUBL(1); SUBR(21) ^= SUBR(1);
-   /* round 18 */
-   SUBL(23) ^= SUBL(1); SUBR(23) ^= SUBR(1);
-   SUBL(1) ^= SUBR(1) & ~SUBR(25);
-   dw = SUBL(1) & SUBL(25),
-      SUBR(1) ^= CAMELLIA_RL1(dw); /* modified for FLinv(kl6) */
-   /* round 20 */
-   SUBL(27) ^= SUBL(1); SUBR(27) ^= SUBR(1);
-   /* round 22 */
-   SUBL(29) ^= SUBL(1); SUBR(29) ^= SUBR(1);
-   /* round 24 */
-   SUBL(31) ^= SUBL(1); SUBR(31) ^= SUBR(1);
-   /* kw3 */
-   SUBL(32) ^= SUBL(1); SUBR(32) ^= SUBR(1);
-
-
-   /* absorb kw4 to other subkeys */
-   kw4l = SUBL(33); kw4r = SUBR(33);
-   /* round 23 */
-   SUBL(30) ^= kw4l; SUBR(30) ^= kw4r;
-   /* round 21 */
-   SUBL(28) ^= kw4l; SUBR(28) ^= kw4r;
-   /* round 19 */
-   SUBL(26) ^= kw4l; SUBR(26) ^= kw4r;
-   kw4l ^= kw4r & ~SUBR(24);
-   dw = kw4l & SUBL(24),
-      kw4r ^= CAMELLIA_RL1(dw); /* modified for FL(kl5) */
-   /* round 17 */
-   SUBL(22) ^= kw4l; SUBR(22) ^= kw4r;
-   /* round 15 */
-   SUBL(20) ^= kw4l; SUBR(20) ^= kw4r;
-   /* round 13 */
-   SUBL(18) ^= kw4l; SUBR(18) ^= kw4r;
-   kw4l ^= kw4r & ~SUBR(16);
-   dw = kw4l & SUBL(16),
-      kw4r ^= CAMELLIA_RL1(dw); /* modified for FL(kl3) */
-   /* round 11 */
-   SUBL(14) ^= kw4l; SUBR(14) ^= kw4r;
-   /* round 9 */
-   SUBL(12) ^= kw4l; SUBR(12) ^= kw4r;
-   /* round 7 */
-   SUBL(10) ^= kw4l; SUBR(10) ^= kw4r;
-   kw4l ^= kw4r & ~SUBR(8);
-   dw = kw4l & SUBL(8),
-      kw4r ^= CAMELLIA_RL1(dw); /* modified for FL(kl1) */
-   /* round 5 */
-   SUBL(6) ^= kw4l; SUBR(6) ^= kw4r;
-   /* round 3 */
-   SUBL(4) ^= kw4l; SUBR(4) ^= kw4r;
-   /* round 1 */
-   SUBL(2) ^= kw4l; SUBR(2) ^= kw4r;
-   /* kw1 */
-   SUBL(0) ^= kw4l; SUBR(0) ^= kw4r;
+   subL[33] = krrl; subR[33] = krrr;
 
-   /* key XOR is end of F-function */
-   CAMELLIA_SUBKEY_L(0) = SUBL(0) ^ SUBL(2);/* kw1 */
-   CAMELLIA_SUBKEY_R(0) = SUBR(0) ^ SUBR(2);
-   CAMELLIA_SUBKEY_L(2) = SUBL(3);       /* round 1 */
-   CAMELLIA_SUBKEY_R(2) = SUBR(3);
-   CAMELLIA_SUBKEY_L(3) = SUBL(2) ^ SUBL(4); /* round 2 */
-   CAMELLIA_SUBKEY_R(3) = SUBR(2) ^ SUBR(4);
-   CAMELLIA_SUBKEY_L(4) = SUBL(3) ^ SUBL(5); /* round 3 */
-   CAMELLIA_SUBKEY_R(4) = SUBR(3) ^ SUBR(5);
-   CAMELLIA_SUBKEY_L(5) = SUBL(4) ^ SUBL(6); /* round 4 */
-   CAMELLIA_SUBKEY_R(5) = SUBR(4) ^ SUBR(6);
-   CAMELLIA_SUBKEY_L(6) = SUBL(5) ^ SUBL(7); /* round 5 */
-   CAMELLIA_SUBKEY_R(6) = SUBR(5) ^ SUBR(7);
-   tl = SUBL(10) ^ (SUBR(10) & ~SUBR(8));
-   dw = tl & SUBL(8),  /* FL(kl1) */
-      tr = SUBR(10) ^ CAMELLIA_RL1(dw);
-   CAMELLIA_SUBKEY_L(7) = SUBL(6) ^ tl; /* round 6 */
-   CAMELLIA_SUBKEY_R(7) = SUBR(6) ^ tr;
-   CAMELLIA_SUBKEY_L(8) = SUBL(8);       /* FL(kl1) */
-   CAMELLIA_SUBKEY_R(8) = SUBR(8);
-   CAMELLIA_SUBKEY_L(9) = SUBL(9);       /* FLinv(kl2) */
-   CAMELLIA_SUBKEY_R(9) = SUBR(9);
-   tl = SUBL(7) ^ (SUBR(7) & ~SUBR(9));
-   dw = tl & SUBL(9),  /* FLinv(kl2) */
-      tr = SUBR(7) ^ CAMELLIA_RL1(dw);
-   CAMELLIA_SUBKEY_L(10) = tl ^ SUBL(11); /* round 7 */
-   CAMELLIA_SUBKEY_R(10) = tr ^ SUBR(11);
-   CAMELLIA_SUBKEY_L(11) = SUBL(10) ^ SUBL(12); /* round 8 */
-   CAMELLIA_SUBKEY_R(11) = SUBR(10) ^ SUBR(12);
-   CAMELLIA_SUBKEY_L(12) = SUBL(11) ^ SUBL(13); /* round 9 */
-   CAMELLIA_SUBKEY_R(12) = SUBR(11) ^ SUBR(13);
-   CAMELLIA_SUBKEY_L(13) = SUBL(12) ^ SUBL(14); /* round 10 */
-   CAMELLIA_SUBKEY_R(13) = SUBR(12) ^ SUBR(14);
-   CAMELLIA_SUBKEY_L(14) = SUBL(13) ^ SUBL(15); /* round 11 */
-   CAMELLIA_SUBKEY_R(14) = SUBR(13) ^ SUBR(15);
-   tl = SUBL(18) ^ (SUBR(18) & ~SUBR(16));
-   dw = tl & SUBL(16), /* FL(kl3) */
-      tr = SUBR(18) ^ CAMELLIA_RL1(dw);
-   CAMELLIA_SUBKEY_L(15) = SUBL(14) ^ tl; /* round 12 */
-   CAMELLIA_SUBKEY_R(15) = SUBR(14) ^ tr;
-   CAMELLIA_SUBKEY_L(16) = SUBL(16);     /* FL(kl3) */
-   CAMELLIA_SUBKEY_R(16) = SUBR(16);
-   CAMELLIA_SUBKEY_L(17) = SUBL(17);     /* FLinv(kl4) */
-   CAMELLIA_SUBKEY_R(17) = SUBR(17);
-   tl = SUBL(15) ^ (SUBR(15) & ~SUBR(17));
-   dw = tl & SUBL(17), /* FLinv(kl4) */
-      tr = SUBR(15) ^ CAMELLIA_RL1(dw);
-   CAMELLIA_SUBKEY_L(18) = tl ^ SUBL(19); /* round 13 */
-   CAMELLIA_SUBKEY_R(18) = tr ^ SUBR(19);
-   CAMELLIA_SUBKEY_L(19) = SUBL(18) ^ SUBL(20); /* round 14 */
-   CAMELLIA_SUBKEY_R(19) = SUBR(18) ^ SUBR(20);
-   CAMELLIA_SUBKEY_L(20) = SUBL(19) ^ SUBL(21); /* round 15 */
-   CAMELLIA_SUBKEY_R(20) = SUBR(19) ^ SUBR(21);
-   CAMELLIA_SUBKEY_L(21) = SUBL(20) ^ SUBL(22); /* round 16 */
-   CAMELLIA_SUBKEY_R(21) = SUBR(20) ^ SUBR(22);
-   CAMELLIA_SUBKEY_L(22) = SUBL(21) ^ SUBL(23); /* round 17 */
-   CAMELLIA_SUBKEY_R(22) = SUBR(21) ^ SUBR(23);
-   tl = SUBL(26) ^ (SUBR(26)
-          & ~SUBR(24));
-   dw = tl & SUBL(24), /* FL(kl5) */
-      tr = SUBR(26) ^ CAMELLIA_RL1(dw);
-   CAMELLIA_SUBKEY_L(23) = SUBL(22) ^ tl; /* round 18 */
-   CAMELLIA_SUBKEY_R(23) = SUBR(22) ^ tr;
-   CAMELLIA_SUBKEY_L(24) = SUBL(24);     /* FL(kl5) */
-   CAMELLIA_SUBKEY_R(24) = SUBR(24);
-   CAMELLIA_SUBKEY_L(25) = SUBL(25);     /* FLinv(kl6) */
-   CAMELLIA_SUBKEY_R(25) = SUBR(25);
-   tl = SUBL(23) ^ (SUBR(23) &
-          ~SUBR(25));
-   dw = tl & SUBL(25), /* FLinv(kl6) */
-      tr = SUBR(23) ^ CAMELLIA_RL1(dw);
-   CAMELLIA_SUBKEY_L(26) = tl ^ SUBL(27); /* round 19 */
-   CAMELLIA_SUBKEY_R(26) = tr ^ SUBR(27);
-   CAMELLIA_SUBKEY_L(27) = SUBL(26) ^ SUBL(28); /* round 20 */
-   CAMELLIA_SUBKEY_R(27) = SUBR(26) ^ SUBR(28);
-   CAMELLIA_SUBKEY_L(28) = SUBL(27) ^ SUBL(29); /* round 21 */
-   CAMELLIA_SUBKEY_R(28) = SUBR(27) ^ SUBR(29);
-   CAMELLIA_SUBKEY_L(29) = SUBL(28) ^ SUBL(30); /* round 22 */
-   CAMELLIA_SUBKEY_R(29) = SUBR(28) ^ SUBR(30);
-   CAMELLIA_SUBKEY_L(30) = SUBL(29) ^ SUBL(31); /* round 23 */
-   CAMELLIA_SUBKEY_R(30) = SUBR(29) ^ SUBR(31);
-   CAMELLIA_SUBKEY_L(31) = SUBL(30);     /* round 24 */
-   CAMELLIA_SUBKEY_R(31) = SUBR(30);
-   CAMELLIA_SUBKEY_L(32) = SUBL(32) ^ SUBL(31); /* kw3 */
-   CAMELLIA_SUBKEY_R(32) = SUBR(32) ^ SUBR(31);
-
-   /* apply the inverse of the last half of P-function */
-   dw = CAMELLIA_SUBKEY_L(2) ^ CAMELLIA_SUBKEY_R(2),
-      dw = CAMELLIA_RL8(dw);/* round 1 */
-   CAMELLIA_SUBKEY_R(2) = CAMELLIA_SUBKEY_L(2) ^ dw,
-      CAMELLIA_SUBKEY_L(2) = dw;
-   dw = CAMELLIA_SUBKEY_L(3) ^ CAMELLIA_SUBKEY_R(3),
-      dw = CAMELLIA_RL8(dw);/* round 2 */
-   CAMELLIA_SUBKEY_R(3) = CAMELLIA_SUBKEY_L(3) ^ dw,
-      CAMELLIA_SUBKEY_L(3) = dw;
-   dw = CAMELLIA_SUBKEY_L(4) ^ CAMELLIA_SUBKEY_R(4),
-      dw = CAMELLIA_RL8(dw);/* round 3 */
-   CAMELLIA_SUBKEY_R(4) = CAMELLIA_SUBKEY_L(4) ^ dw,
-      CAMELLIA_SUBKEY_L(4) = dw;
-   dw = CAMELLIA_SUBKEY_L(5) ^ CAMELLIA_SUBKEY_R(5),
-      dw = CAMELLIA_RL8(dw);/* round 4 */
-   CAMELLIA_SUBKEY_R(5) = CAMELLIA_SUBKEY_L(5) ^ dw,
-   CAMELLIA_SUBKEY_L(5) = dw;
-   dw = CAMELLIA_SUBKEY_L(6) ^ CAMELLIA_SUBKEY_R(6),
-      dw = CAMELLIA_RL8(dw);/* round 5 */
-   CAMELLIA_SUBKEY_R(6) = CAMELLIA_SUBKEY_L(6) ^ dw,
-      CAMELLIA_SUBKEY_L(6) = dw;
-   dw = CAMELLIA_SUBKEY_L(7) ^ CAMELLIA_SUBKEY_R(7),
-      dw = CAMELLIA_RL8(dw);/* round 6 */
-   CAMELLIA_SUBKEY_R(7) = CAMELLIA_SUBKEY_L(7) ^ dw,
-      CAMELLIA_SUBKEY_L(7) = dw;
-   dw = CAMELLIA_SUBKEY_L(10) ^ CAMELLIA_SUBKEY_R(10),
-      dw = CAMELLIA_RL8(dw);/* round 7 */
-   CAMELLIA_SUBKEY_R(10) = CAMELLIA_SUBKEY_L(10) ^ dw,
-      CAMELLIA_SUBKEY_L(10) = dw;
-   dw = CAMELLIA_SUBKEY_L(11) ^ CAMELLIA_SUBKEY_R(11),
-       dw = CAMELLIA_RL8(dw);/* round 8 */
-   CAMELLIA_SUBKEY_R(11) = CAMELLIA_SUBKEY_L(11) ^ dw,
-      CAMELLIA_SUBKEY_L(11) = dw;
-   dw = CAMELLIA_SUBKEY_L(12) ^ CAMELLIA_SUBKEY_R(12),
-      dw = CAMELLIA_RL8(dw);/* round 9 */
-   CAMELLIA_SUBKEY_R(12) = CAMELLIA_SUBKEY_L(12) ^ dw,
-      CAMELLIA_SUBKEY_L(12) = dw;
-   dw = CAMELLIA_SUBKEY_L(13) ^ CAMELLIA_SUBKEY_R(13),
-      dw = CAMELLIA_RL8(dw);/* round 10 */
-   CAMELLIA_SUBKEY_R(13) = CAMELLIA_SUBKEY_L(13) ^ dw,
-      CAMELLIA_SUBKEY_L(13) = dw;
-   dw = CAMELLIA_SUBKEY_L(14) ^ CAMELLIA_SUBKEY_R(14),
-      dw = CAMELLIA_RL8(dw);/* round 11 */
-   CAMELLIA_SUBKEY_R(14) = CAMELLIA_SUBKEY_L(14) ^ dw,
-      CAMELLIA_SUBKEY_L(14) = dw;
-   dw = CAMELLIA_SUBKEY_L(15) ^ CAMELLIA_SUBKEY_R(15),
-      dw = CAMELLIA_RL8(dw);/* round 12 */
-   CAMELLIA_SUBKEY_R(15) = CAMELLIA_SUBKEY_L(15) ^ dw,
-      CAMELLIA_SUBKEY_L(15) = dw;
-   dw = CAMELLIA_SUBKEY_L(18) ^ CAMELLIA_SUBKEY_R(18),
-      dw = CAMELLIA_RL8(dw);/* round 13 */
-   CAMELLIA_SUBKEY_R(18) = CAMELLIA_SUBKEY_L(18) ^ dw,
-      CAMELLIA_SUBKEY_L(18) = dw;
-   dw = CAMELLIA_SUBKEY_L(19) ^ CAMELLIA_SUBKEY_R(19),
-      dw = CAMELLIA_RL8(dw);/* round 14 */
-   CAMELLIA_SUBKEY_R(19) = CAMELLIA_SUBKEY_L(19) ^ dw,
-      CAMELLIA_SUBKEY_L(19) = dw;
-   dw = CAMELLIA_SUBKEY_L(20) ^ CAMELLIA_SUBKEY_R(20),
-      dw = CAMELLIA_RL8(dw);/* round 15 */
-   CAMELLIA_SUBKEY_R(20) = CAMELLIA_SUBKEY_L(20) ^ dw,
-      CAMELLIA_SUBKEY_L(20) = dw;
-   dw = CAMELLIA_SUBKEY_L(21) ^ CAMELLIA_SUBKEY_R(21),
-      dw = CAMELLIA_RL8(dw);/* round 16 */
-   CAMELLIA_SUBKEY_R(21) = CAMELLIA_SUBKEY_L(21) ^ dw,
-      CAMELLIA_SUBKEY_L(21) = dw;
-   dw = CAMELLIA_SUBKEY_L(22) ^ CAMELLIA_SUBKEY_R(22),
-      dw = CAMELLIA_RL8(dw);/* round 17 */
-   CAMELLIA_SUBKEY_R(22) = CAMELLIA_SUBKEY_L(22) ^ dw,
-      CAMELLIA_SUBKEY_L(22) = dw;
-   dw = CAMELLIA_SUBKEY_L(23) ^ CAMELLIA_SUBKEY_R(23),
-      dw = CAMELLIA_RL8(dw);/* round 18 */
-   CAMELLIA_SUBKEY_R(23) = CAMELLIA_SUBKEY_L(23) ^ dw,
-      CAMELLIA_SUBKEY_L(23) = dw;
-   dw = CAMELLIA_SUBKEY_L(26) ^ CAMELLIA_SUBKEY_R(26),
-      dw = CAMELLIA_RL8(dw);/* round 19 */
-   CAMELLIA_SUBKEY_R(26) = CAMELLIA_SUBKEY_L(26) ^ dw,
-      CAMELLIA_SUBKEY_L(26) = dw;
-   dw = CAMELLIA_SUBKEY_L(27) ^ CAMELLIA_SUBKEY_R(27),
-      dw = CAMELLIA_RL8(dw);/* round 20 */
-   CAMELLIA_SUBKEY_R(27) = CAMELLIA_SUBKEY_L(27) ^ dw,
-      CAMELLIA_SUBKEY_L(27) = dw;
-   dw = CAMELLIA_SUBKEY_L(28) ^ CAMELLIA_SUBKEY_R(28),
-      dw = CAMELLIA_RL8(dw);/* round 21 */
-   CAMELLIA_SUBKEY_R(28) = CAMELLIA_SUBKEY_L(28) ^ dw,
-      CAMELLIA_SUBKEY_L(28) = dw;
-   dw = CAMELLIA_SUBKEY_L(29) ^ CAMELLIA_SUBKEY_R(29),
-      dw = CAMELLIA_RL8(dw);/* round 22 */
-   CAMELLIA_SUBKEY_R(29) = CAMELLIA_SUBKEY_L(29) ^ dw,
-      CAMELLIA_SUBKEY_L(29) = dw;
-   dw = CAMELLIA_SUBKEY_L(30) ^ CAMELLIA_SUBKEY_R(30),
-      dw = CAMELLIA_RL8(dw);/* round 23 */
-   CAMELLIA_SUBKEY_R(30) = CAMELLIA_SUBKEY_L(30) ^ dw,
-      CAMELLIA_SUBKEY_L(30) = dw;
-   dw = CAMELLIA_SUBKEY_L(31) ^ CAMELLIA_SUBKEY_R(31),
-      dw = CAMELLIA_RL8(dw);/* round 24 */
-   CAMELLIA_SUBKEY_R(31) = CAMELLIA_SUBKEY_L(31) ^ dw,
-      CAMELLIA_SUBKEY_L(31) = dw;
-
-   return;
+   camellia_setup_tail(subkey, subL, subR, 32);
 }
 
 static void camellia_setup192(const unsigned char *key, u32 *subkey)
@@ -1197,482 +850,168 @@ static void camellia_setup192(const unsigned char *key, u32 *subkey)
    u32 krll, krlr, krrl,krrr;
 
    memcpy(kk, key, 24);
-   memcpy((unsigned char *)&krll, key+16,4);
-   memcpy((unsigned char *)&krlr, key+20,4);
+   memcpy((unsigned char *)&krll, key+16, 4);
+   memcpy((unsigned char *)&krlr, key+20, 4);
    krrl = ~krll;
    krrr = ~krlr;
    memcpy(kk+24, (unsigned char *)&krrl, 4);
    memcpy(kk+28, (unsigned char *)&krrr, 4);
    camellia_setup256(kk, subkey);
-   return;
 }
 
 
-/**
- * Stuff related to camellia encryption/decryption
+/*
+ * Encrypt/decrypt
  */
-static void camellia_encrypt128(const u32 *subkey, __be32 *io_text)
-{
-   u32 il,ir,t0,t1;               /* temporary valiables */
-
-   u32 io[4];
-
-   io[0] = be32_to_cpu(io_text[0]);
-   io[1] = be32_to_cpu(io_text[1]);
-   io[2] = be32_to_cpu(io_text[2]);
-   io[3] = be32_to_cpu(io_text[3]);
-
-   /* pre whitening but absorb kw2*/
-   io[0] ^= CAMELLIA_SUBKEY_L(0);
-   io[1] ^= CAMELLIA_SUBKEY_R(0);
-   /* main iteration */
-
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(2),CAMELLIA_SUBKEY_R(2),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(3),CAMELLIA_SUBKEY_R(3),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(4),CAMELLIA_SUBKEY_R(4),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(5),CAMELLIA_SUBKEY_R(5),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(6),CAMELLIA_SUBKEY_R(6),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(7),CAMELLIA_SUBKEY_R(7),
-          io[0],io[1],il,ir,t0,t1);
-
-   CAMELLIA_FLS(io[0],io[1],io[2],io[3],
-           CAMELLIA_SUBKEY_L(8),CAMELLIA_SUBKEY_R(8),
-           CAMELLIA_SUBKEY_L(9),CAMELLIA_SUBKEY_R(9),
-           t0,t1,il,ir);
-
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(10),CAMELLIA_SUBKEY_R(10),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(11),CAMELLIA_SUBKEY_R(11),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(12),CAMELLIA_SUBKEY_R(12),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(13),CAMELLIA_SUBKEY_R(13),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(14),CAMELLIA_SUBKEY_R(14),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(15),CAMELLIA_SUBKEY_R(15),
-          io[0],io[1],il,ir,t0,t1);
-
-   CAMELLIA_FLS(io[0],io[1],io[2],io[3],
-           CAMELLIA_SUBKEY_L(16),CAMELLIA_SUBKEY_R(16),
-           CAMELLIA_SUBKEY_L(17),CAMELLIA_SUBKEY_R(17),
-           t0,t1,il,ir);
-
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(18),CAMELLIA_SUBKEY_R(18),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(19),CAMELLIA_SUBKEY_R(19),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(20),CAMELLIA_SUBKEY_R(20),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(21),CAMELLIA_SUBKEY_R(21),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(22),CAMELLIA_SUBKEY_R(22),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(23),CAMELLIA_SUBKEY_R(23),
-          io[0],io[1],il,ir,t0,t1);
+#define CAMELLIA_FLS(ll, lr, rl, rr, kll, klr, krl, krr, t0, t1, t2, t3) \
+    do {                        \
+   t0 = kll;                     \
+   t2 = krr;                     \
+   t0 &= ll;                     \
+   t2 |= rr;                     \
+   rl ^= t2;                     \
+   lr ^= ROL1(t0);                     \
+   t3 = krl;                     \
+   t1 = klr;                     \
+   t3 &= rl;                     \
+   t1 |= lr;                     \
+   ll ^= t1;                     \
+   rr ^= ROL1(t3);                     \
+    } while(0)
 
-   /* post whitening but kw4 */
-   io[2] ^= CAMELLIA_SUBKEY_L(24);
-   io[3] ^= CAMELLIA_SUBKEY_R(24);
-
-   t0 = io[0];
-   t1 = io[1];
-   io[0] = io[2];
-   io[1] = io[3];
-   io[2] = t0;
-   io[3] = t1;
-
-   io_text[0] = cpu_to_be32(io[0]);
-   io_text[1] = cpu_to_be32(io[1]);
-   io_text[2] = cpu_to_be32(io[2]);
-   io_text[3] = cpu_to_be32(io[3]);
-
-   return;
-}
+#define CAMELLIA_ROUNDSM(xl, xr, kl, kr, yl, yr, il, ir)      \
+    do {                        \
+   ir =  camellia_sp1110[(u8)xr];               \
+   il =  camellia_sp1110[    (xl >> 24)];            \
+   ir ^= camellia_sp0222[    (xr >> 24)];            \
+   il ^= camellia_sp0222[(u8)(xl >> 16)];            \
+   ir ^= camellia_sp3033[(u8)(xr >> 16)];            \
+   il ^= camellia_sp3033[(u8)(xl >> 8)];            \
+   ir ^= camellia_sp4404[(u8)(xr >> 8)];            \
+   il ^= camellia_sp4404[(u8)xl];               \
+   il ^= kl;                     \
+   ir ^= il ^ kr;                     \
+   yl ^= ir;                     \
+   yr ^= ROR8(il) ^ ir;                  \
+    } while(0)
 
-static void camellia_decrypt128(const u32 *subkey, __be32 *io_text)
+/* max = 24: 128bit encrypt, max = 32: 256bit encrypt */
+static void camellia_do_encrypt(const u32 *subkey, u32 *io, unsigned max)
 {
-   u32 il,ir,t0,t1;               /* temporary valiables */
+   u32 il,ir,t0,t1;               /* temporary variables */
 
-   u32 io[4];
-
-   io[0] = be32_to_cpu(io_text[0]);
-   io[1] = be32_to_cpu(io_text[1]);
-   io[2] = be32_to_cpu(io_text[2]);
-   io[3] = be32_to_cpu(io_text[3]);
-
-   /* pre whitening but absorb kw2*/
-   io[0] ^= CAMELLIA_SUBKEY_L(24);
-   io[1] ^= CAMELLIA_SUBKEY_R(24);
+   /* pre whitening but absorb kw2 */
+   io[0] ^= SUBKEY_L(0);
+   io[1] ^= SUBKEY_R(0);
 
    /* main iteration */
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(23),CAMELLIA_SUBKEY_R(23),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(22),CAMELLIA_SUBKEY_R(22),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(21),CAMELLIA_SUBKEY_R(21),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(20),CAMELLIA_SUBKEY_R(20),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(19),CAMELLIA_SUBKEY_R(19),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(18),CAMELLIA_SUBKEY_R(18),
-          io[0],io[1],il,ir,t0,t1);
-
-   CAMELLIA_FLS(io[0],io[1],io[2],io[3],
-           CAMELLIA_SUBKEY_L(17),CAMELLIA_SUBKEY_R(17),
-           CAMELLIA_SUBKEY_L(16),CAMELLIA_SUBKEY_R(16),
-           t0,t1,il,ir);
-
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(15),CAMELLIA_SUBKEY_R(15),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(14),CAMELLIA_SUBKEY_R(14),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(13),CAMELLIA_SUBKEY_R(13),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(12),CAMELLIA_SUBKEY_R(12),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(11),CAMELLIA_SUBKEY_R(11),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(10),CAMELLIA_SUBKEY_R(10),
-          io[0],io[1],il,ir,t0,t1);
-
-   CAMELLIA_FLS(io[0],io[1],io[2],io[3],
-           CAMELLIA_SUBKEY_L(9),CAMELLIA_SUBKEY_R(9),
-           CAMELLIA_SUBKEY_L(8),CAMELLIA_SUBKEY_R(8),
-           t0,t1,il,ir);
-
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(7),CAMELLIA_SUBKEY_R(7),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(6),CAMELLIA_SUBKEY_R(6),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(5),CAMELLIA_SUBKEY_R(5),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(4),CAMELLIA_SUBKEY_R(4),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(3),CAMELLIA_SUBKEY_R(3),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(2),CAMELLIA_SUBKEY_R(2),
-          io[0],io[1],il,ir,t0,t1);
-
-   /* post whitening but kw4 */
-   io[2] ^= CAMELLIA_SUBKEY_L(0);
-   io[3] ^= CAMELLIA_SUBKEY_R(0);
-
-   t0 = io[0];
-   t1 = io[1];
-   io[0] = io[2];
-   io[1] = io[3];
-   io[2] = t0;
-   io[3] = t1;
-
-   io_text[0] = cpu_to_be32(io[0]);
-   io_text[1] = cpu_to_be32(io[1]);
-   io_text[2] = cpu_to_be32(io[2]);
-   io_text[3] = cpu_to_be32(io[3]);
-
-   return;
-}
-
-
-/**
- * stuff for 192 and 256bit encryption/decryption
- */
-static void camellia_encrypt256(const u32 *subkey, __be32 *io_text)
-{
-   u32 il,ir,t0,t1;           /* temporary valiables */
-
-   u32 io[4];
-
-   io[0] = be32_to_cpu(io_text[0]);
-   io[1] = be32_to_cpu(io_text[1]);
-   io[2] = be32_to_cpu(io_text[2]);
-   io[3] = be32_to_cpu(io_text[3]);
+#define ROUNDS(i) do { \
+   CAMELLIA_ROUNDSM(io[0],io[1], \
+          SUBKEY_L(i + 2),SUBKEY_R(i + 2), \
+          io[2],io[3],il,ir); \
+   CAMELLIA_ROUNDSM(io[2],io[3], \
+          SUBKEY_L(i + 3),SUBKEY_R(i + 3), \
+          io[0],io[1],il,ir); \
+   CAMELLIA_ROUNDSM(io[0],io[1], \
+          SUBKEY_L(i + 4),SUBKEY_R(i + 4), \
+          io[2],io[3],il,ir); \
+   CAMELLIA_ROUNDSM(io[2],io[3], \
+          SUBKEY_L(i + 5),SUBKEY_R(i + 5), \
+          io[0],io[1],il,ir); \
+   CAMELLIA_ROUNDSM(io[0],io[1], \
+          SUBKEY_L(i + 6),SUBKEY_R(i + 6), \
+          io[2],io[3],il,ir); \
+   CAMELLIA_ROUNDSM(io[2],io[3], \
+          SUBKEY_L(i + 7),SUBKEY_R(i + 7), \
+          io[0],io[1],il,ir); \
+} while (0)
+#define FLS(i) do { \
+   CAMELLIA_FLS(io[0],io[1],io[2],io[3], \
+           SUBKEY_L(i + 0),SUBKEY_R(i + 0), \
+           SUBKEY_L(i + 1),SUBKEY_R(i + 1), \
+           t0,t1,il,ir); \
+} while (0)
+
+   ROUNDS(0);
+   FLS(8);
+   ROUNDS(8);
+   FLS(16);
+   ROUNDS(16);
+   if (max == 32) {
+      FLS(24);
+      ROUNDS(24);
+   }
 
-   /* pre whitening but absorb kw2*/
-   io[0] ^= CAMELLIA_SUBKEY_L(0);
-   io[1] ^= CAMELLIA_SUBKEY_R(0);
-
-   /* main iteration */
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(2),CAMELLIA_SUBKEY_R(2),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(3),CAMELLIA_SUBKEY_R(3),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(4),CAMELLIA_SUBKEY_R(4),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(5),CAMELLIA_SUBKEY_R(5),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(6),CAMELLIA_SUBKEY_R(6),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(7),CAMELLIA_SUBKEY_R(7),
-          io[0],io[1],il,ir,t0,t1);
-
-   CAMELLIA_FLS(io[0],io[1],io[2],io[3],
-           CAMELLIA_SUBKEY_L(8),CAMELLIA_SUBKEY_R(8),
-           CAMELLIA_SUBKEY_L(9),CAMELLIA_SUBKEY_R(9),
-           t0,t1,il,ir);
-
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(10),CAMELLIA_SUBKEY_R(10),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(11),CAMELLIA_SUBKEY_R(11),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(12),CAMELLIA_SUBKEY_R(12),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(13),CAMELLIA_SUBKEY_R(13),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(14),CAMELLIA_SUBKEY_R(14),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(15),CAMELLIA_SUBKEY_R(15),
-          io[0],io[1],il,ir,t0,t1);
-
-   CAMELLIA_FLS(io[0],io[1],io[2],io[3],
-           CAMELLIA_SUBKEY_L(16),CAMELLIA_SUBKEY_R(16),
-           CAMELLIA_SUBKEY_L(17),CAMELLIA_SUBKEY_R(17),
-           t0,t1,il,ir);
-
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(18),CAMELLIA_SUBKEY_R(18),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(19),CAMELLIA_SUBKEY_R(19),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(20),CAMELLIA_SUBKEY_R(20),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(21),CAMELLIA_SUBKEY_R(21),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(22),CAMELLIA_SUBKEY_R(22),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(23),CAMELLIA_SUBKEY_R(23),
-          io[0],io[1],il,ir,t0,t1);
-
-   CAMELLIA_FLS(io[0],io[1],io[2],io[3],
-           CAMELLIA_SUBKEY_L(24),CAMELLIA_SUBKEY_R(24),
-           CAMELLIA_SUBKEY_L(25),CAMELLIA_SUBKEY_R(25),
-           t0,t1,il,ir);
-
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(26),CAMELLIA_SUBKEY_R(26),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(27),CAMELLIA_SUBKEY_R(27),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(28),CAMELLIA_SUBKEY_R(28),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(29),CAMELLIA_SUBKEY_R(29),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(30),CAMELLIA_SUBKEY_R(30),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(31),CAMELLIA_SUBKEY_R(31),
-          io[0],io[1],il,ir,t0,t1);
+#undef ROUNDS
+#undef FLS
 
    /* post whitening but kw4 */
-   io[2] ^= CAMELLIA_SUBKEY_L(32);
-   io[3] ^= CAMELLIA_SUBKEY_R(32);
-
-   t0 = io[0];
-   t1 = io[1];
-   io[0] = io[2];
-   io[1] = io[3];
-   io[2] = t0;
-   io[3] = t1;
-
-   io_text[0] = cpu_to_be32(io[0]);
-   io_text[1] = cpu_to_be32(io[1]);
-   io_text[2] = cpu_to_be32(io[2]);
-   io_text[3] = cpu_to_be32(io[3]);
-
-   return;
+   io[2] ^= SUBKEY_L(max);
+   io[3] ^= SUBKEY_R(max);
+   /* NB: io[0],[1] should be swapped with [2],[3] by caller! */
 }
 
-
-static void camellia_decrypt256(const u32 *subkey, __be32 *io_text)
+static void camellia_do_decrypt(const u32 *subkey, u32 *io, unsigned i)
 {
-   u32 il,ir,t0,t1;           /* temporary valiables */
+   u32 il,ir,t0,t1;               /* temporary variables */
 
-   u32 io[4];
-
-   io[0] = be32_to_cpu(io_text[0]);
-   io[1] = be32_to_cpu(io_text[1]);
-   io[2] = be32_to_cpu(io_text[2]);
-   io[3] = be32_to_cpu(io_text[3]);
-
-   /* pre whitening but absorb kw2*/
-   io[0] ^= CAMELLIA_SUBKEY_L(32);
-   io[1] ^= CAMELLIA_SUBKEY_R(32);
+   /* pre whitening but absorb kw2 */
+   io[0] ^= SUBKEY_L(i);
+   io[1] ^= SUBKEY_R(i);
 
    /* main iteration */
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(31),CAMELLIA_SUBKEY_R(31),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(30),CAMELLIA_SUBKEY_R(30),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(29),CAMELLIA_SUBKEY_R(29),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(28),CAMELLIA_SUBKEY_R(28),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(27),CAMELLIA_SUBKEY_R(27),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(26),CAMELLIA_SUBKEY_R(26),
-          io[0],io[1],il,ir,t0,t1);
-
-   CAMELLIA_FLS(io[0],io[1],io[2],io[3],
-           CAMELLIA_SUBKEY_L(25),CAMELLIA_SUBKEY_R(25),
-           CAMELLIA_SUBKEY_L(24),CAMELLIA_SUBKEY_R(24),
-           t0,t1,il,ir);
-
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(23),CAMELLIA_SUBKEY_R(23),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(22),CAMELLIA_SUBKEY_R(22),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(21),CAMELLIA_SUBKEY_R(21),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(20),CAMELLIA_SUBKEY_R(20),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(19),CAMELLIA_SUBKEY_R(19),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(18),CAMELLIA_SUBKEY_R(18),
-          io[0],io[1],il,ir,t0,t1);
-
-   CAMELLIA_FLS(io[0],io[1],io[2],io[3],
-           CAMELLIA_SUBKEY_L(17),CAMELLIA_SUBKEY_R(17),
-           CAMELLIA_SUBKEY_L(16),CAMELLIA_SUBKEY_R(16),
-           t0,t1,il,ir);
-
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(15),CAMELLIA_SUBKEY_R(15),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(14),CAMELLIA_SUBKEY_R(14),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(13),CAMELLIA_SUBKEY_R(13),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(12),CAMELLIA_SUBKEY_R(12),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(11),CAMELLIA_SUBKEY_R(11),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(10),CAMELLIA_SUBKEY_R(10),
-          io[0],io[1],il,ir,t0,t1);
-
-   CAMELLIA_FLS(io[0],io[1],io[2],io[3],
-           CAMELLIA_SUBKEY_L(9),CAMELLIA_SUBKEY_R(9),
-           CAMELLIA_SUBKEY_L(8),CAMELLIA_SUBKEY_R(8),
-           t0,t1,il,ir);
-
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(7),CAMELLIA_SUBKEY_R(7),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(6),CAMELLIA_SUBKEY_R(6),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(5),CAMELLIA_SUBKEY_R(5),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(4),CAMELLIA_SUBKEY_R(4),
-          io[0],io[1],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[0],io[1],
-          CAMELLIA_SUBKEY_L(3),CAMELLIA_SUBKEY_R(3),
-          io[2],io[3],il,ir,t0,t1);
-   CAMELLIA_ROUNDSM(io[2],io[3],
-          CAMELLIA_SUBKEY_L(2),CAMELLIA_SUBKEY_R(2),
-          io[0],io[1],il,ir,t0,t1);
+#define ROUNDS(i) do { \
+   CAMELLIA_ROUNDSM(io[0],io[1], \
+          SUBKEY_L(i + 7),SUBKEY_R(i + 7), \
+          io[2],io[3],il,ir); \
+   CAMELLIA_ROUNDSM(io[2],io[3], \
+          SUBKEY_L(i + 6),SUBKEY_R(i + 6), \
+          io[0],io[1],il,ir); \
+   CAMELLIA_ROUNDSM(io[0],io[1], \
+          SUBKEY_L(i + 5),SUBKEY_R(i + 5), \
+          io[2],io[3],il,ir); \
+   CAMELLIA_ROUNDSM(io[2],io[3], \
+          SUBKEY_L(i + 4),SUBKEY_R(i + 4), \
+          io[0],io[1],il,ir); \
+   CAMELLIA_ROUNDSM(io[0],io[1], \
+          SUBKEY_L(i + 3),SUBKEY_R(i + 3), \
+          io[2],io[3],il,ir); \
+   CAMELLIA_ROUNDSM(io[2],io[3], \
+          SUBKEY_L(i + 2),SUBKEY_R(i + 2), \
+          io[0],io[1],il,ir); \
+} while (0)
+#define FLS(i) do { \
+   CAMELLIA_FLS(io[0],io[1],io[2],io[3], \
+           SUBKEY_L(i + 1),SUBKEY_R(i + 1), \
+           SUBKEY_L(i + 0),SUBKEY_R(i + 0), \
+           t0,t1,il,ir); \
+} while (0)
+
+   if (i == 32) {
+      ROUNDS(24);
+      FLS(24);
+   }
+   ROUNDS(16);
+   FLS(16);
+   ROUNDS(8);
+   FLS(8);
+   ROUNDS(0);
+
+#undef ROUNDS
+#undef FLS
 
    /* post whitening but kw4 */
-   io[2] ^= CAMELLIA_SUBKEY_L(0);
-   io[3] ^= CAMELLIA_SUBKEY_R(0);
-
-   t0 = io[0];
-   t1 = io[1];
-   io[0] = io[2];
-   io[1] = io[3];
-   io[2] = t0;
-   io[3] = t1;
-
-   io_text[0] = cpu_to_be32(io[0]);
-   io_text[1] = cpu_to_be32(io[1]);
-   io_text[2] = cpu_to_be32(io[2]);
-   io_text[3] = cpu_to_be32(io[3]);
-
-   return;
+   io[2] ^= SUBKEY_L(0);
+   io[3] ^= SUBKEY_R(0);
+   /* NB: 0,1 should be swapped with 2,3 by caller! */
 }
 
 
+struct camellia_ctx {
+   int key_length;
+   u32 key_table[CAMELLIA_TABLE_BYTE_LEN / sizeof(u32)];
+};
+
 static int
 camellia_set_key(struct crypto_tfm *tfm, const u8 *in_key,
        unsigned int key_len)
@@ -1688,7 +1027,7 @@ camellia_set_key(struct crypto_tfm *tfm, const u8 *in_key,
 
    cctx->key_length = key_len;
 
-   switch(key_len) {
+   switch (key_len) {
    case 16:
       camellia_setup128(key, cctx->key_table);
       break;
@@ -1698,68 +1037,59 @@ camellia_set_key(struct crypto_tfm *tfm, const u8 *in_key,
    case 32:
       camellia_setup256(key, cctx->key_table);
       break;
-   default:
-      break;
    }
 
    return 0;
 }
 
-
 static void camellia_encrypt(struct crypto_tfm *tfm, u8 *out, const u8 *in)
 {
    const struct camellia_ctx *cctx = crypto_tfm_ctx(tfm);
    const __be32 *src = (const __be32 *)in;
    __be32 *dst = (__be32 *)out;
 
-   __be32 tmp[4];
+   u32 tmp[4];
 
-   memcpy(tmp, src, CAMELLIA_BLOCK_SIZE);
+   tmp[0] = be32_to_cpu(src[0]);
+   tmp[1] = be32_to_cpu(src[1]);
+   tmp[2] = be32_to_cpu(src[2]);
+   tmp[3] = be32_to_cpu(src[3]);
 
-   switch (cctx->key_length) {
-   case 16:
-      camellia_encrypt128(cctx->key_table, tmp);
-      break;
-   case 24:
-      /* fall through */
-   case 32:
-      camellia_encrypt256(cctx->key_table, tmp);
-      break;
-   default:
-      break;
-   }
+   camellia_do_encrypt(cctx->key_table, tmp,
+      cctx->key_length == 16 ? 24 : 32 /* for key lengths of 24 and 32 */
+   );
 
-   memcpy(dst, tmp, CAMELLIA_BLOCK_SIZE);
+   /* do_encrypt returns 0,1 swapped with 2,3 */
+   dst[0] = cpu_to_be32(tmp[2]);
+   dst[1] = cpu_to_be32(tmp[3]);
+   dst[2] = cpu_to_be32(tmp[0]);
+   dst[3] = cpu_to_be32(tmp[1]);
 }
 
-
 static void camellia_decrypt(struct crypto_tfm *tfm, u8 *out, const u8 *in)
 {
    const struct camellia_ctx *cctx = crypto_tfm_ctx(tfm);
    const __be32 *src = (const __be32 *)in;
    __be32 *dst = (__be32 *)out;
 
-   __be32 tmp[4];
+   u32 tmp[4];
 
-   memcpy(tmp, src, CAMELLIA_BLOCK_SIZE);
+   tmp[0] = be32_to_cpu(src[0]);
+   tmp[1] = be32_to_cpu(src[1]);
+   tmp[2] = be32_to_cpu(src[2]);
+   tmp[3] = be32_to_cpu(src[3]);
 
-   switch (cctx->key_length) {
-   case 16:
-      camellia_decrypt128(cctx->key_table, tmp);
-      break;
-   case 24:
-      /* fall through */
-   case 32:
-      camellia_decrypt256(cctx->key_table, tmp);
-      break;
-   default:
-      break;
-   }
+   camellia_do_decrypt(cctx->key_table, tmp,
+      cctx->key_length == 16 ? 24 : 32 /* for key lengths of 24 and 32 */
+   );
 
-   memcpy(dst, tmp, CAMELLIA_BLOCK_SIZE);
+   /* do_decrypt returns 0,1 swapped with 2,3 */
+   dst[0] = cpu_to_be32(tmp[2]);
+   dst[1] = cpu_to_be32(tmp[3]);
+   dst[2] = cpu_to_be32(tmp[0]);
+   dst[3] = cpu_to_be32(tmp[1]);
 }
 
-
 static struct crypto_alg camellia_alg = {
    .cra_name      =   "camellia",
    .cra_driver_name   =   "camellia-generic",
@@ -1786,16 +1116,13 @@ static int __init camellia_init(void)
    return crypto_register_alg(&camellia_alg);
 }
 
-
 static void __exit camellia_fini(void)
 {
    crypto_unregister_alg(&camellia_alg);
 }
 
-
 module_init(camellia_init);
 module_exit(camellia_fini);
 
-
 MODULE_DESCRIPTION("Camellia Cipher Algorithm");
 MODULE_LICENSE("GPL");


Comments: webmaster (at) linuxhq.com.
Advertising: banners (at) linuxhq.com.
Compilation ©1998-2008 Linux Headquarters, Inc.