1
2
3
4
5
6#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
7
8#include <linux/crypto.h>
9#include <linux/init.h>
10#include <linux/module.h>
11#include <linux/mm.h>
12#include <linux/types.h>
13#include <crypto/algapi.h>
14
15#include <asm/fpumacro.h>
16#include <asm/pstate.h>
17#include <asm/elf.h>
18
19#include "opcodes.h"
20
21#define CAMELLIA_MIN_KEY_SIZE 16
22#define CAMELLIA_MAX_KEY_SIZE 32
23#define CAMELLIA_BLOCK_SIZE 16
24#define CAMELLIA_TABLE_BYTE_LEN 272
25
26struct camellia_sparc64_ctx {
27 u64 encrypt_key[CAMELLIA_TABLE_BYTE_LEN / sizeof(u64)];
28 u64 decrypt_key[CAMELLIA_TABLE_BYTE_LEN / sizeof(u64)];
29 int key_len;
30};
31
32extern void camellia_sparc64_key_expand(const u32 *in_key, u64 *encrypt_key,
33 unsigned int key_len, u64 *decrypt_key);
34
35static int camellia_set_key(struct crypto_tfm *tfm, const u8 *_in_key,
36 unsigned int key_len)
37{
38 struct camellia_sparc64_ctx *ctx = crypto_tfm_ctx(tfm);
39 const u32 *in_key = (const u32 *) _in_key;
40 u32 *flags = &tfm->crt_flags;
41
42 if (key_len != 16 && key_len != 24 && key_len != 32) {
43 *flags |= CRYPTO_TFM_RES_BAD_KEY_LEN;
44 return -EINVAL;
45 }
46
47 ctx->key_len = key_len;
48
49 camellia_sparc64_key_expand(in_key, &ctx->encrypt_key[0],
50 key_len, &ctx->decrypt_key[0]);
51 return 0;
52}
53
54extern void camellia_sparc64_crypt(const u64 *key, const u32 *input,
55 u32 *output, unsigned int key_len);
56
57static void camellia_encrypt(struct crypto_tfm *tfm, u8 *dst, const u8 *src)
58{
59 struct camellia_sparc64_ctx *ctx = crypto_tfm_ctx(tfm);
60
61 camellia_sparc64_crypt(&ctx->encrypt_key[0],
62 (const u32 *) src,
63 (u32 *) dst, ctx->key_len);
64}
65
66static void camellia_decrypt(struct crypto_tfm *tfm, u8 *dst, const u8 *src)
67{
68 struct camellia_sparc64_ctx *ctx = crypto_tfm_ctx(tfm);
69
70 camellia_sparc64_crypt(&ctx->decrypt_key[0],
71 (const u32 *) src,
72 (u32 *) dst, ctx->key_len);
73}
74
75extern void camellia_sparc64_load_keys(const u64 *key, unsigned int key_len);
76
77typedef void ecb_crypt_op(const u64 *input, u64 *output, unsigned int len,
78 const u64 *key);
79
80extern ecb_crypt_op camellia_sparc64_ecb_crypt_3_grand_rounds;
81extern ecb_crypt_op camellia_sparc64_ecb_crypt_4_grand_rounds;
82
83#define CAMELLIA_BLOCK_MASK (~(CAMELLIA_BLOCK_SIZE - 1))
84
85static int __ecb_crypt(struct blkcipher_desc *desc,
86 struct scatterlist *dst, struct scatterlist *src,
87 unsigned int nbytes, bool encrypt)
88{
89 struct camellia_sparc64_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
90 struct blkcipher_walk walk;
91 ecb_crypt_op *op;
92 const u64 *key;
93 int err;
94
95 op = camellia_sparc64_ecb_crypt_3_grand_rounds;
96 if (ctx->key_len != 16)
97 op = camellia_sparc64_ecb_crypt_4_grand_rounds;
98
99 blkcipher_walk_init(&walk, dst, src, nbytes);
100 err = blkcipher_walk_virt(desc, &walk);
101 desc->flags &= ~CRYPTO_TFM_REQ_MAY_SLEEP;
102
103 if (encrypt)
104 key = &ctx->encrypt_key[0];
105 else
106 key = &ctx->decrypt_key[0];
107 camellia_sparc64_load_keys(key, ctx->key_len);
108 while ((nbytes = walk.nbytes)) {
109 unsigned int block_len = nbytes & CAMELLIA_BLOCK_MASK;
110
111 if (likely(block_len)) {
112 const u64 *src64;
113 u64 *dst64;
114
115 src64 = (const u64 *)walk.src.virt.addr;
116 dst64 = (u64 *) walk.dst.virt.addr;
117 op(src64, dst64, block_len, key);
118 }
119 nbytes &= CAMELLIA_BLOCK_SIZE - 1;
120 err = blkcipher_walk_done(desc, &walk, nbytes);
121 }
122 fprs_write(0);
123 return err;
124}
125
126static int ecb_encrypt(struct blkcipher_desc *desc,
127 struct scatterlist *dst, struct scatterlist *src,
128 unsigned int nbytes)
129{
130 return __ecb_crypt(desc, dst, src, nbytes, true);
131}
132
133static int ecb_decrypt(struct blkcipher_desc *desc,
134 struct scatterlist *dst, struct scatterlist *src,
135 unsigned int nbytes)
136{
137 return __ecb_crypt(desc, dst, src, nbytes, false);
138}
139
140typedef void cbc_crypt_op(const u64 *input, u64 *output, unsigned int len,
141 const u64 *key, u64 *iv);
142
143extern cbc_crypt_op camellia_sparc64_cbc_encrypt_3_grand_rounds;
144extern cbc_crypt_op camellia_sparc64_cbc_encrypt_4_grand_rounds;
145extern cbc_crypt_op camellia_sparc64_cbc_decrypt_3_grand_rounds;
146extern cbc_crypt_op camellia_sparc64_cbc_decrypt_4_grand_rounds;
147
148static int cbc_encrypt(struct blkcipher_desc *desc,
149 struct scatterlist *dst, struct scatterlist *src,
150 unsigned int nbytes)
151{
152 struct camellia_sparc64_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
153 struct blkcipher_walk walk;
154 cbc_crypt_op *op;
155 const u64 *key;
156 int err;
157
158 op = camellia_sparc64_cbc_encrypt_3_grand_rounds;
159 if (ctx->key_len != 16)
160 op = camellia_sparc64_cbc_encrypt_4_grand_rounds;
161
162 blkcipher_walk_init(&walk, dst, src, nbytes);
163 err = blkcipher_walk_virt(desc, &walk);
164 desc->flags &= ~CRYPTO_TFM_REQ_MAY_SLEEP;
165
166 key = &ctx->encrypt_key[0];
167 camellia_sparc64_load_keys(key, ctx->key_len);
168 while ((nbytes = walk.nbytes)) {
169 unsigned int block_len = nbytes & CAMELLIA_BLOCK_MASK;
170
171 if (likely(block_len)) {
172 const u64 *src64;
173 u64 *dst64;
174
175 src64 = (const u64 *)walk.src.virt.addr;
176 dst64 = (u64 *) walk.dst.virt.addr;
177 op(src64, dst64, block_len, key,
178 (u64 *) walk.iv);
179 }
180 nbytes &= CAMELLIA_BLOCK_SIZE - 1;
181 err = blkcipher_walk_done(desc, &walk, nbytes);
182 }
183 fprs_write(0);
184 return err;
185}
186
187static int cbc_decrypt(struct blkcipher_desc *desc,
188 struct scatterlist *dst, struct scatterlist *src,
189 unsigned int nbytes)
190{
191 struct camellia_sparc64_ctx *ctx = crypto_blkcipher_ctx(desc->tfm);
192 struct blkcipher_walk walk;
193 cbc_crypt_op *op;
194 const u64 *key;
195 int err;
196
197 op = camellia_sparc64_cbc_decrypt_3_grand_rounds;
198 if (ctx->key_len != 16)
199 op = camellia_sparc64_cbc_decrypt_4_grand_rounds;
200
201 blkcipher_walk_init(&walk, dst, src, nbytes);
202 err = blkcipher_walk_virt(desc, &walk);
203 desc->flags &= ~CRYPTO_TFM_REQ_MAY_SLEEP;
204
205 key = &ctx->decrypt_key[0];
206 camellia_sparc64_load_keys(key, ctx->key_len);
207 while ((nbytes = walk.nbytes)) {
208 unsigned int block_len = nbytes & CAMELLIA_BLOCK_MASK;
209
210 if (likely(block_len)) {
211 const u64 *src64;
212 u64 *dst64;
213
214 src64 = (const u64 *)walk.src.virt.addr;
215 dst64 = (u64 *) walk.dst.virt.addr;
216 op(src64, dst64, block_len, key,
217 (u64 *) walk.iv);
218 }
219 nbytes &= CAMELLIA_BLOCK_SIZE - 1;
220 err = blkcipher_walk_done(desc, &walk, nbytes);
221 }
222 fprs_write(0);
223 return err;
224}
225
226static struct crypto_alg algs[] = { {
227 .cra_name = "camellia",
228 .cra_driver_name = "camellia-sparc64",
229 .cra_priority = SPARC_CR_OPCODE_PRIORITY,
230 .cra_flags = CRYPTO_ALG_TYPE_CIPHER,
231 .cra_blocksize = CAMELLIA_BLOCK_SIZE,
232 .cra_ctxsize = sizeof(struct camellia_sparc64_ctx),
233 .cra_alignmask = 3,
234 .cra_module = THIS_MODULE,
235 .cra_u = {
236 .cipher = {
237 .cia_min_keysize = CAMELLIA_MIN_KEY_SIZE,
238 .cia_max_keysize = CAMELLIA_MAX_KEY_SIZE,
239 .cia_setkey = camellia_set_key,
240 .cia_encrypt = camellia_encrypt,
241 .cia_decrypt = camellia_decrypt
242 }
243 }
244}, {
245 .cra_name = "ecb(camellia)",
246 .cra_driver_name = "ecb-camellia-sparc64",
247 .cra_priority = SPARC_CR_OPCODE_PRIORITY,
248 .cra_flags = CRYPTO_ALG_TYPE_BLKCIPHER,
249 .cra_blocksize = CAMELLIA_BLOCK_SIZE,
250 .cra_ctxsize = sizeof(struct camellia_sparc64_ctx),
251 .cra_alignmask = 7,
252 .cra_type = &crypto_blkcipher_type,
253 .cra_module = THIS_MODULE,
254 .cra_u = {
255 .blkcipher = {
256 .min_keysize = CAMELLIA_MIN_KEY_SIZE,
257 .max_keysize = CAMELLIA_MAX_KEY_SIZE,
258 .setkey = camellia_set_key,
259 .encrypt = ecb_encrypt,
260 .decrypt = ecb_decrypt,
261 },
262 },
263}, {
264 .cra_name = "cbc(camellia)",
265 .cra_driver_name = "cbc-camellia-sparc64",
266 .cra_priority = SPARC_CR_OPCODE_PRIORITY,
267 .cra_flags = CRYPTO_ALG_TYPE_BLKCIPHER,
268 .cra_blocksize = CAMELLIA_BLOCK_SIZE,
269 .cra_ctxsize = sizeof(struct camellia_sparc64_ctx),
270 .cra_alignmask = 7,
271 .cra_type = &crypto_blkcipher_type,
272 .cra_module = THIS_MODULE,
273 .cra_u = {
274 .blkcipher = {
275 .min_keysize = CAMELLIA_MIN_KEY_SIZE,
276 .max_keysize = CAMELLIA_MAX_KEY_SIZE,
277 .setkey = camellia_set_key,
278 .encrypt = cbc_encrypt,
279 .decrypt = cbc_decrypt,
280 },
281 },
282}
283};
284
285static bool __init sparc64_has_camellia_opcode(void)
286{
287 unsigned long cfr;
288
289 if (!(sparc64_elf_hwcap & HWCAP_SPARC_CRYPTO))
290 return false;
291
292 __asm__ __volatile__("rd %%asr26, %0" : "=r" (cfr));
293 if (!(cfr & CFR_CAMELLIA))
294 return false;
295
296 return true;
297}
298
299static int __init camellia_sparc64_mod_init(void)
300{
301 int i;
302
303 for (i = 0; i < ARRAY_SIZE(algs); i++)
304 INIT_LIST_HEAD(&algs[i].cra_list);
305
306 if (sparc64_has_camellia_opcode()) {
307 pr_info("Using sparc64 camellia opcodes optimized CAMELLIA implementation\n");
308 return crypto_register_algs(algs, ARRAY_SIZE(algs));
309 }
310 pr_info("sparc64 camellia opcodes not available.\n");
311 return -ENODEV;
312}
313
314static void __exit camellia_sparc64_mod_fini(void)
315{
316 crypto_unregister_algs(algs, ARRAY_SIZE(algs));
317}
318
319module_init(camellia_sparc64_mod_init);
320module_exit(camellia_sparc64_mod_fini);
321
322MODULE_LICENSE("GPL");
323MODULE_DESCRIPTION("Camellia Cipher Algorithm, sparc64 camellia opcode accelerated");
324
325MODULE_ALIAS("aes");
326
327#include "crop_devid.c"
328
