Linux Audio

Check our new training course

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