1
2
3
4
5
6
7#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
8
9#include <linux/crypto.h>
10#include <linux/init.h>
11#include <linux/module.h>
12#include <linux/mm.h>
13#include <linux/types.h>
14#include <crypto/algapi.h>
15#include <crypto/internal/des.h>
16#include <crypto/internal/skcipher.h>
17
18#include <asm/fpumacro.h>
19#include <asm/pstate.h>
20#include <asm/elf.h>
21
22#include "opcodes.h"
23
24struct des_sparc64_ctx {
25 u64 encrypt_expkey[DES_EXPKEY_WORDS / 2];
26 u64 decrypt_expkey[DES_EXPKEY_WORDS / 2];
27};
28
29struct des3_ede_sparc64_ctx {
30 u64 encrypt_expkey[DES3_EDE_EXPKEY_WORDS / 2];
31 u64 decrypt_expkey[DES3_EDE_EXPKEY_WORDS / 2];
32};
33
34static void encrypt_to_decrypt(u64 *d, const u64 *e)
35{
36 const u64 *s = e + (DES_EXPKEY_WORDS / 2) - 1;
37 int i;
38
39 for (i = 0; i < DES_EXPKEY_WORDS / 2; i++)
40 *d++ = *s--;
41}
42
43extern void des_sparc64_key_expand(const u32 *input_key, u64 *key);
44
45static int des_set_key(struct crypto_tfm *tfm, const u8 *key,
46 unsigned int keylen)
47{
48 struct des_sparc64_ctx *dctx = crypto_tfm_ctx(tfm);
49 int err;
50
51
52
53
54
55 err = crypto_des_verify_key(tfm, key);
56 if (err)
57 return err;
58
59 des_sparc64_key_expand((const u32 *) key, &dctx->encrypt_expkey[0]);
60 encrypt_to_decrypt(&dctx->decrypt_expkey[0], &dctx->encrypt_expkey[0]);
61
62 return 0;
63}
64
65static int des_set_key_skcipher(struct crypto_skcipher *tfm, const u8 *key,
66 unsigned int keylen)
67{
68 return des_set_key(crypto_skcipher_tfm(tfm), key, keylen);
69}
70
71extern void des_sparc64_crypt(const u64 *key, const u64 *input,
72 u64 *output);
73
74static void sparc_des_encrypt(struct crypto_tfm *tfm, u8 *dst, const u8 *src)
75{
76 struct des_sparc64_ctx *ctx = crypto_tfm_ctx(tfm);
77 const u64 *K = ctx->encrypt_expkey;
78
79 des_sparc64_crypt(K, (const u64 *) src, (u64 *) dst);
80}
81
82static void sparc_des_decrypt(struct crypto_tfm *tfm, u8 *dst, const u8 *src)
83{
84 struct des_sparc64_ctx *ctx = crypto_tfm_ctx(tfm);
85 const u64 *K = ctx->decrypt_expkey;
86
87 des_sparc64_crypt(K, (const u64 *) src, (u64 *) dst);
88}
89
90extern void des_sparc64_load_keys(const u64 *key);
91
92extern void des_sparc64_ecb_crypt(const u64 *input, u64 *output,
93 unsigned int len);
94
95static int __ecb_crypt(struct skcipher_request *req, bool encrypt)
96{
97 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
98 const struct des_sparc64_ctx *ctx = crypto_skcipher_ctx(tfm);
99 struct skcipher_walk walk;
100 unsigned int nbytes;
101 int err;
102
103 err = skcipher_walk_virt(&walk, req, true);
104 if (err)
105 return err;
106
107 if (encrypt)
108 des_sparc64_load_keys(&ctx->encrypt_expkey[0]);
109 else
110 des_sparc64_load_keys(&ctx->decrypt_expkey[0]);
111 while ((nbytes = walk.nbytes) != 0) {
112 des_sparc64_ecb_crypt(walk.src.virt.addr, walk.dst.virt.addr,
113 round_down(nbytes, DES_BLOCK_SIZE));
114 err = skcipher_walk_done(&walk, nbytes % DES_BLOCK_SIZE);
115 }
116 fprs_write(0);
117 return err;
118}
119
120static int ecb_encrypt(struct skcipher_request *req)
121{
122 return __ecb_crypt(req, true);
123}
124
125static int ecb_decrypt(struct skcipher_request *req)
126{
127 return __ecb_crypt(req, false);
128}
129
130extern void des_sparc64_cbc_encrypt(const u64 *input, u64 *output,
131 unsigned int len, u64 *iv);
132
133extern void des_sparc64_cbc_decrypt(const u64 *input, u64 *output,
134 unsigned int len, u64 *iv);
135
136static int __cbc_crypt(struct skcipher_request *req, bool encrypt)
137{
138 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
139 const struct des_sparc64_ctx *ctx = crypto_skcipher_ctx(tfm);
140 struct skcipher_walk walk;
141 unsigned int nbytes;
142 int err;
143
144 err = skcipher_walk_virt(&walk, req, true);
145 if (err)
146 return err;
147
148 if (encrypt)
149 des_sparc64_load_keys(&ctx->encrypt_expkey[0]);
150 else
151 des_sparc64_load_keys(&ctx->decrypt_expkey[0]);
152 while ((nbytes = walk.nbytes) != 0) {
153 if (encrypt)
154 des_sparc64_cbc_encrypt(walk.src.virt.addr,
155 walk.dst.virt.addr,
156 round_down(nbytes,
157 DES_BLOCK_SIZE),
158 walk.iv);
159 else
160 des_sparc64_cbc_decrypt(walk.src.virt.addr,
161 walk.dst.virt.addr,
162 round_down(nbytes,
163 DES_BLOCK_SIZE),
164 walk.iv);
165 err = skcipher_walk_done(&walk, nbytes % DES_BLOCK_SIZE);
166 }
167 fprs_write(0);
168 return err;
169}
170
171static int cbc_encrypt(struct skcipher_request *req)
172{
173 return __cbc_crypt(req, true);
174}
175
176static int cbc_decrypt(struct skcipher_request *req)
177{
178 return __cbc_crypt(req, false);
179}
180
181static int des3_ede_set_key(struct crypto_tfm *tfm, const u8 *key,
182 unsigned int keylen)
183{
184 struct des3_ede_sparc64_ctx *dctx = crypto_tfm_ctx(tfm);
185 u64 k1[DES_EXPKEY_WORDS / 2];
186 u64 k2[DES_EXPKEY_WORDS / 2];
187 u64 k3[DES_EXPKEY_WORDS / 2];
188 int err;
189
190 err = crypto_des3_ede_verify_key(tfm, key);
191 if (err)
192 return err;
193
194 des_sparc64_key_expand((const u32 *)key, k1);
195 key += DES_KEY_SIZE;
196 des_sparc64_key_expand((const u32 *)key, k2);
197 key += DES_KEY_SIZE;
198 des_sparc64_key_expand((const u32 *)key, k3);
199
200 memcpy(&dctx->encrypt_expkey[0], &k1[0], sizeof(k1));
201 encrypt_to_decrypt(&dctx->encrypt_expkey[DES_EXPKEY_WORDS / 2], &k2[0]);
202 memcpy(&dctx->encrypt_expkey[(DES_EXPKEY_WORDS / 2) * 2],
203 &k3[0], sizeof(k3));
204
205 encrypt_to_decrypt(&dctx->decrypt_expkey[0], &k3[0]);
206 memcpy(&dctx->decrypt_expkey[DES_EXPKEY_WORDS / 2],
207 &k2[0], sizeof(k2));
208 encrypt_to_decrypt(&dctx->decrypt_expkey[(DES_EXPKEY_WORDS / 2) * 2],
209 &k1[0]);
210
211 return 0;
212}
213
214static int des3_ede_set_key_skcipher(struct crypto_skcipher *tfm, const u8 *key,
215 unsigned int keylen)
216{
217 return des3_ede_set_key(crypto_skcipher_tfm(tfm), key, keylen);
218}
219
220extern void des3_ede_sparc64_crypt(const u64 *key, const u64 *input,
221 u64 *output);
222
223static void sparc_des3_ede_encrypt(struct crypto_tfm *tfm, u8 *dst, const u8 *src)
224{
225 struct des3_ede_sparc64_ctx *ctx = crypto_tfm_ctx(tfm);
226 const u64 *K = ctx->encrypt_expkey;
227
228 des3_ede_sparc64_crypt(K, (const u64 *) src, (u64 *) dst);
229}
230
231static void sparc_des3_ede_decrypt(struct crypto_tfm *tfm, u8 *dst, const u8 *src)
232{
233 struct des3_ede_sparc64_ctx *ctx = crypto_tfm_ctx(tfm);
234 const u64 *K = ctx->decrypt_expkey;
235
236 des3_ede_sparc64_crypt(K, (const u64 *) src, (u64 *) dst);
237}
238
239extern void des3_ede_sparc64_load_keys(const u64 *key);
240
241extern void des3_ede_sparc64_ecb_crypt(const u64 *expkey, const u64 *input,
242 u64 *output, unsigned int len);
243
244static int __ecb3_crypt(struct skcipher_request *req, bool encrypt)
245{
246 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
247 const struct des3_ede_sparc64_ctx *ctx = crypto_skcipher_ctx(tfm);
248 struct skcipher_walk walk;
249 const u64 *K;
250 unsigned int nbytes;
251 int err;
252
253 err = skcipher_walk_virt(&walk, req, true);
254 if (err)
255 return err;
256
257 if (encrypt)
258 K = &ctx->encrypt_expkey[0];
259 else
260 K = &ctx->decrypt_expkey[0];
261 des3_ede_sparc64_load_keys(K);
262 while ((nbytes = walk.nbytes) != 0) {
263 des3_ede_sparc64_ecb_crypt(K, walk.src.virt.addr,
264 walk.dst.virt.addr,
265 round_down(nbytes, DES_BLOCK_SIZE));
266 err = skcipher_walk_done(&walk, nbytes % DES_BLOCK_SIZE);
267 }
268 fprs_write(0);
269 return err;
270}
271
272static int ecb3_encrypt(struct skcipher_request *req)
273{
274 return __ecb3_crypt(req, true);
275}
276
277static int ecb3_decrypt(struct skcipher_request *req)
278{
279 return __ecb3_crypt(req, false);
280}
281
282extern void des3_ede_sparc64_cbc_encrypt(const u64 *expkey, const u64 *input,
283 u64 *output, unsigned int len,
284 u64 *iv);
285
286extern void des3_ede_sparc64_cbc_decrypt(const u64 *expkey, const u64 *input,
287 u64 *output, unsigned int len,
288 u64 *iv);
289
290static int __cbc3_crypt(struct skcipher_request *req, bool encrypt)
291{
292 struct crypto_skcipher *tfm = crypto_skcipher_reqtfm(req);
293 const struct des3_ede_sparc64_ctx *ctx = crypto_skcipher_ctx(tfm);
294 struct skcipher_walk walk;
295 const u64 *K;
296 unsigned int nbytes;
297 int err;
298
299 err = skcipher_walk_virt(&walk, req, true);
300 if (err)
301 return err;
302
303 if (encrypt)
304 K = &ctx->encrypt_expkey[0];
305 else
306 K = &ctx->decrypt_expkey[0];
307 des3_ede_sparc64_load_keys(K);
308 while ((nbytes = walk.nbytes) != 0) {
309 if (encrypt)
310 des3_ede_sparc64_cbc_encrypt(K, walk.src.virt.addr,
311 walk.dst.virt.addr,
312 round_down(nbytes,
313 DES_BLOCK_SIZE),
314 walk.iv);
315 else
316 des3_ede_sparc64_cbc_decrypt(K, walk.src.virt.addr,
317 walk.dst.virt.addr,
318 round_down(nbytes,
319 DES_BLOCK_SIZE),
320 walk.iv);
321 err = skcipher_walk_done(&walk, nbytes % DES_BLOCK_SIZE);
322 }
323 fprs_write(0);
324 return err;
325}
326
327static int cbc3_encrypt(struct skcipher_request *req)
328{
329 return __cbc3_crypt(req, true);
330}
331
332static int cbc3_decrypt(struct skcipher_request *req)
333{
334 return __cbc3_crypt(req, false);
335}
336
337static struct crypto_alg cipher_algs[] = {
338 {
339 .cra_name = "des",
340 .cra_driver_name = "des-sparc64",
341 .cra_priority = SPARC_CR_OPCODE_PRIORITY,
342 .cra_flags = CRYPTO_ALG_TYPE_CIPHER,
343 .cra_blocksize = DES_BLOCK_SIZE,
344 .cra_ctxsize = sizeof(struct des_sparc64_ctx),
345 .cra_alignmask = 7,
346 .cra_module = THIS_MODULE,
347 .cra_u = {
348 .cipher = {
349 .cia_min_keysize = DES_KEY_SIZE,
350 .cia_max_keysize = DES_KEY_SIZE,
351 .cia_setkey = des_set_key,
352 .cia_encrypt = sparc_des_encrypt,
353 .cia_decrypt = sparc_des_decrypt
354 }
355 }
356 }, {
357 .cra_name = "des3_ede",
358 .cra_driver_name = "des3_ede-sparc64",
359 .cra_priority = SPARC_CR_OPCODE_PRIORITY,
360 .cra_flags = CRYPTO_ALG_TYPE_CIPHER,
361 .cra_blocksize = DES3_EDE_BLOCK_SIZE,
362 .cra_ctxsize = sizeof(struct des3_ede_sparc64_ctx),
363 .cra_alignmask = 7,
364 .cra_module = THIS_MODULE,
365 .cra_u = {
366 .cipher = {
367 .cia_min_keysize = DES3_EDE_KEY_SIZE,
368 .cia_max_keysize = DES3_EDE_KEY_SIZE,
369 .cia_setkey = des3_ede_set_key,
370 .cia_encrypt = sparc_des3_ede_encrypt,
371 .cia_decrypt = sparc_des3_ede_decrypt
372 }
373 }
374 }
375};
376
377static struct skcipher_alg skcipher_algs[] = {
378 {
379 .base.cra_name = "ecb(des)",
380 .base.cra_driver_name = "ecb-des-sparc64",
381 .base.cra_priority = SPARC_CR_OPCODE_PRIORITY,
382 .base.cra_blocksize = DES_BLOCK_SIZE,
383 .base.cra_ctxsize = sizeof(struct des_sparc64_ctx),
384 .base.cra_alignmask = 7,
385 .base.cra_module = THIS_MODULE,
386 .min_keysize = DES_KEY_SIZE,
387 .max_keysize = DES_KEY_SIZE,
388 .setkey = des_set_key_skcipher,
389 .encrypt = ecb_encrypt,
390 .decrypt = ecb_decrypt,
391 }, {
392 .base.cra_name = "cbc(des)",
393 .base.cra_driver_name = "cbc-des-sparc64",
394 .base.cra_priority = SPARC_CR_OPCODE_PRIORITY,
395 .base.cra_blocksize = DES_BLOCK_SIZE,
396 .base.cra_ctxsize = sizeof(struct des_sparc64_ctx),
397 .base.cra_alignmask = 7,
398 .base.cra_module = THIS_MODULE,
399 .min_keysize = DES_KEY_SIZE,
400 .max_keysize = DES_KEY_SIZE,
401 .ivsize = DES_BLOCK_SIZE,
402 .setkey = des_set_key_skcipher,
403 .encrypt = cbc_encrypt,
404 .decrypt = cbc_decrypt,
405 }, {
406 .base.cra_name = "ecb(des3_ede)",
407 .base.cra_driver_name = "ecb-des3_ede-sparc64",
408 .base.cra_priority = SPARC_CR_OPCODE_PRIORITY,
409 .base.cra_blocksize = DES3_EDE_BLOCK_SIZE,
410 .base.cra_ctxsize = sizeof(struct des3_ede_sparc64_ctx),
411 .base.cra_alignmask = 7,
412 .base.cra_module = THIS_MODULE,
413 .min_keysize = DES3_EDE_KEY_SIZE,
414 .max_keysize = DES3_EDE_KEY_SIZE,
415 .setkey = des3_ede_set_key_skcipher,
416 .encrypt = ecb3_encrypt,
417 .decrypt = ecb3_decrypt,
418 }, {
419 .base.cra_name = "cbc(des3_ede)",
420 .base.cra_driver_name = "cbc-des3_ede-sparc64",
421 .base.cra_priority = SPARC_CR_OPCODE_PRIORITY,
422 .base.cra_blocksize = DES3_EDE_BLOCK_SIZE,
423 .base.cra_ctxsize = sizeof(struct des3_ede_sparc64_ctx),
424 .base.cra_alignmask = 7,
425 .base.cra_module = THIS_MODULE,
426 .min_keysize = DES3_EDE_KEY_SIZE,
427 .max_keysize = DES3_EDE_KEY_SIZE,
428 .ivsize = DES3_EDE_BLOCK_SIZE,
429 .setkey = des3_ede_set_key_skcipher,
430 .encrypt = cbc3_encrypt,
431 .decrypt = cbc3_decrypt,
432 }
433};
434
435static bool __init sparc64_has_des_opcode(void)
436{
437 unsigned long cfr;
438
439 if (!(sparc64_elf_hwcap & HWCAP_SPARC_CRYPTO))
440 return false;
441
442 __asm__ __volatile__("rd %%asr26, %0" : "=r" (cfr));
443 if (!(cfr & CFR_DES))
444 return false;
445
446 return true;
447}
448
449static int __init des_sparc64_mod_init(void)
450{
451 int err;
452
453 if (!sparc64_has_des_opcode()) {
454 pr_info("sparc64 des opcodes not available.\n");
455 return -ENODEV;
456 }
457 pr_info("Using sparc64 des opcodes optimized DES implementation\n");
458 err = crypto_register_algs(cipher_algs, ARRAY_SIZE(cipher_algs));
459 if (err)
460 return err;
461 err = crypto_register_skciphers(skcipher_algs,
462 ARRAY_SIZE(skcipher_algs));
463 if (err)
464 crypto_unregister_algs(cipher_algs, ARRAY_SIZE(cipher_algs));
465 return err;
466}
467
468static void __exit des_sparc64_mod_fini(void)
469{
470 crypto_unregister_algs(cipher_algs, ARRAY_SIZE(cipher_algs));
471 crypto_unregister_skciphers(skcipher_algs, ARRAY_SIZE(skcipher_algs));
472}
473
474module_init(des_sparc64_mod_init);
475module_exit(des_sparc64_mod_fini);
476
477MODULE_LICENSE("GPL");
478MODULE_DESCRIPTION("DES & Triple DES EDE Cipher Algorithms, sparc64 des opcode accelerated");
479
480MODULE_ALIAS_CRYPTO("des");
481MODULE_ALIAS_CRYPTO("des3_ede");
482
483#include "crop_devid.c"
484
