1
2
3
4
5
6
7
8#include "compat.h"
9#include "regs.h"
10#include "intern.h"
11#include "jr.h"
12#include "desc_constr.h"
13#include "error.h"
14#include "ctrl.h"
15
16static int caam_remove(struct platform_device *pdev)
17{
18 struct device *ctrldev;
19 struct caam_drv_private *ctrlpriv;
20 struct caam_drv_private_jr *jrpriv;
21 struct caam_full __iomem *topregs;
22 int ring, ret = 0;
23
24 ctrldev = &pdev->dev;
25 ctrlpriv = dev_get_drvdata(ctrldev);
26 topregs = (struct caam_full __iomem *)ctrlpriv->ctrl;
27
28
29 for (ring = 0; ring < ctrlpriv->total_jobrs; ring++) {
30 ret |= caam_jr_shutdown(ctrlpriv->jrdev[ring]);
31 jrpriv = dev_get_drvdata(ctrlpriv->jrdev[ring]);
32 irq_dispose_mapping(jrpriv->irq);
33 }
34
35
36#ifdef CONFIG_DEBUG_FS
37 debugfs_remove_recursive(ctrlpriv->dfs_root);
38#endif
39
40
41 iounmap(&topregs->ctrl);
42
43 kfree(ctrlpriv->jrdev);
44 kfree(ctrlpriv);
45
46 return ret;
47}
48
49
50
51
52
53static void build_instantiation_desc(u32 *desc)
54{
55 u32 *jump_cmd;
56
57 init_job_desc(desc, 0);
58
59
60 append_operation(desc, OP_TYPE_CLASS1_ALG | OP_ALG_ALGSEL_RNG |
61 OP_ALG_AS_INIT);
62
63
64 jump_cmd = append_jump(desc, JUMP_CLASS_CLASS1);
65 set_jump_tgt_here(desc, jump_cmd);
66
67
68
69
70
71 append_load_imm_u32(desc, 1, LDST_SRCDST_WORD_CLRW);
72
73
74 append_operation(desc, OP_TYPE_CLASS1_ALG | OP_ALG_ALGSEL_RNG |
75 OP_ALG_RNG4_SK);
76}
77
78struct instantiate_result {
79 struct completion completion;
80 int err;
81};
82
83static void rng4_init_done(struct device *dev, u32 *desc, u32 err,
84 void *context)
85{
86 struct instantiate_result *instantiation = context;
87
88 if (err) {
89 char tmp[CAAM_ERROR_STR_MAX];
90
91 dev_err(dev, "%08x: %s\n", err, caam_jr_strstatus(tmp, err));
92 }
93
94 instantiation->err = err;
95 complete(&instantiation->completion);
96}
97
98static int instantiate_rng(struct device *jrdev)
99{
100 struct instantiate_result instantiation;
101
102 dma_addr_t desc_dma;
103 u32 *desc;
104 int ret;
105
106 desc = kmalloc(CAAM_CMD_SZ * 6, GFP_KERNEL | GFP_DMA);
107 if (!desc) {
108 dev_err(jrdev, "cannot allocate RNG init descriptor memory\n");
109 return -ENOMEM;
110 }
111
112 build_instantiation_desc(desc);
113 desc_dma = dma_map_single(jrdev, desc, desc_bytes(desc), DMA_TO_DEVICE);
114 init_completion(&instantiation.completion);
115 ret = caam_jr_enqueue(jrdev, desc, rng4_init_done, &instantiation);
116 if (!ret) {
117 wait_for_completion_interruptible(&instantiation.completion);
118 ret = instantiation.err;
119 if (ret)
120 dev_err(jrdev, "unable to instantiate RNG\n");
121 }
122
123 dma_unmap_single(jrdev, desc_dma, desc_bytes(desc), DMA_TO_DEVICE);
124
125 kfree(desc);
126
127 return ret;
128}
129
130
131
132
133
134static void kick_trng(struct platform_device *pdev)
135{
136 struct device *ctrldev = &pdev->dev;
137 struct caam_drv_private *ctrlpriv = dev_get_drvdata(ctrldev);
138 struct caam_full __iomem *topregs;
139 struct rng4tst __iomem *r4tst;
140 u32 val;
141
142 topregs = (struct caam_full __iomem *)ctrlpriv->ctrl;
143 r4tst = &topregs->ctrl.r4tst[0];
144
145
146 setbits32(&r4tst->rtmctl, RTMCTL_PRGM);
147
148 val = rd_reg32(&r4tst->rtsdctl);
149 val = (val & ~RTSDCTL_ENT_DLY_MASK) | (1600 << RTSDCTL_ENT_DLY_SHIFT);
150 wr_reg32(&r4tst->rtsdctl, val);
151
152 wr_reg32(&r4tst->rtfrqmin, 400);
153
154 wr_reg32(&r4tst->rtfrqmax, 6400);
155
156 clrbits32(&r4tst->rtmctl, RTMCTL_PRGM);
157}
158
159
160
161
162
163
164
165int caam_get_era(u64 caam_id)
166{
167 struct sec_vid *sec_vid = (struct sec_vid *)&caam_id;
168 static const struct {
169 u16 ip_id;
170 u8 maj_rev;
171 u8 era;
172 } caam_eras[] = {
173 {0x0A10, 1, 1},
174 {0x0A10, 2, 2},
175 {0x0A12, 1, 3},
176 {0x0A14, 1, 3},
177 {0x0A14, 2, 4},
178 {0x0A16, 1, 4},
179 {0x0A11, 1, 4}
180 };
181 int i;
182
183 for (i = 0; i < ARRAY_SIZE(caam_eras); i++)
184 if (caam_eras[i].ip_id == sec_vid->ip_id &&
185 caam_eras[i].maj_rev == sec_vid->maj_rev)
186 return caam_eras[i].era;
187
188 return -ENOTSUPP;
189}
190EXPORT_SYMBOL(caam_get_era);
191
192
193static int caam_probe(struct platform_device *pdev)
194{
195 int ret, ring, rspec;
196 u64 caam_id;
197 struct device *dev;
198 struct device_node *nprop, *np;
199 struct caam_ctrl __iomem *ctrl;
200 struct caam_full __iomem *topregs;
201 struct caam_drv_private *ctrlpriv;
202#ifdef CONFIG_DEBUG_FS
203 struct caam_perfmon *perfmon;
204#endif
205
206 ctrlpriv = kzalloc(sizeof(struct caam_drv_private), GFP_KERNEL);
207 if (!ctrlpriv)
208 return -ENOMEM;
209
210 dev = &pdev->dev;
211 dev_set_drvdata(dev, ctrlpriv);
212 ctrlpriv->pdev = pdev;
213 nprop = pdev->dev.of_node;
214
215
216
217 ctrl = of_iomap(nprop, 0);
218 if (ctrl == NULL) {
219 dev_err(dev, "caam: of_iomap() failed\n");
220 return -ENOMEM;
221 }
222 ctrlpriv->ctrl = (struct caam_ctrl __force *)ctrl;
223
224
225 topregs = (struct caam_full __iomem *)ctrl;
226
227
228 ctrlpriv->secvio_irq = of_irq_to_resource(nprop, 0, NULL);
229
230
231
232
233
234 setbits32(&topregs->ctrl.mcr, MCFGR_WDENABLE |
235 (sizeof(dma_addr_t) == sizeof(u64) ? MCFGR_LONG_PTR : 0));
236
237 if (sizeof(dma_addr_t) == sizeof(u64))
238 if (of_device_is_compatible(nprop, "fsl,sec-v5.0"))
239 dma_set_mask(dev, DMA_BIT_MASK(40));
240 else
241 dma_set_mask(dev, DMA_BIT_MASK(36));
242 else
243 dma_set_mask(dev, DMA_BIT_MASK(32));
244
245
246
247
248
249
250 rspec = 0;
251 for_each_compatible_node(np, NULL, "fsl,sec-v4.0-job-ring")
252 rspec++;
253 if (!rspec) {
254
255 for_each_compatible_node(np, NULL, "fsl,sec4.0-job-ring")
256 rspec++;
257 }
258
259 ctrlpriv->jrdev = kzalloc(sizeof(struct device *) * rspec, GFP_KERNEL);
260 if (ctrlpriv->jrdev == NULL) {
261 iounmap(&topregs->ctrl);
262 return -ENOMEM;
263 }
264
265 ring = 0;
266 ctrlpriv->total_jobrs = 0;
267 for_each_compatible_node(np, NULL, "fsl,sec-v4.0-job-ring") {
268 caam_jr_probe(pdev, np, ring);
269 ctrlpriv->total_jobrs++;
270 ring++;
271 }
272 if (!ring) {
273 for_each_compatible_node(np, NULL, "fsl,sec4.0-job-ring") {
274 caam_jr_probe(pdev, np, ring);
275 ctrlpriv->total_jobrs++;
276 ring++;
277 }
278 }
279
280
281 ctrlpriv->qi_present = !!(rd_reg64(&topregs->ctrl.perfmon.comp_parms) &
282 CTPR_QI_MASK);
283 if (ctrlpriv->qi_present) {
284 ctrlpriv->qi = (struct caam_queue_if __force *)&topregs->qi;
285
286 wr_reg32(&topregs->qi.qi_control_lo, QICTL_DQEN);
287 }
288
289
290 if ((!ctrlpriv->qi_present) && (!ctrlpriv->total_jobrs)) {
291 dev_err(dev, "no queues configured, terminating\n");
292 caam_remove(pdev);
293 return -ENOMEM;
294 }
295
296
297
298
299
300 if (of_device_is_compatible(nprop, "fsl,sec-v5.0")) {
301 kick_trng(pdev);
302 ret = instantiate_rng(ctrlpriv->jrdev[0]);
303 if (ret) {
304 caam_remove(pdev);
305 return ret;
306 }
307 }
308
309
310
311
312 spin_lock_init(&ctrlpriv->jr_alloc_lock);
313
314 caam_id = rd_reg64(&topregs->ctrl.perfmon.caam_id);
315
316
317 dev_info(dev, "device ID = 0x%016llx (Era %d)\n", caam_id,
318 caam_get_era(caam_id));
319 dev_info(dev, "job rings = %d, qi = %d\n",
320 ctrlpriv->total_jobrs, ctrlpriv->qi_present);
321
322#ifdef CONFIG_DEBUG_FS
323
324
325
326
327
328 perfmon = (struct caam_perfmon __force *)&ctrl->perfmon;
329
330 ctrlpriv->dfs_root = debugfs_create_dir("caam", NULL);
331 ctrlpriv->ctl = debugfs_create_dir("ctl", ctrlpriv->dfs_root);
332
333
334 ctrlpriv->ctl_rq_dequeued =
335 debugfs_create_u64("rq_dequeued",
336 S_IRUSR | S_IRGRP | S_IROTH,
337 ctrlpriv->ctl, &perfmon->req_dequeued);
338 ctrlpriv->ctl_ob_enc_req =
339 debugfs_create_u64("ob_rq_encrypted",
340 S_IRUSR | S_IRGRP | S_IROTH,
341 ctrlpriv->ctl, &perfmon->ob_enc_req);
342 ctrlpriv->ctl_ib_dec_req =
343 debugfs_create_u64("ib_rq_decrypted",
344 S_IRUSR | S_IRGRP | S_IROTH,
345 ctrlpriv->ctl, &perfmon->ib_dec_req);
346 ctrlpriv->ctl_ob_enc_bytes =
347 debugfs_create_u64("ob_bytes_encrypted",
348 S_IRUSR | S_IRGRP | S_IROTH,
349 ctrlpriv->ctl, &perfmon->ob_enc_bytes);
350 ctrlpriv->ctl_ob_prot_bytes =
351 debugfs_create_u64("ob_bytes_protected",
352 S_IRUSR | S_IRGRP | S_IROTH,
353 ctrlpriv->ctl, &perfmon->ob_prot_bytes);
354 ctrlpriv->ctl_ib_dec_bytes =
355 debugfs_create_u64("ib_bytes_decrypted",
356 S_IRUSR | S_IRGRP | S_IROTH,
357 ctrlpriv->ctl, &perfmon->ib_dec_bytes);
358 ctrlpriv->ctl_ib_valid_bytes =
359 debugfs_create_u64("ib_bytes_validated",
360 S_IRUSR | S_IRGRP | S_IROTH,
361 ctrlpriv->ctl, &perfmon->ib_valid_bytes);
362
363
364 ctrlpriv->ctl_faultaddr =
365 debugfs_create_u64("fault_addr",
366 S_IRUSR | S_IRGRP | S_IROTH,
367 ctrlpriv->ctl, &perfmon->faultaddr);
368 ctrlpriv->ctl_faultdetail =
369 debugfs_create_u32("fault_detail",
370 S_IRUSR | S_IRGRP | S_IROTH,
371 ctrlpriv->ctl, &perfmon->faultdetail);
372 ctrlpriv->ctl_faultstatus =
373 debugfs_create_u32("fault_status",
374 S_IRUSR | S_IRGRP | S_IROTH,
375 ctrlpriv->ctl, &perfmon->status);
376
377
378 ctrlpriv->ctl_kek_wrap.data = &ctrlpriv->ctrl->kek[0];
379 ctrlpriv->ctl_kek_wrap.size = KEK_KEY_SIZE * sizeof(u32);
380 ctrlpriv->ctl_kek = debugfs_create_blob("kek",
381 S_IRUSR |
382 S_IRGRP | S_IROTH,
383 ctrlpriv->ctl,
384 &ctrlpriv->ctl_kek_wrap);
385
386 ctrlpriv->ctl_tkek_wrap.data = &ctrlpriv->ctrl->tkek[0];
387 ctrlpriv->ctl_tkek_wrap.size = KEK_KEY_SIZE * sizeof(u32);
388 ctrlpriv->ctl_tkek = debugfs_create_blob("tkek",
389 S_IRUSR |
390 S_IRGRP | S_IROTH,
391 ctrlpriv->ctl,
392 &ctrlpriv->ctl_tkek_wrap);
393
394 ctrlpriv->ctl_tdsk_wrap.data = &ctrlpriv->ctrl->tdsk[0];
395 ctrlpriv->ctl_tdsk_wrap.size = KEK_KEY_SIZE * sizeof(u32);
396 ctrlpriv->ctl_tdsk = debugfs_create_blob("tdsk",
397 S_IRUSR |
398 S_IRGRP | S_IROTH,
399 ctrlpriv->ctl,
400 &ctrlpriv->ctl_tdsk_wrap);
401#endif
402 return 0;
403}
404
405static struct of_device_id caam_match[] = {
406 {
407 .compatible = "fsl,sec-v4.0",
408 },
409 {
410 .compatible = "fsl,sec4.0",
411 },
412 {},
413};
414MODULE_DEVICE_TABLE(of, caam_match);
415
416static struct platform_driver caam_driver = {
417 .driver = {
418 .name = "caam",
419 .owner = THIS_MODULE,
420 .of_match_table = caam_match,
421 },
422 .probe = caam_probe,
423 .remove = caam_remove,
424};
425
426module_platform_driver(caam_driver);
427
428MODULE_LICENSE("GPL");
429MODULE_DESCRIPTION("FSL CAAM request backend");
430MODULE_AUTHOR("Freescale Semiconductor - NMG/STC");
431