Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/ieee1394...
[linux-2.6] / drivers / isdn / mISDN / dsp_blowfish.c
1 /*
2  * Blowfish encryption/decryption for mISDN_dsp.
3  *
4  * Copyright Andreas Eversberg (jolly@eversberg.eu)
5  *
6  * This software may be used and distributed according to the terms
7  * of the GNU General Public License, incorporated herein by reference.
8  *
9  */
10
11 #include <linux/mISDNif.h>
12 #include <linux/mISDNdsp.h>
13 #include "core.h"
14 #include "dsp.h"
15
16 /*
17  * how to encode a sample stream to 64-bit blocks that will be encryped
18  *
19  * first of all, data is collected until a block of 9 samples are received.
20  * of course, a packet may have much more than 9 sample, but is may have
21  * not excacly the multiple of 9 samples. if there is a rest, the next
22  * received data will complete the block.
23  *
24  * the block is then converted to 9 uLAW samples without the least sigificant
25  * bit. the result is a 7-bit encoded sample.
26  *
27  * the samples will be reoganised to form 8 bytes of data:
28  * (5(6) means: encoded sample no. 5, bit 6)
29  *
30  * 0(6) 0(5) 0(4) 0(3) 0(2) 0(1) 0(0) 1(6)
31  * 1(5) 1(4) 1(3) 1(2) 1(1) 1(0) 2(6) 2(5)
32  * 2(4) 2(3) 2(2) 2(1) 2(0) 3(6) 3(5) 3(4)
33  * 3(3) 3(2) 3(1) 3(0) 4(6) 4(5) 4(4) 4(3)
34  * 4(2) 4(1) 4(0) 5(6) 5(5) 5(4) 5(3) 5(2)
35  * 5(1) 5(0) 6(6) 6(5) 6(4) 6(3) 6(2) 6(1)
36  * 6(0) 7(6) 7(5) 7(4) 7(3) 7(2) 7(1) 7(0)
37  * 8(6) 8(5) 8(4) 8(3) 8(2) 8(1) 8(0)
38  *
39  * the missing bit 0 of the last byte is filled with some
40  * random noise, to fill all 8 bytes.
41  *
42  * the 8 bytes will be encrypted using blowfish.
43  *
44  * the result will be converted into 9 bytes. the bit 7 is used for
45  * checksumme (CS) for sync (0, 1) and for the last bit:
46  * (5(6) means: crypted byte 5, bit 6)
47  *
48  * 1    0(7) 0(6) 0(5) 0(4) 0(3) 0(2) 0(1)
49  * 0    0(0) 1(7) 1(6) 1(5) 1(4) 1(3) 1(2)
50  * 0    1(1) 1(0) 2(7) 2(6) 2(5) 2(4) 2(3)
51  * 0    2(2) 2(1) 2(0) 3(7) 3(6) 3(5) 3(4)
52  * 0    3(3) 3(2) 3(1) 3(0) 4(7) 4(6) 4(5)
53  * CS   4(4) 4(3) 4(2) 4(1) 4(0) 5(7) 5(6)
54  * CS   5(5) 5(4) 5(3) 5(2) 5(1) 5(0) 6(7)
55  * CS   6(6) 6(5) 6(4) 6(3) 6(2) 6(1) 6(0)
56  * 7(0) 7(6) 7(5) 7(4) 7(3) 7(2) 7(1) 7(0)
57  *
58  * the checksum is used to detect transmission errors and frame drops.
59  *
60  * synchronisation of received block is done by shifting the upper bit of each
61  * byte (bit 7) to a shift register. if the rigister has the first five bits
62  * (10000), this is used to find the sync. only if sync has been found, the
63  * current block of 9 received bytes are decrypted. before that the check
64  * sum is calculated. if it is incorrect the block is dropped.
65  * this will avoid loud noise due to corrupt encrypted data.
66  *
67  * if the last block is corrupt, the current decoded block is repeated
68  * until a valid block has been received.
69  */
70
71 /*
72  *  some blowfish parts are taken from the
73  * crypto-api for faster implementation
74  */
75
76 struct bf_ctx {
77         u32 p[18];
78         u32 s[1024];
79 };
80
81 static const u32 bf_pbox[16 + 2] = {
82         0x243f6a88, 0x85a308d3, 0x13198a2e, 0x03707344,
83         0xa4093822, 0x299f31d0, 0x082efa98, 0xec4e6c89,
84         0x452821e6, 0x38d01377, 0xbe5466cf, 0x34e90c6c,
85         0xc0ac29b7, 0xc97c50dd, 0x3f84d5b5, 0xb5470917,
86         0x9216d5d9, 0x8979fb1b,
87 };
88
89 static const u32 bf_sbox[256 * 4] = {
90         0xd1310ba6, 0x98dfb5ac, 0x2ffd72db, 0xd01adfb7,
91         0xb8e1afed, 0x6a267e96, 0xba7c9045, 0xf12c7f99,
92         0x24a19947, 0xb3916cf7, 0x0801f2e2, 0x858efc16,
93         0x636920d8, 0x71574e69, 0xa458fea3, 0xf4933d7e,
94         0x0d95748f, 0x728eb658, 0x718bcd58, 0x82154aee,
95         0x7b54a41d, 0xc25a59b5, 0x9c30d539, 0x2af26013,
96         0xc5d1b023, 0x286085f0, 0xca417918, 0xb8db38ef,
97         0x8e79dcb0, 0x603a180e, 0x6c9e0e8b, 0xb01e8a3e,
98         0xd71577c1, 0xbd314b27, 0x78af2fda, 0x55605c60,
99         0xe65525f3, 0xaa55ab94, 0x57489862, 0x63e81440,
100         0x55ca396a, 0x2aab10b6, 0xb4cc5c34, 0x1141e8ce,
101         0xa15486af, 0x7c72e993, 0xb3ee1411, 0x636fbc2a,
102         0x2ba9c55d, 0x741831f6, 0xce5c3e16, 0x9b87931e,
103         0xafd6ba33, 0x6c24cf5c, 0x7a325381, 0x28958677,
104         0x3b8f4898, 0x6b4bb9af, 0xc4bfe81b, 0x66282193,
105         0x61d809cc, 0xfb21a991, 0x487cac60, 0x5dec8032,
106         0xef845d5d, 0xe98575b1, 0xdc262302, 0xeb651b88,
107         0x23893e81, 0xd396acc5, 0x0f6d6ff3, 0x83f44239,
108         0x2e0b4482, 0xa4842004, 0x69c8f04a, 0x9e1f9b5e,
109         0x21c66842, 0xf6e96c9a, 0x670c9c61, 0xabd388f0,
110         0x6a51a0d2, 0xd8542f68, 0x960fa728, 0xab5133a3,
111         0x6eef0b6c, 0x137a3be4, 0xba3bf050, 0x7efb2a98,
112         0xa1f1651d, 0x39af0176, 0x66ca593e, 0x82430e88,
113         0x8cee8619, 0x456f9fb4, 0x7d84a5c3, 0x3b8b5ebe,
114         0xe06f75d8, 0x85c12073, 0x401a449f, 0x56c16aa6,
115         0x4ed3aa62, 0x363f7706, 0x1bfedf72, 0x429b023d,
116         0x37d0d724, 0xd00a1248, 0xdb0fead3, 0x49f1c09b,
117         0x075372c9, 0x80991b7b, 0x25d479d8, 0xf6e8def7,
118         0xe3fe501a, 0xb6794c3b, 0x976ce0bd, 0x04c006ba,
119         0xc1a94fb6, 0x409f60c4, 0x5e5c9ec2, 0x196a2463,
120         0x68fb6faf, 0x3e6c53b5, 0x1339b2eb, 0x3b52ec6f,
121         0x6dfc511f, 0x9b30952c, 0xcc814544, 0xaf5ebd09,
122         0xbee3d004, 0xde334afd, 0x660f2807, 0x192e4bb3,
123         0xc0cba857, 0x45c8740f, 0xd20b5f39, 0xb9d3fbdb,
124         0x5579c0bd, 0x1a60320a, 0xd6a100c6, 0x402c7279,
125         0x679f25fe, 0xfb1fa3cc, 0x8ea5e9f8, 0xdb3222f8,
126         0x3c7516df, 0xfd616b15, 0x2f501ec8, 0xad0552ab,
127         0x323db5fa, 0xfd238760, 0x53317b48, 0x3e00df82,
128         0x9e5c57bb, 0xca6f8ca0, 0x1a87562e, 0xdf1769db,
129         0xd542a8f6, 0x287effc3, 0xac6732c6, 0x8c4f5573,
130         0x695b27b0, 0xbbca58c8, 0xe1ffa35d, 0xb8f011a0,
131         0x10fa3d98, 0xfd2183b8, 0x4afcb56c, 0x2dd1d35b,
132         0x9a53e479, 0xb6f84565, 0xd28e49bc, 0x4bfb9790,
133         0xe1ddf2da, 0xa4cb7e33, 0x62fb1341, 0xcee4c6e8,
134         0xef20cada, 0x36774c01, 0xd07e9efe, 0x2bf11fb4,
135         0x95dbda4d, 0xae909198, 0xeaad8e71, 0x6b93d5a0,
136         0xd08ed1d0, 0xafc725e0, 0x8e3c5b2f, 0x8e7594b7,
137         0x8ff6e2fb, 0xf2122b64, 0x8888b812, 0x900df01c,
138         0x4fad5ea0, 0x688fc31c, 0xd1cff191, 0xb3a8c1ad,
139         0x2f2f2218, 0xbe0e1777, 0xea752dfe, 0x8b021fa1,
140         0xe5a0cc0f, 0xb56f74e8, 0x18acf3d6, 0xce89e299,
141         0xb4a84fe0, 0xfd13e0b7, 0x7cc43b81, 0xd2ada8d9,
142         0x165fa266, 0x80957705, 0x93cc7314, 0x211a1477,
143         0xe6ad2065, 0x77b5fa86, 0xc75442f5, 0xfb9d35cf,
144         0xebcdaf0c, 0x7b3e89a0, 0xd6411bd3, 0xae1e7e49,
145         0x00250e2d, 0x2071b35e, 0x226800bb, 0x57b8e0af,
146         0x2464369b, 0xf009b91e, 0x5563911d, 0x59dfa6aa,
147         0x78c14389, 0xd95a537f, 0x207d5ba2, 0x02e5b9c5,
148         0x83260376, 0x6295cfa9, 0x11c81968, 0x4e734a41,
149         0xb3472dca, 0x7b14a94a, 0x1b510052, 0x9a532915,
150         0xd60f573f, 0xbc9bc6e4, 0x2b60a476, 0x81e67400,
151         0x08ba6fb5, 0x571be91f, 0xf296ec6b, 0x2a0dd915,
152         0xb6636521, 0xe7b9f9b6, 0xff34052e, 0xc5855664,
153         0x53b02d5d, 0xa99f8fa1, 0x08ba4799, 0x6e85076a,
154         0x4b7a70e9, 0xb5b32944, 0xdb75092e, 0xc4192623,
155         0xad6ea6b0, 0x49a7df7d, 0x9cee60b8, 0x8fedb266,
156         0xecaa8c71, 0x699a17ff, 0x5664526c, 0xc2b19ee1,
157         0x193602a5, 0x75094c29, 0xa0591340, 0xe4183a3e,
158         0x3f54989a, 0x5b429d65, 0x6b8fe4d6, 0x99f73fd6,
159         0xa1d29c07, 0xefe830f5, 0x4d2d38e6, 0xf0255dc1,
160         0x4cdd2086, 0x8470eb26, 0x6382e9c6, 0x021ecc5e,
161         0x09686b3f, 0x3ebaefc9, 0x3c971814, 0x6b6a70a1,
162         0x687f3584, 0x52a0e286, 0xb79c5305, 0xaa500737,
163         0x3e07841c, 0x7fdeae5c, 0x8e7d44ec, 0x5716f2b8,
164         0xb03ada37, 0xf0500c0d, 0xf01c1f04, 0x0200b3ff,
165         0xae0cf51a, 0x3cb574b2, 0x25837a58, 0xdc0921bd,
166         0xd19113f9, 0x7ca92ff6, 0x94324773, 0x22f54701,
167         0x3ae5e581, 0x37c2dadc, 0xc8b57634, 0x9af3dda7,
168         0xa9446146, 0x0fd0030e, 0xecc8c73e, 0xa4751e41,
169         0xe238cd99, 0x3bea0e2f, 0x3280bba1, 0x183eb331,
170         0x4e548b38, 0x4f6db908, 0x6f420d03, 0xf60a04bf,
171         0x2cb81290, 0x24977c79, 0x5679b072, 0xbcaf89af,
172         0xde9a771f, 0xd9930810, 0xb38bae12, 0xdccf3f2e,
173         0x5512721f, 0x2e6b7124, 0x501adde6, 0x9f84cd87,
174         0x7a584718, 0x7408da17, 0xbc9f9abc, 0xe94b7d8c,
175         0xec7aec3a, 0xdb851dfa, 0x63094366, 0xc464c3d2,
176         0xef1c1847, 0x3215d908, 0xdd433b37, 0x24c2ba16,
177         0x12a14d43, 0x2a65c451, 0x50940002, 0x133ae4dd,
178         0x71dff89e, 0x10314e55, 0x81ac77d6, 0x5f11199b,
179         0x043556f1, 0xd7a3c76b, 0x3c11183b, 0x5924a509,
180         0xf28fe6ed, 0x97f1fbfa, 0x9ebabf2c, 0x1e153c6e,
181         0x86e34570, 0xeae96fb1, 0x860e5e0a, 0x5a3e2ab3,
182         0x771fe71c, 0x4e3d06fa, 0x2965dcb9, 0x99e71d0f,
183         0x803e89d6, 0x5266c825, 0x2e4cc978, 0x9c10b36a,
184         0xc6150eba, 0x94e2ea78, 0xa5fc3c53, 0x1e0a2df4,
185         0xf2f74ea7, 0x361d2b3d, 0x1939260f, 0x19c27960,
186         0x5223a708, 0xf71312b6, 0xebadfe6e, 0xeac31f66,
187         0xe3bc4595, 0xa67bc883, 0xb17f37d1, 0x018cff28,
188         0xc332ddef, 0xbe6c5aa5, 0x65582185, 0x68ab9802,
189         0xeecea50f, 0xdb2f953b, 0x2aef7dad, 0x5b6e2f84,
190         0x1521b628, 0x29076170, 0xecdd4775, 0x619f1510,
191         0x13cca830, 0xeb61bd96, 0x0334fe1e, 0xaa0363cf,
192         0xb5735c90, 0x4c70a239, 0xd59e9e0b, 0xcbaade14,
193         0xeecc86bc, 0x60622ca7, 0x9cab5cab, 0xb2f3846e,
194         0x648b1eaf, 0x19bdf0ca, 0xa02369b9, 0x655abb50,
195         0x40685a32, 0x3c2ab4b3, 0x319ee9d5, 0xc021b8f7,
196         0x9b540b19, 0x875fa099, 0x95f7997e, 0x623d7da8,
197         0xf837889a, 0x97e32d77, 0x11ed935f, 0x16681281,
198         0x0e358829, 0xc7e61fd6, 0x96dedfa1, 0x7858ba99,
199         0x57f584a5, 0x1b227263, 0x9b83c3ff, 0x1ac24696,
200         0xcdb30aeb, 0x532e3054, 0x8fd948e4, 0x6dbc3128,
201         0x58ebf2ef, 0x34c6ffea, 0xfe28ed61, 0xee7c3c73,
202         0x5d4a14d9, 0xe864b7e3, 0x42105d14, 0x203e13e0,
203         0x45eee2b6, 0xa3aaabea, 0xdb6c4f15, 0xfacb4fd0,
204         0xc742f442, 0xef6abbb5, 0x654f3b1d, 0x41cd2105,
205         0xd81e799e, 0x86854dc7, 0xe44b476a, 0x3d816250,
206         0xcf62a1f2, 0x5b8d2646, 0xfc8883a0, 0xc1c7b6a3,
207         0x7f1524c3, 0x69cb7492, 0x47848a0b, 0x5692b285,
208         0x095bbf00, 0xad19489d, 0x1462b174, 0x23820e00,
209         0x58428d2a, 0x0c55f5ea, 0x1dadf43e, 0x233f7061,
210         0x3372f092, 0x8d937e41, 0xd65fecf1, 0x6c223bdb,
211         0x7cde3759, 0xcbee7460, 0x4085f2a7, 0xce77326e,
212         0xa6078084, 0x19f8509e, 0xe8efd855, 0x61d99735,
213         0xa969a7aa, 0xc50c06c2, 0x5a04abfc, 0x800bcadc,
214         0x9e447a2e, 0xc3453484, 0xfdd56705, 0x0e1e9ec9,
215         0xdb73dbd3, 0x105588cd, 0x675fda79, 0xe3674340,
216         0xc5c43465, 0x713e38d8, 0x3d28f89e, 0xf16dff20,
217         0x153e21e7, 0x8fb03d4a, 0xe6e39f2b, 0xdb83adf7,
218         0xe93d5a68, 0x948140f7, 0xf64c261c, 0x94692934,
219         0x411520f7, 0x7602d4f7, 0xbcf46b2e, 0xd4a20068,
220         0xd4082471, 0x3320f46a, 0x43b7d4b7, 0x500061af,
221         0x1e39f62e, 0x97244546, 0x14214f74, 0xbf8b8840,
222         0x4d95fc1d, 0x96b591af, 0x70f4ddd3, 0x66a02f45,
223         0xbfbc09ec, 0x03bd9785, 0x7fac6dd0, 0x31cb8504,
224         0x96eb27b3, 0x55fd3941, 0xda2547e6, 0xabca0a9a,
225         0x28507825, 0x530429f4, 0x0a2c86da, 0xe9b66dfb,
226         0x68dc1462, 0xd7486900, 0x680ec0a4, 0x27a18dee,
227         0x4f3ffea2, 0xe887ad8c, 0xb58ce006, 0x7af4d6b6,
228         0xaace1e7c, 0xd3375fec, 0xce78a399, 0x406b2a42,
229         0x20fe9e35, 0xd9f385b9, 0xee39d7ab, 0x3b124e8b,
230         0x1dc9faf7, 0x4b6d1856, 0x26a36631, 0xeae397b2,
231         0x3a6efa74, 0xdd5b4332, 0x6841e7f7, 0xca7820fb,
232         0xfb0af54e, 0xd8feb397, 0x454056ac, 0xba489527,
233         0x55533a3a, 0x20838d87, 0xfe6ba9b7, 0xd096954b,
234         0x55a867bc, 0xa1159a58, 0xcca92963, 0x99e1db33,
235         0xa62a4a56, 0x3f3125f9, 0x5ef47e1c, 0x9029317c,
236         0xfdf8e802, 0x04272f70, 0x80bb155c, 0x05282ce3,
237         0x95c11548, 0xe4c66d22, 0x48c1133f, 0xc70f86dc,
238         0x07f9c9ee, 0x41041f0f, 0x404779a4, 0x5d886e17,
239         0x325f51eb, 0xd59bc0d1, 0xf2bcc18f, 0x41113564,
240         0x257b7834, 0x602a9c60, 0xdff8e8a3, 0x1f636c1b,
241         0x0e12b4c2, 0x02e1329e, 0xaf664fd1, 0xcad18115,
242         0x6b2395e0, 0x333e92e1, 0x3b240b62, 0xeebeb922,
243         0x85b2a20e, 0xe6ba0d99, 0xde720c8c, 0x2da2f728,
244         0xd0127845, 0x95b794fd, 0x647d0862, 0xe7ccf5f0,
245         0x5449a36f, 0x877d48fa, 0xc39dfd27, 0xf33e8d1e,
246         0x0a476341, 0x992eff74, 0x3a6f6eab, 0xf4f8fd37,
247         0xa812dc60, 0xa1ebddf8, 0x991be14c, 0xdb6e6b0d,
248         0xc67b5510, 0x6d672c37, 0x2765d43b, 0xdcd0e804,
249         0xf1290dc7, 0xcc00ffa3, 0xb5390f92, 0x690fed0b,
250         0x667b9ffb, 0xcedb7d9c, 0xa091cf0b, 0xd9155ea3,
251         0xbb132f88, 0x515bad24, 0x7b9479bf, 0x763bd6eb,
252         0x37392eb3, 0xcc115979, 0x8026e297, 0xf42e312d,
253         0x6842ada7, 0xc66a2b3b, 0x12754ccc, 0x782ef11c,
254         0x6a124237, 0xb79251e7, 0x06a1bbe6, 0x4bfb6350,
255         0x1a6b1018, 0x11caedfa, 0x3d25bdd8, 0xe2e1c3c9,
256         0x44421659, 0x0a121386, 0xd90cec6e, 0xd5abea2a,
257         0x64af674e, 0xda86a85f, 0xbebfe988, 0x64e4c3fe,
258         0x9dbc8057, 0xf0f7c086, 0x60787bf8, 0x6003604d,
259         0xd1fd8346, 0xf6381fb0, 0x7745ae04, 0xd736fccc,
260         0x83426b33, 0xf01eab71, 0xb0804187, 0x3c005e5f,
261         0x77a057be, 0xbde8ae24, 0x55464299, 0xbf582e61,
262         0x4e58f48f, 0xf2ddfda2, 0xf474ef38, 0x8789bdc2,
263         0x5366f9c3, 0xc8b38e74, 0xb475f255, 0x46fcd9b9,
264         0x7aeb2661, 0x8b1ddf84, 0x846a0e79, 0x915f95e2,
265         0x466e598e, 0x20b45770, 0x8cd55591, 0xc902de4c,
266         0xb90bace1, 0xbb8205d0, 0x11a86248, 0x7574a99e,
267         0xb77f19b6, 0xe0a9dc09, 0x662d09a1, 0xc4324633,
268         0xe85a1f02, 0x09f0be8c, 0x4a99a025, 0x1d6efe10,
269         0x1ab93d1d, 0x0ba5a4df, 0xa186f20f, 0x2868f169,
270         0xdcb7da83, 0x573906fe, 0xa1e2ce9b, 0x4fcd7f52,
271         0x50115e01, 0xa70683fa, 0xa002b5c4, 0x0de6d027,
272         0x9af88c27, 0x773f8641, 0xc3604c06, 0x61a806b5,
273         0xf0177a28, 0xc0f586e0, 0x006058aa, 0x30dc7d62,
274         0x11e69ed7, 0x2338ea63, 0x53c2dd94, 0xc2c21634,
275         0xbbcbee56, 0x90bcb6de, 0xebfc7da1, 0xce591d76,
276         0x6f05e409, 0x4b7c0188, 0x39720a3d, 0x7c927c24,
277         0x86e3725f, 0x724d9db9, 0x1ac15bb4, 0xd39eb8fc,
278         0xed545578, 0x08fca5b5, 0xd83d7cd3, 0x4dad0fc4,
279         0x1e50ef5e, 0xb161e6f8, 0xa28514d9, 0x6c51133c,
280         0x6fd5c7e7, 0x56e14ec4, 0x362abfce, 0xddc6c837,
281         0xd79a3234, 0x92638212, 0x670efa8e, 0x406000e0,
282         0x3a39ce37, 0xd3faf5cf, 0xabc27737, 0x5ac52d1b,
283         0x5cb0679e, 0x4fa33742, 0xd3822740, 0x99bc9bbe,
284         0xd5118e9d, 0xbf0f7315, 0xd62d1c7e, 0xc700c47b,
285         0xb78c1b6b, 0x21a19045, 0xb26eb1be, 0x6a366eb4,
286         0x5748ab2f, 0xbc946e79, 0xc6a376d2, 0x6549c2c8,
287         0x530ff8ee, 0x468dde7d, 0xd5730a1d, 0x4cd04dc6,
288         0x2939bbdb, 0xa9ba4650, 0xac9526e8, 0xbe5ee304,
289         0xa1fad5f0, 0x6a2d519a, 0x63ef8ce2, 0x9a86ee22,
290         0xc089c2b8, 0x43242ef6, 0xa51e03aa, 0x9cf2d0a4,
291         0x83c061ba, 0x9be96a4d, 0x8fe51550, 0xba645bd6,
292         0x2826a2f9, 0xa73a3ae1, 0x4ba99586, 0xef5562e9,
293         0xc72fefd3, 0xf752f7da, 0x3f046f69, 0x77fa0a59,
294         0x80e4a915, 0x87b08601, 0x9b09e6ad, 0x3b3ee593,
295         0xe990fd5a, 0x9e34d797, 0x2cf0b7d9, 0x022b8b51,
296         0x96d5ac3a, 0x017da67d, 0xd1cf3ed6, 0x7c7d2d28,
297         0x1f9f25cf, 0xadf2b89b, 0x5ad6b472, 0x5a88f54c,
298         0xe029ac71, 0xe019a5e6, 0x47b0acfd, 0xed93fa9b,
299         0xe8d3c48d, 0x283b57cc, 0xf8d56629, 0x79132e28,
300         0x785f0191, 0xed756055, 0xf7960e44, 0xe3d35e8c,
301         0x15056dd4, 0x88f46dba, 0x03a16125, 0x0564f0bd,
302         0xc3eb9e15, 0x3c9057a2, 0x97271aec, 0xa93a072a,
303         0x1b3f6d9b, 0x1e6321f5, 0xf59c66fb, 0x26dcf319,
304         0x7533d928, 0xb155fdf5, 0x03563482, 0x8aba3cbb,
305         0x28517711, 0xc20ad9f8, 0xabcc5167, 0xccad925f,
306         0x4de81751, 0x3830dc8e, 0x379d5862, 0x9320f991,
307         0xea7a90c2, 0xfb3e7bce, 0x5121ce64, 0x774fbe32,
308         0xa8b6e37e, 0xc3293d46, 0x48de5369, 0x6413e680,
309         0xa2ae0810, 0xdd6db224, 0x69852dfd, 0x09072166,
310         0xb39a460a, 0x6445c0dd, 0x586cdecf, 0x1c20c8ae,
311         0x5bbef7dd, 0x1b588d40, 0xccd2017f, 0x6bb4e3bb,
312         0xdda26a7e, 0x3a59ff45, 0x3e350a44, 0xbcb4cdd5,
313         0x72eacea8, 0xfa6484bb, 0x8d6612ae, 0xbf3c6f47,
314         0xd29be463, 0x542f5d9e, 0xaec2771b, 0xf64e6370,
315         0x740e0d8d, 0xe75b1357, 0xf8721671, 0xaf537d5d,
316         0x4040cb08, 0x4eb4e2cc, 0x34d2466a, 0x0115af84,
317         0xe1b00428, 0x95983a1d, 0x06b89fb4, 0xce6ea048,
318         0x6f3f3b82, 0x3520ab82, 0x011a1d4b, 0x277227f8,
319         0x611560b1, 0xe7933fdc, 0xbb3a792b, 0x344525bd,
320         0xa08839e1, 0x51ce794b, 0x2f32c9b7, 0xa01fbac9,
321         0xe01cc87e, 0xbcc7d1f6, 0xcf0111c3, 0xa1e8aac7,
322         0x1a908749, 0xd44fbd9a, 0xd0dadecb, 0xd50ada38,
323         0x0339c32a, 0xc6913667, 0x8df9317c, 0xe0b12b4f,
324         0xf79e59b7, 0x43f5bb3a, 0xf2d519ff, 0x27d9459c,
325         0xbf97222c, 0x15e6fc2a, 0x0f91fc71, 0x9b941525,
326         0xfae59361, 0xceb69ceb, 0xc2a86459, 0x12baa8d1,
327         0xb6c1075e, 0xe3056a0c, 0x10d25065, 0xcb03a442,
328         0xe0ec6e0e, 0x1698db3b, 0x4c98a0be, 0x3278e964,
329         0x9f1f9532, 0xe0d392df, 0xd3a0342b, 0x8971f21e,
330         0x1b0a7441, 0x4ba3348c, 0xc5be7120, 0xc37632d8,
331         0xdf359f8d, 0x9b992f2e, 0xe60b6f47, 0x0fe3f11d,
332         0xe54cda54, 0x1edad891, 0xce6279cf, 0xcd3e7e6f,
333         0x1618b166, 0xfd2c1d05, 0x848fd2c5, 0xf6fb2299,
334         0xf523f357, 0xa6327623, 0x93a83531, 0x56cccd02,
335         0xacf08162, 0x5a75ebb5, 0x6e163697, 0x88d273cc,
336         0xde966292, 0x81b949d0, 0x4c50901b, 0x71c65614,
337         0xe6c6c7bd, 0x327a140a, 0x45e1d006, 0xc3f27b9a,
338         0xc9aa53fd, 0x62a80f00, 0xbb25bfe2, 0x35bdd2f6,
339         0x71126905, 0xb2040222, 0xb6cbcf7c, 0xcd769c2b,
340         0x53113ec0, 0x1640e3d3, 0x38abbd60, 0x2547adf0,
341         0xba38209c, 0xf746ce76, 0x77afa1c5, 0x20756060,
342         0x85cbfe4e, 0x8ae88dd8, 0x7aaaf9b0, 0x4cf9aa7e,
343         0x1948c25c, 0x02fb8a8c, 0x01c36ae4, 0xd6ebe1f9,
344         0x90d4f869, 0xa65cdea0, 0x3f09252d, 0xc208e69f,
345         0xb74e6132, 0xce77e25b, 0x578fdfe3, 0x3ac372e6,
346 };
347
348 /*
349  * Round loop unrolling macros, S is a pointer to a S-Box array
350  * organized in 4 unsigned longs at a row.
351  */
352 #define GET32_3(x) (((x) & 0xff))
353 #define GET32_2(x) (((x) >> (8)) & (0xff))
354 #define GET32_1(x) (((x) >> (16)) & (0xff))
355 #define GET32_0(x) (((x) >> (24)) & (0xff))
356
357 #define bf_F(x) (((S[GET32_0(x)] + S[256 + GET32_1(x)]) ^ \
358     S[512 + GET32_2(x)]) + S[768 + GET32_3(x)])
359
360 #define EROUND(a, b, n)  do { b ^= P[n]; a ^= bf_F(b); } while (0)
361 #define DROUND(a, b, n)  do { a ^= bf_F(b); b ^= P[n]; } while (0)
362
363
364 /*
365  * encrypt isdn data frame
366  * every block with 9 samples is encrypted
367  */
368 void
369 dsp_bf_encrypt(struct dsp *dsp, u8 *data, int len)
370 {
371         int i = 0, j = dsp->bf_crypt_pos;
372         u8 *bf_data_in = dsp->bf_data_in;
373         u8 *bf_crypt_out = dsp->bf_crypt_out;
374         u32 *P = dsp->bf_p;
375         u32 *S = dsp->bf_s;
376         u32 yl, yr;
377         u32 cs;
378         u8 nibble;
379
380         while (i < len) {
381                 /* collect a block of 9 samples */
382                 if (j < 9) {
383                         bf_data_in[j] = *data;
384                         *data++ = bf_crypt_out[j++];
385                         i++;
386                         continue;
387                 }
388                 j = 0;
389                 /* transcode 9 samples xlaw to 8 bytes */
390                 yl = dsp_audio_law2seven[bf_data_in[0]];
391                 yl = (yl<<7) | dsp_audio_law2seven[bf_data_in[1]];
392                 yl = (yl<<7) | dsp_audio_law2seven[bf_data_in[2]];
393                 yl = (yl<<7) | dsp_audio_law2seven[bf_data_in[3]];
394                 nibble = dsp_audio_law2seven[bf_data_in[4]];
395                 yr = nibble;
396                 yl = (yl<<4) | (nibble>>3);
397                 yr = (yr<<7) | dsp_audio_law2seven[bf_data_in[5]];
398                 yr = (yr<<7) | dsp_audio_law2seven[bf_data_in[6]];
399                 yr = (yr<<7) | dsp_audio_law2seven[bf_data_in[7]];
400                 yr = (yr<<7) | dsp_audio_law2seven[bf_data_in[8]];
401                 yr = (yr<<1) | (bf_data_in[0] & 1);
402
403                 /* fill unused bit with random noise of audio input */
404                 /* encrypt */
405
406                 EROUND(yr, yl, 0);
407                 EROUND(yl, yr, 1);
408                 EROUND(yr, yl, 2);
409                 EROUND(yl, yr, 3);
410                 EROUND(yr, yl, 4);
411                 EROUND(yl, yr, 5);
412                 EROUND(yr, yl, 6);
413                 EROUND(yl, yr, 7);
414                 EROUND(yr, yl, 8);
415                 EROUND(yl, yr, 9);
416                 EROUND(yr, yl, 10);
417                 EROUND(yl, yr, 11);
418                 EROUND(yr, yl, 12);
419                 EROUND(yl, yr, 13);
420                 EROUND(yr, yl, 14);
421                 EROUND(yl, yr, 15);
422                 yl ^= P[16];
423                 yr ^= P[17];
424
425                 /* calculate 3-bit checksumme */
426                 cs = yl ^ (yl>>3) ^ (yl>>6) ^ (yl>>9) ^ (yl>>12) ^ (yl>>15)
427                         ^ (yl>>18) ^ (yl>>21) ^ (yl>>24) ^ (yl>>27) ^ (yl>>30)
428                         ^ (yr<<2) ^ (yr>>1) ^ (yr>>4) ^ (yr>>7) ^ (yr>>10)
429                         ^ (yr>>13) ^ (yr>>16) ^ (yr>>19) ^ (yr>>22) ^ (yr>>25)
430                         ^ (yr>>28) ^ (yr>>31);
431
432                 /*
433                  * transcode 8 crypted bytes to 9 data bytes with sync
434                  * and checksum information
435                  */
436                 bf_crypt_out[0] = (yl>>25) | 0x80;
437                 bf_crypt_out[1] = (yl>>18) & 0x7f;
438                 bf_crypt_out[2] = (yl>>11) & 0x7f;
439                 bf_crypt_out[3] = (yl>>4) & 0x7f;
440                 bf_crypt_out[4] = ((yl<<3) & 0x78) | ((yr>>29) & 0x07);
441                 bf_crypt_out[5] = ((yr>>22) & 0x7f) | ((cs<<5) & 0x80);
442                 bf_crypt_out[6] = ((yr>>15) & 0x7f) | ((cs<<6) & 0x80);
443                 bf_crypt_out[7] = ((yr>>8) & 0x7f) | (cs<<7);
444                 bf_crypt_out[8] = yr;
445         }
446
447         /* write current count */
448         dsp->bf_crypt_pos = j;
449
450 }
451
452
453 /*
454  * decrypt isdn data frame
455  * every block with 9 bytes is decrypted
456  */
457 void
458 dsp_bf_decrypt(struct dsp *dsp, u8 *data, int len)
459 {
460         int i = 0;
461         u8 j = dsp->bf_decrypt_in_pos;
462         u8 k = dsp->bf_decrypt_out_pos;
463         u8 *bf_crypt_inring = dsp->bf_crypt_inring;
464         u8 *bf_data_out = dsp->bf_data_out;
465         u16 sync = dsp->bf_sync;
466         u32 *P = dsp->bf_p;
467         u32 *S = dsp->bf_s;
468         u32 yl, yr;
469         u8 nibble;
470         u8 cs, cs0, cs1, cs2;
471
472         while (i < len) {
473                 /*
474                  * shift upper bit and rotate data to buffer ring
475                  * send current decrypted data
476                  */
477                 sync = (sync<<1) | ((*data)>>7);
478                 bf_crypt_inring[j++ & 15] = *data;
479                 *data++ = bf_data_out[k++];
480                 i++;
481                 if (k == 9)
482                         k = 0; /* repeat if no sync has been found */
483                 /* check if not in sync */
484                 if ((sync&0x1f0) != 0x100)
485                         continue;
486                 j -= 9;
487                 /* transcode receive data to 64 bit block of encrypted data */
488                 yl = bf_crypt_inring[j++ & 15];
489                 yl = (yl<<7) | bf_crypt_inring[j++ & 15]; /* bit7 = 0 */
490                 yl = (yl<<7) | bf_crypt_inring[j++ & 15]; /* bit7 = 0 */
491                 yl = (yl<<7) | bf_crypt_inring[j++ & 15]; /* bit7 = 0 */
492                 nibble = bf_crypt_inring[j++ & 15]; /* bit7 = 0 */
493                 yr = nibble;
494                 yl = (yl<<4) | (nibble>>3);
495                 cs2 = bf_crypt_inring[j++ & 15];
496                 yr = (yr<<7) | (cs2 & 0x7f);
497                 cs1 = bf_crypt_inring[j++ & 15];
498                 yr = (yr<<7) | (cs1 & 0x7f);
499                 cs0 = bf_crypt_inring[j++ & 15];
500                 yr = (yr<<7) | (cs0 & 0x7f);
501                 yr = (yr<<8) | bf_crypt_inring[j++ & 15];
502
503                 /* calculate 3-bit checksumme */
504                 cs = yl ^ (yl>>3) ^ (yl>>6) ^ (yl>>9) ^ (yl>>12) ^ (yl>>15)
505                         ^ (yl>>18) ^ (yl>>21) ^ (yl>>24) ^ (yl>>27) ^ (yl>>30)
506                         ^ (yr<<2) ^ (yr>>1) ^ (yr>>4) ^ (yr>>7) ^ (yr>>10)
507                         ^ (yr>>13) ^ (yr>>16) ^ (yr>>19) ^ (yr>>22) ^ (yr>>25)
508                         ^ (yr>>28) ^ (yr>>31);
509
510                 /* check if frame is valid */
511                 if ((cs&0x7) != (((cs2>>5)&4) | ((cs1>>6)&2) | (cs0 >> 7))) {
512                         if (dsp_debug & DEBUG_DSP_BLOWFISH)
513                                 printk(KERN_DEBUG
514                                     "DSP BLOWFISH: received corrupt frame, "
515                                     "checksumme is not correct\n");
516                         continue;
517                 }
518
519                 /* decrypt */
520                 yr ^= P[17];
521                 yl ^= P[16];
522                 DROUND(yl, yr, 15);
523                 DROUND(yr, yl, 14);
524                 DROUND(yl, yr, 13);
525                 DROUND(yr, yl, 12);
526                 DROUND(yl, yr, 11);
527                 DROUND(yr, yl, 10);
528                 DROUND(yl, yr, 9);
529                 DROUND(yr, yl, 8);
530                 DROUND(yl, yr, 7);
531                 DROUND(yr, yl, 6);
532                 DROUND(yl, yr, 5);
533                 DROUND(yr, yl, 4);
534                 DROUND(yl, yr, 3);
535                 DROUND(yr, yl, 2);
536                 DROUND(yl, yr, 1);
537                 DROUND(yr, yl, 0);
538
539                 /* transcode 8 crypted bytes to 9 sample bytes */
540                 bf_data_out[0] = dsp_audio_seven2law[(yl>>25) & 0x7f];
541                 bf_data_out[1] = dsp_audio_seven2law[(yl>>18) & 0x7f];
542                 bf_data_out[2] = dsp_audio_seven2law[(yl>>11) & 0x7f];
543                 bf_data_out[3] = dsp_audio_seven2law[(yl>>4) & 0x7f];
544                 bf_data_out[4] = dsp_audio_seven2law[((yl<<3) & 0x78) |
545                     ((yr>>29) & 0x07)];
546
547                 bf_data_out[5] = dsp_audio_seven2law[(yr>>22) & 0x7f];
548                 bf_data_out[6] = dsp_audio_seven2law[(yr>>15) & 0x7f];
549                 bf_data_out[7] = dsp_audio_seven2law[(yr>>8) & 0x7f];
550                 bf_data_out[8] = dsp_audio_seven2law[(yr>>1) & 0x7f];
551                 k = 0; /* start with new decoded frame */
552         }
553
554         /* write current count and sync */
555         dsp->bf_decrypt_in_pos = j;
556         dsp->bf_decrypt_out_pos = k;
557         dsp->bf_sync = sync;
558 }
559
560
561 /* used to encrypt S and P boxes */
562 static inline void
563 encrypt_block(const u32 *P, const u32 *S, u32 *dst, u32 *src)
564 {
565         u32 yl = src[0];
566         u32 yr = src[1];
567
568         EROUND(yr, yl, 0);
569         EROUND(yl, yr, 1);
570         EROUND(yr, yl, 2);
571         EROUND(yl, yr, 3);
572         EROUND(yr, yl, 4);
573         EROUND(yl, yr, 5);
574         EROUND(yr, yl, 6);
575         EROUND(yl, yr, 7);
576         EROUND(yr, yl, 8);
577         EROUND(yl, yr, 9);
578         EROUND(yr, yl, 10);
579         EROUND(yl, yr, 11);
580         EROUND(yr, yl, 12);
581         EROUND(yl, yr, 13);
582         EROUND(yr, yl, 14);
583         EROUND(yl, yr, 15);
584
585         yl ^= P[16];
586         yr ^= P[17];
587
588         dst[0] = yr;
589         dst[1] = yl;
590 }
591
592 /*
593  * initialize the dsp for encryption and decryption using the same key
594  * Calculates the blowfish S and P boxes for encryption and decryption.
595  * The margin of keylen must be 4-56 bytes.
596  * returns 0 if ok.
597  */
598 int
599 dsp_bf_init(struct dsp *dsp, const u8 *key, uint keylen)
600 {
601         short i, j, count;
602         u32 data[2], temp;
603         u32 *P = (u32 *)dsp->bf_p;
604         u32 *S = (u32 *)dsp->bf_s;
605
606         if (keylen < 4 || keylen > 56)
607                 return 1;
608
609         /* Set dsp states */
610         i = 0;
611         while (i < 9) {
612                 dsp->bf_crypt_out[i] = 0xff;
613                 dsp->bf_data_out[i] = dsp_silence;
614                 i++;
615         }
616         dsp->bf_crypt_pos = 0;
617         dsp->bf_decrypt_in_pos = 0;
618         dsp->bf_decrypt_out_pos = 0;
619         dsp->bf_sync = 0x1ff;
620         dsp->bf_enable = 1;
621
622         /* Copy the initialization s-boxes */
623         for (i = 0, count = 0; i < 256; i++)
624                 for (j = 0; j < 4; j++, count++)
625                         S[count] = bf_sbox[count];
626
627         /* Set the p-boxes */
628         for (i = 0; i < 16 + 2; i++)
629                 P[i] = bf_pbox[i];
630
631         /* Actual subkey generation */
632         for (j = 0, i = 0; i < 16 + 2; i++) {
633                 temp = (((u32)key[j] << 24) |
634                     ((u32)key[(j + 1) % keylen] << 16) |
635                     ((u32)key[(j + 2) % keylen] << 8) |
636                     ((u32)key[(j + 3) % keylen]));
637
638                 P[i] = P[i] ^ temp;
639                 j = (j + 4) % keylen;
640         }
641
642         data[0] = 0x00000000;
643         data[1] = 0x00000000;
644
645         for (i = 0; i < 16 + 2; i += 2) {
646                 encrypt_block(P, S, data, data);
647
648                 P[i] = data[0];
649                 P[i + 1] = data[1];
650         }
651
652         for (i = 0; i < 4; i++) {
653                 for (j = 0, count = i * 256; j < 256; j += 2, count += 2) {
654                         encrypt_block(P, S, data, data);
655
656                         S[count] = data[0];
657                         S[count + 1] = data[1];
658                 }
659         }
660
661         return 0;
662 }
663
664
665 /*
666  * turn encryption off
667  */
668 void
669 dsp_bf_cleanup(struct dsp *dsp)
670 {
671         dsp->bf_enable = 0;
672 }