xref: /linux/drivers/crypto/ccree/cc_driver.c (revision e7edfb41)
1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (C) 2012-2019 ARM Limited or its affiliates. */
3 
4 #include <linux/kernel.h>
5 #include <linux/module.h>
6 
7 #include <linux/crypto.h>
8 #include <linux/moduleparam.h>
9 #include <linux/types.h>
10 #include <linux/interrupt.h>
11 #include <linux/platform_device.h>
12 #include <linux/slab.h>
13 #include <linux/spinlock.h>
14 #include <linux/of.h>
15 #include <linux/clk.h>
16 #include <linux/of_address.h>
17 #include <linux/pm_runtime.h>
18 
19 #include "cc_driver.h"
20 #include "cc_request_mgr.h"
21 #include "cc_buffer_mgr.h"
22 #include "cc_debugfs.h"
23 #include "cc_cipher.h"
24 #include "cc_aead.h"
25 #include "cc_hash.h"
26 #include "cc_sram_mgr.h"
27 #include "cc_pm.h"
28 #include "cc_fips.h"
29 
30 bool cc_dump_desc;
31 module_param_named(dump_desc, cc_dump_desc, bool, 0600);
32 MODULE_PARM_DESC(cc_dump_desc, "Dump descriptors to kernel log as debugging aid");
33 bool cc_dump_bytes;
34 module_param_named(dump_bytes, cc_dump_bytes, bool, 0600);
35 MODULE_PARM_DESC(cc_dump_bytes, "Dump buffers to kernel log as debugging aid");
36 
37 static bool cc_sec_disable;
38 module_param_named(sec_disable, cc_sec_disable, bool, 0600);
39 MODULE_PARM_DESC(cc_sec_disable, "Disable security functions");
40 
41 struct cc_hw_data {
42 	char *name;
43 	enum cc_hw_rev rev;
44 	u32 sig;
45 	u32 cidr_0123;
46 	u32 pidr_0124;
47 	int std_bodies;
48 };
49 
50 #define CC_NUM_IDRS 4
51 #define CC_HW_RESET_LOOP_COUNT 10
52 
53 /* Note: PIDR3 holds CMOD/Rev so ignored for HW identification purposes */
54 static const u32 pidr_0124_offsets[CC_NUM_IDRS] = {
55 	CC_REG(PERIPHERAL_ID_0), CC_REG(PERIPHERAL_ID_1),
56 	CC_REG(PERIPHERAL_ID_2), CC_REG(PERIPHERAL_ID_4)
57 };
58 
59 static const u32 cidr_0123_offsets[CC_NUM_IDRS] = {
60 	CC_REG(COMPONENT_ID_0), CC_REG(COMPONENT_ID_1),
61 	CC_REG(COMPONENT_ID_2), CC_REG(COMPONENT_ID_3)
62 };
63 
64 /* Hardware revisions defs. */
65 
66 /* The 703 is a OSCCA only variant of the 713 */
67 static const struct cc_hw_data cc703_hw = {
68 	.name = "703", .rev = CC_HW_REV_713, .cidr_0123 = 0xB105F00DU,
69 	.pidr_0124 = 0x040BB0D0U, .std_bodies = CC_STD_OSCCA
70 };
71 
72 static const struct cc_hw_data cc713_hw = {
73 	.name = "713", .rev = CC_HW_REV_713, .cidr_0123 = 0xB105F00DU,
74 	.pidr_0124 = 0x040BB0D0U, .std_bodies = CC_STD_ALL
75 };
76 
77 static const struct cc_hw_data cc712_hw = {
78 	.name = "712", .rev = CC_HW_REV_712, .sig =  0xDCC71200U,
79 	.std_bodies = CC_STD_ALL
80 };
81 
82 static const struct cc_hw_data cc710_hw = {
83 	.name = "710", .rev = CC_HW_REV_710, .sig =  0xDCC63200U,
84 	.std_bodies = CC_STD_ALL
85 };
86 
87 static const struct cc_hw_data cc630p_hw = {
88 	.name = "630P", .rev = CC_HW_REV_630, .sig = 0xDCC63000U,
89 	.std_bodies = CC_STD_ALL
90 };
91 
92 static const struct of_device_id arm_ccree_dev_of_match[] = {
93 	{ .compatible = "arm,cryptocell-703-ree", .data = &cc703_hw },
94 	{ .compatible = "arm,cryptocell-713-ree", .data = &cc713_hw },
95 	{ .compatible = "arm,cryptocell-712-ree", .data = &cc712_hw },
96 	{ .compatible = "arm,cryptocell-710-ree", .data = &cc710_hw },
97 	{ .compatible = "arm,cryptocell-630p-ree", .data = &cc630p_hw },
98 	{}
99 };
100 MODULE_DEVICE_TABLE(of, arm_ccree_dev_of_match);
101 
init_cc_cache_params(struct cc_drvdata * drvdata)102 static void init_cc_cache_params(struct cc_drvdata *drvdata)
103 {
104 	struct device *dev = drvdata_to_dev(drvdata);
105 	u32 cache_params, ace_const, val;
106 	u64 mask;
107 
108 	/* compute CC_AXIM_CACHE_PARAMS */
109 	cache_params = cc_ioread(drvdata, CC_REG(AXIM_CACHE_PARAMS));
110 	dev_dbg(dev, "Cache params previous: 0x%08X\n", cache_params);
111 
112 	/* non cached or write-back, write allocate */
113 	val = drvdata->coherent ? 0xb : 0x2;
114 
115 	mask = CC_GENMASK(CC_AXIM_CACHE_PARAMS_AWCACHE);
116 	cache_params &= ~mask;
117 	cache_params |= FIELD_PREP(mask, val);
118 
119 	mask = CC_GENMASK(CC_AXIM_CACHE_PARAMS_AWCACHE_LAST);
120 	cache_params &= ~mask;
121 	cache_params |= FIELD_PREP(mask, val);
122 
123 	mask = CC_GENMASK(CC_AXIM_CACHE_PARAMS_ARCACHE);
124 	cache_params &= ~mask;
125 	cache_params |= FIELD_PREP(mask, val);
126 
127 	drvdata->cache_params = cache_params;
128 
129 	dev_dbg(dev, "Cache params current: 0x%08X\n", cache_params);
130 
131 	if (drvdata->hw_rev <= CC_HW_REV_710)
132 		return;
133 
134 	/* compute CC_AXIM_ACE_CONST */
135 	ace_const = cc_ioread(drvdata, CC_REG(AXIM_ACE_CONST));
136 	dev_dbg(dev, "ACE-const previous: 0x%08X\n", ace_const);
137 
138 	/* system or outer-sharable */
139 	val = drvdata->coherent ? 0x2 : 0x3;
140 
141 	mask = CC_GENMASK(CC_AXIM_ACE_CONST_ARDOMAIN);
142 	ace_const &= ~mask;
143 	ace_const |= FIELD_PREP(mask, val);
144 
145 	mask = CC_GENMASK(CC_AXIM_ACE_CONST_AWDOMAIN);
146 	ace_const &= ~mask;
147 	ace_const |= FIELD_PREP(mask, val);
148 
149 	dev_dbg(dev, "ACE-const current: 0x%08X\n", ace_const);
150 
151 	drvdata->ace_const = ace_const;
152 }
153 
cc_read_idr(struct cc_drvdata * drvdata,const u32 * idr_offsets)154 static u32 cc_read_idr(struct cc_drvdata *drvdata, const u32 *idr_offsets)
155 {
156 	int i;
157 	union {
158 		u8 regs[CC_NUM_IDRS];
159 		__le32 val;
160 	} idr;
161 
162 	for (i = 0; i < CC_NUM_IDRS; ++i)
163 		idr.regs[i] = cc_ioread(drvdata, idr_offsets[i]);
164 
165 	return le32_to_cpu(idr.val);
166 }
167 
__dump_byte_array(const char * name,const u8 * buf,size_t len)168 void __dump_byte_array(const char *name, const u8 *buf, size_t len)
169 {
170 	char prefix[64];
171 
172 	if (!buf)
173 		return;
174 
175 	snprintf(prefix, sizeof(prefix), "%s[%zu]: ", name, len);
176 
177 	print_hex_dump(KERN_DEBUG, prefix, DUMP_PREFIX_ADDRESS, 16, 1, buf,
178 		       len, false);
179 }
180 
cc_isr(int irq,void * dev_id)181 static irqreturn_t cc_isr(int irq, void *dev_id)
182 {
183 	struct cc_drvdata *drvdata = (struct cc_drvdata *)dev_id;
184 	struct device *dev = drvdata_to_dev(drvdata);
185 	u32 irr;
186 	u32 imr;
187 
188 	/* STAT_OP_TYPE_GENERIC STAT_PHASE_0: Interrupt */
189 	/* if driver suspended return, probably shared interrupt */
190 	if (pm_runtime_suspended(dev))
191 		return IRQ_NONE;
192 
193 	/* read the interrupt status */
194 	irr = cc_ioread(drvdata, CC_REG(HOST_IRR));
195 	dev_dbg(dev, "Got IRR=0x%08X\n", irr);
196 
197 	if (irr == 0) /* Probably shared interrupt line */
198 		return IRQ_NONE;
199 
200 	imr = cc_ioread(drvdata, CC_REG(HOST_IMR));
201 
202 	/* clear interrupt - must be before processing events */
203 	cc_iowrite(drvdata, CC_REG(HOST_ICR), irr);
204 
205 	drvdata->irq = irr;
206 	/* Completion interrupt - most probable */
207 	if (irr & drvdata->comp_mask) {
208 		/* Mask all completion interrupts - will be unmasked in
209 		 * deferred service handler
210 		 */
211 		cc_iowrite(drvdata, CC_REG(HOST_IMR), imr | drvdata->comp_mask);
212 		irr &= ~drvdata->comp_mask;
213 		complete_request(drvdata);
214 	}
215 #ifdef CONFIG_CRYPTO_FIPS
216 	/* TEE FIPS interrupt */
217 	if (irr & CC_GPR0_IRQ_MASK) {
218 		/* Mask interrupt - will be unmasked in Deferred service
219 		 * handler
220 		 */
221 		cc_iowrite(drvdata, CC_REG(HOST_IMR), imr | CC_GPR0_IRQ_MASK);
222 		irr &= ~CC_GPR0_IRQ_MASK;
223 		fips_handler(drvdata);
224 	}
225 #endif
226 	/* AXI error interrupt */
227 	if (irr & CC_AXI_ERR_IRQ_MASK) {
228 		u32 axi_err;
229 
230 		/* Read the AXI error ID */
231 		axi_err = cc_ioread(drvdata, CC_REG(AXIM_MON_ERR));
232 		dev_dbg(dev, "AXI completion error: axim_mon_err=0x%08X\n",
233 			axi_err);
234 
235 		irr &= ~CC_AXI_ERR_IRQ_MASK;
236 	}
237 
238 	if (irr) {
239 		dev_dbg_ratelimited(dev, "IRR includes unknown cause bits (0x%08X)\n",
240 				    irr);
241 		/* Just warning */
242 	}
243 
244 	return IRQ_HANDLED;
245 }
246 
cc_wait_for_reset_completion(struct cc_drvdata * drvdata)247 bool cc_wait_for_reset_completion(struct cc_drvdata *drvdata)
248 {
249 	unsigned int val;
250 	unsigned int i;
251 
252 	/* 712/710/63 has no reset completion indication, always return true */
253 	if (drvdata->hw_rev <= CC_HW_REV_712)
254 		return true;
255 
256 	for (i = 0; i < CC_HW_RESET_LOOP_COUNT; i++) {
257 		/* in cc7x3 NVM_IS_IDLE indicates that CC reset is
258 		 *  completed and device is fully functional
259 		 */
260 		val = cc_ioread(drvdata, CC_REG(NVM_IS_IDLE));
261 		if (val & CC_NVM_IS_IDLE_MASK) {
262 			/* hw indicate reset completed */
263 			return true;
264 		}
265 		/* allow scheduling other process on the processor */
266 		schedule();
267 	}
268 	/* reset not completed */
269 	return false;
270 }
271 
init_cc_regs(struct cc_drvdata * drvdata)272 int init_cc_regs(struct cc_drvdata *drvdata)
273 {
274 	unsigned int val;
275 	struct device *dev = drvdata_to_dev(drvdata);
276 
277 	/* Unmask all AXI interrupt sources AXI_CFG1 register   */
278 	/* AXI interrupt config are obsoleted startign at cc7x3 */
279 	if (drvdata->hw_rev <= CC_HW_REV_712) {
280 		val = cc_ioread(drvdata, CC_REG(AXIM_CFG));
281 		cc_iowrite(drvdata, CC_REG(AXIM_CFG), val & ~CC_AXI_IRQ_MASK);
282 		dev_dbg(dev, "AXIM_CFG=0x%08X\n",
283 			cc_ioread(drvdata, CC_REG(AXIM_CFG)));
284 	}
285 
286 	/* Clear all pending interrupts */
287 	val = cc_ioread(drvdata, CC_REG(HOST_IRR));
288 	dev_dbg(dev, "IRR=0x%08X\n", val);
289 	cc_iowrite(drvdata, CC_REG(HOST_ICR), val);
290 
291 	/* Unmask relevant interrupt cause */
292 	val = drvdata->comp_mask | CC_AXI_ERR_IRQ_MASK;
293 
294 	if (drvdata->hw_rev >= CC_HW_REV_712)
295 		val |= CC_GPR0_IRQ_MASK;
296 
297 	cc_iowrite(drvdata, CC_REG(HOST_IMR), ~val);
298 
299 	cc_iowrite(drvdata, CC_REG(AXIM_CACHE_PARAMS), drvdata->cache_params);
300 	if (drvdata->hw_rev >= CC_HW_REV_712)
301 		cc_iowrite(drvdata, CC_REG(AXIM_ACE_CONST), drvdata->ace_const);
302 
303 	return 0;
304 }
305 
init_cc_resources(struct platform_device * plat_dev)306 static int init_cc_resources(struct platform_device *plat_dev)
307 {
308 	struct resource *req_mem_cc_regs = NULL;
309 	struct cc_drvdata *new_drvdata;
310 	struct device *dev = &plat_dev->dev;
311 	struct device_node *np = dev->of_node;
312 	u32 val, hw_rev_pidr, sig_cidr;
313 	u64 dma_mask;
314 	const struct cc_hw_data *hw_rev;
315 	struct clk *clk;
316 	int irq;
317 	int rc = 0;
318 
319 	new_drvdata = devm_kzalloc(dev, sizeof(*new_drvdata), GFP_KERNEL);
320 	if (!new_drvdata)
321 		return -ENOMEM;
322 
323 	hw_rev = of_device_get_match_data(dev);
324 	new_drvdata->hw_rev_name = hw_rev->name;
325 	new_drvdata->hw_rev = hw_rev->rev;
326 	new_drvdata->std_bodies = hw_rev->std_bodies;
327 
328 	if (hw_rev->rev >= CC_HW_REV_712) {
329 		new_drvdata->axim_mon_offset = CC_REG(AXIM_MON_COMP);
330 		new_drvdata->sig_offset = CC_REG(HOST_SIGNATURE_712);
331 		new_drvdata->ver_offset = CC_REG(HOST_VERSION_712);
332 	} else {
333 		new_drvdata->axim_mon_offset = CC_REG(AXIM_MON_COMP8);
334 		new_drvdata->sig_offset = CC_REG(HOST_SIGNATURE_630);
335 		new_drvdata->ver_offset = CC_REG(HOST_VERSION_630);
336 	}
337 
338 	new_drvdata->comp_mask = CC_COMP_IRQ_MASK;
339 
340 	platform_set_drvdata(plat_dev, new_drvdata);
341 	new_drvdata->plat_dev = plat_dev;
342 
343 	clk = devm_clk_get_optional(dev, NULL);
344 	if (IS_ERR(clk))
345 		return dev_err_probe(dev, PTR_ERR(clk), "Error getting clock\n");
346 	new_drvdata->clk = clk;
347 
348 	new_drvdata->coherent = of_dma_is_coherent(np);
349 
350 	/* Get device resources */
351 	/* First CC registers space */
352 	/* Map registers space */
353 	new_drvdata->cc_base = devm_platform_get_and_ioremap_resource(plat_dev,
354 								      0, &req_mem_cc_regs);
355 	if (IS_ERR(new_drvdata->cc_base))
356 		return PTR_ERR(new_drvdata->cc_base);
357 
358 	dev_dbg(dev, "Got MEM resource (%s): %pR\n", req_mem_cc_regs->name,
359 		req_mem_cc_regs);
360 	dev_dbg(dev, "CC registers mapped from %pa to 0x%p\n",
361 		&req_mem_cc_regs->start, new_drvdata->cc_base);
362 
363 	/* Then IRQ */
364 	irq = platform_get_irq(plat_dev, 0);
365 	if (irq < 0)
366 		return irq;
367 
368 	init_completion(&new_drvdata->hw_queue_avail);
369 
370 	if (!dev->dma_mask)
371 		dev->dma_mask = &dev->coherent_dma_mask;
372 
373 	dma_mask = DMA_BIT_MASK(DMA_BIT_MASK_LEN);
374 	rc = dma_set_coherent_mask(dev, dma_mask);
375 	if (rc) {
376 		dev_err(dev, "Failed in dma_set_coherent_mask, mask=%llx\n",
377 			dma_mask);
378 		return rc;
379 	}
380 
381 	rc = clk_prepare_enable(new_drvdata->clk);
382 	if (rc) {
383 		dev_err(dev, "Failed to enable clock");
384 		return rc;
385 	}
386 
387 	new_drvdata->sec_disabled = cc_sec_disable;
388 
389 	pm_runtime_set_autosuspend_delay(dev, CC_SUSPEND_TIMEOUT);
390 	pm_runtime_use_autosuspend(dev);
391 	pm_runtime_set_active(dev);
392 	pm_runtime_enable(dev);
393 	rc = pm_runtime_get_sync(dev);
394 	if (rc < 0) {
395 		dev_err(dev, "pm_runtime_get_sync() failed: %d\n", rc);
396 		goto post_pm_err;
397 	}
398 
399 	/* Wait for Cryptocell reset completion */
400 	if (!cc_wait_for_reset_completion(new_drvdata)) {
401 		dev_err(dev, "Cryptocell reset not completed");
402 	}
403 
404 	if (hw_rev->rev <= CC_HW_REV_712) {
405 		/* Verify correct mapping */
406 		val = cc_ioread(new_drvdata, new_drvdata->sig_offset);
407 		if (val != hw_rev->sig) {
408 			dev_err(dev, "Invalid CC signature: SIGNATURE=0x%08X != expected=0x%08X\n",
409 				val, hw_rev->sig);
410 			rc = -EINVAL;
411 			goto post_pm_err;
412 		}
413 		sig_cidr = val;
414 		hw_rev_pidr = cc_ioread(new_drvdata, new_drvdata->ver_offset);
415 	} else {
416 		/* Verify correct mapping */
417 		val = cc_read_idr(new_drvdata, pidr_0124_offsets);
418 		if (val != hw_rev->pidr_0124) {
419 			dev_err(dev, "Invalid CC PIDR: PIDR0124=0x%08X != expected=0x%08X\n",
420 				val,  hw_rev->pidr_0124);
421 			rc = -EINVAL;
422 			goto post_pm_err;
423 		}
424 		hw_rev_pidr = val;
425 
426 		val = cc_read_idr(new_drvdata, cidr_0123_offsets);
427 		if (val != hw_rev->cidr_0123) {
428 			dev_err(dev, "Invalid CC CIDR: CIDR0123=0x%08X != expected=0x%08X\n",
429 			val,  hw_rev->cidr_0123);
430 			rc = -EINVAL;
431 			goto post_pm_err;
432 		}
433 		sig_cidr = val;
434 
435 		/* Check HW engine configuration */
436 		val = cc_ioread(new_drvdata, CC_REG(HOST_REMOVE_INPUT_PINS));
437 		switch (val) {
438 		case CC_PINS_FULL:
439 			/* This is fine */
440 			break;
441 		case CC_PINS_SLIM:
442 			if (new_drvdata->std_bodies & CC_STD_NIST) {
443 				dev_warn(dev, "703 mode forced due to HW configuration.\n");
444 				new_drvdata->std_bodies = CC_STD_OSCCA;
445 			}
446 			break;
447 		default:
448 			dev_err(dev, "Unsupported engines configuration.\n");
449 			rc = -EINVAL;
450 			goto post_pm_err;
451 		}
452 
453 		/* Check security disable state */
454 		val = cc_ioread(new_drvdata, CC_REG(SECURITY_DISABLED));
455 		val &= CC_SECURITY_DISABLED_MASK;
456 		new_drvdata->sec_disabled |= !!val;
457 
458 		if (!new_drvdata->sec_disabled) {
459 			new_drvdata->comp_mask |= CC_CPP_SM4_ABORT_MASK;
460 			if (new_drvdata->std_bodies & CC_STD_NIST)
461 				new_drvdata->comp_mask |= CC_CPP_AES_ABORT_MASK;
462 		}
463 	}
464 
465 	if (new_drvdata->sec_disabled)
466 		dev_info(dev, "Security Disabled mode is in effect. Security functions disabled.\n");
467 
468 	/* Display HW versions */
469 	dev_info(dev, "ARM CryptoCell %s Driver: HW version 0x%08X/0x%8X, Driver version %s\n",
470 		 hw_rev->name, hw_rev_pidr, sig_cidr, DRV_MODULE_VERSION);
471 	/* register the driver isr function */
472 	rc = devm_request_irq(dev, irq, cc_isr, IRQF_SHARED, "ccree",
473 			      new_drvdata);
474 	if (rc) {
475 		dev_err(dev, "Could not register to interrupt %d\n", irq);
476 		goto post_pm_err;
477 	}
478 	dev_dbg(dev, "Registered to IRQ: %d\n", irq);
479 
480 	init_cc_cache_params(new_drvdata);
481 
482 	rc = init_cc_regs(new_drvdata);
483 	if (rc) {
484 		dev_err(dev, "init_cc_regs failed\n");
485 		goto post_pm_err;
486 	}
487 
488 	rc = cc_debugfs_init(new_drvdata);
489 	if (rc) {
490 		dev_err(dev, "Failed registering debugfs interface\n");
491 		goto post_regs_err;
492 	}
493 
494 	rc = cc_fips_init(new_drvdata);
495 	if (rc) {
496 		dev_err(dev, "cc_fips_init failed 0x%x\n", rc);
497 		goto post_debugfs_err;
498 	}
499 	rc = cc_sram_mgr_init(new_drvdata);
500 	if (rc) {
501 		dev_err(dev, "cc_sram_mgr_init failed\n");
502 		goto post_fips_init_err;
503 	}
504 
505 	new_drvdata->mlli_sram_addr =
506 		cc_sram_alloc(new_drvdata, MAX_MLLI_BUFF_SIZE);
507 	if (new_drvdata->mlli_sram_addr == NULL_SRAM_ADDR) {
508 		rc = -ENOMEM;
509 		goto post_fips_init_err;
510 	}
511 
512 	rc = cc_req_mgr_init(new_drvdata);
513 	if (rc) {
514 		dev_err(dev, "cc_req_mgr_init failed\n");
515 		goto post_fips_init_err;
516 	}
517 
518 	rc = cc_buffer_mgr_init(new_drvdata);
519 	if (rc) {
520 		dev_err(dev, "cc_buffer_mgr_init failed\n");
521 		goto post_req_mgr_err;
522 	}
523 
524 	/* hash must be allocated first due to use of send_request_init()
525 	 * and dependency of AEAD on it
526 	 */
527 	rc = cc_hash_alloc(new_drvdata);
528 	if (rc) {
529 		dev_err(dev, "cc_hash_alloc failed\n");
530 		goto post_buf_mgr_err;
531 	}
532 
533 	/* Allocate crypto algs */
534 	rc = cc_cipher_alloc(new_drvdata);
535 	if (rc) {
536 		dev_err(dev, "cc_cipher_alloc failed\n");
537 		goto post_hash_err;
538 	}
539 
540 	rc = cc_aead_alloc(new_drvdata);
541 	if (rc) {
542 		dev_err(dev, "cc_aead_alloc failed\n");
543 		goto post_cipher_err;
544 	}
545 
546 	/* If we got here and FIPS mode is enabled
547 	 * it means all FIPS test passed, so let TEE
548 	 * know we're good.
549 	 */
550 	cc_set_ree_fips_status(new_drvdata, true);
551 
552 	pm_runtime_put(dev);
553 	return 0;
554 
555 post_cipher_err:
556 	cc_cipher_free(new_drvdata);
557 post_hash_err:
558 	cc_hash_free(new_drvdata);
559 post_buf_mgr_err:
560 	 cc_buffer_mgr_fini(new_drvdata);
561 post_req_mgr_err:
562 	cc_req_mgr_fini(new_drvdata);
563 post_fips_init_err:
564 	cc_fips_fini(new_drvdata);
565 post_debugfs_err:
566 	cc_debugfs_fini(new_drvdata);
567 post_regs_err:
568 	fini_cc_regs(new_drvdata);
569 post_pm_err:
570 	pm_runtime_put_noidle(dev);
571 	pm_runtime_disable(dev);
572 	pm_runtime_set_suspended(dev);
573 	clk_disable_unprepare(new_drvdata->clk);
574 	return rc;
575 }
576 
fini_cc_regs(struct cc_drvdata * drvdata)577 void fini_cc_regs(struct cc_drvdata *drvdata)
578 {
579 	/* Mask all interrupts */
580 	cc_iowrite(drvdata, CC_REG(HOST_IMR), 0xFFFFFFFF);
581 }
582 
cleanup_cc_resources(struct platform_device * plat_dev)583 static void cleanup_cc_resources(struct platform_device *plat_dev)
584 {
585 	struct device *dev = &plat_dev->dev;
586 	struct cc_drvdata *drvdata =
587 		(struct cc_drvdata *)platform_get_drvdata(plat_dev);
588 
589 	cc_aead_free(drvdata);
590 	cc_cipher_free(drvdata);
591 	cc_hash_free(drvdata);
592 	cc_buffer_mgr_fini(drvdata);
593 	cc_req_mgr_fini(drvdata);
594 	cc_fips_fini(drvdata);
595 	cc_debugfs_fini(drvdata);
596 	fini_cc_regs(drvdata);
597 	pm_runtime_put_noidle(dev);
598 	pm_runtime_disable(dev);
599 	pm_runtime_set_suspended(dev);
600 	clk_disable_unprepare(drvdata->clk);
601 }
602 
cc_get_default_hash_len(struct cc_drvdata * drvdata)603 unsigned int cc_get_default_hash_len(struct cc_drvdata *drvdata)
604 {
605 	if (drvdata->hw_rev >= CC_HW_REV_712)
606 		return HASH_LEN_SIZE_712;
607 	else
608 		return HASH_LEN_SIZE_630;
609 }
610 
ccree_probe(struct platform_device * plat_dev)611 static int ccree_probe(struct platform_device *plat_dev)
612 {
613 	int rc;
614 	struct device *dev = &plat_dev->dev;
615 
616 	/* Map registers space */
617 	rc = init_cc_resources(plat_dev);
618 	if (rc)
619 		return rc;
620 
621 	dev_info(dev, "ARM ccree device initialized\n");
622 
623 	return 0;
624 }
625 
ccree_remove(struct platform_device * plat_dev)626 static void ccree_remove(struct platform_device *plat_dev)
627 {
628 	struct device *dev = &plat_dev->dev;
629 
630 	dev_dbg(dev, "Releasing ccree resources...\n");
631 
632 	cleanup_cc_resources(plat_dev);
633 
634 	dev_info(dev, "ARM ccree device terminated\n");
635 }
636 
637 static struct platform_driver ccree_driver = {
638 	.driver = {
639 		   .name = "ccree",
640 		   .of_match_table = arm_ccree_dev_of_match,
641 #ifdef CONFIG_PM
642 		   .pm = &ccree_pm,
643 #endif
644 	},
645 	.probe = ccree_probe,
646 	.remove_new = ccree_remove,
647 };
648 
ccree_init(void)649 static int __init ccree_init(void)
650 {
651 	int rc;
652 
653 	cc_debugfs_global_init();
654 
655 	rc = platform_driver_register(&ccree_driver);
656 	if (rc) {
657 		cc_debugfs_global_fini();
658 		return rc;
659 	}
660 
661 	return 0;
662 }
663 module_init(ccree_init);
664 
ccree_exit(void)665 static void __exit ccree_exit(void)
666 {
667 	platform_driver_unregister(&ccree_driver);
668 	cc_debugfs_global_fini();
669 }
670 module_exit(ccree_exit);
671 
672 /* Module description */
673 MODULE_DESCRIPTION("ARM TrustZone CryptoCell REE Driver");
674 MODULE_VERSION(DRV_MODULE_VERSION);
675 MODULE_AUTHOR("ARM");
676 MODULE_LICENSE("GPL v2");
677