.. | .. |
---|
1 | 1 | // SPDX-License-Identifier: GPL-2.0 |
---|
2 | | -/* Copyright (C) 2012-2018 ARM Limited or its affiliates. */ |
---|
| 2 | +/* Copyright (C) 2012-2019 ARM Limited or its affiliates. */ |
---|
3 | 3 | |
---|
4 | 4 | #include <linux/kernel.h> |
---|
5 | 5 | #include <linux/module.h> |
---|
.. | .. |
---|
14 | 14 | #include <linux/of.h> |
---|
15 | 15 | #include <linux/clk.h> |
---|
16 | 16 | #include <linux/of_address.h> |
---|
| 17 | +#include <linux/of_device.h> |
---|
| 18 | +#include <linux/pm_runtime.h> |
---|
17 | 19 | |
---|
18 | 20 | #include "cc_driver.h" |
---|
19 | 21 | #include "cc_request_mgr.h" |
---|
.. | .. |
---|
22 | 24 | #include "cc_cipher.h" |
---|
23 | 25 | #include "cc_aead.h" |
---|
24 | 26 | #include "cc_hash.h" |
---|
25 | | -#include "cc_ivgen.h" |
---|
26 | 27 | #include "cc_sram_mgr.h" |
---|
27 | 28 | #include "cc_pm.h" |
---|
28 | 29 | #include "cc_fips.h" |
---|
.. | .. |
---|
30 | 31 | bool cc_dump_desc; |
---|
31 | 32 | module_param_named(dump_desc, cc_dump_desc, bool, 0600); |
---|
32 | 33 | MODULE_PARM_DESC(cc_dump_desc, "Dump descriptors to kernel log as debugging aid"); |
---|
33 | | - |
---|
34 | 34 | bool cc_dump_bytes; |
---|
35 | 35 | module_param_named(dump_bytes, cc_dump_bytes, bool, 0600); |
---|
36 | 36 | MODULE_PARM_DESC(cc_dump_bytes, "Dump buffers to kernel log as debugging aid"); |
---|
| 37 | + |
---|
| 38 | +static bool cc_sec_disable; |
---|
| 39 | +module_param_named(sec_disable, cc_sec_disable, bool, 0600); |
---|
| 40 | +MODULE_PARM_DESC(cc_sec_disable, "Disable security functions"); |
---|
37 | 41 | |
---|
38 | 42 | struct cc_hw_data { |
---|
39 | 43 | char *name; |
---|
40 | 44 | enum cc_hw_rev rev; |
---|
41 | 45 | u32 sig; |
---|
| 46 | + u32 cidr_0123; |
---|
| 47 | + u32 pidr_0124; |
---|
| 48 | + int std_bodies; |
---|
| 49 | +}; |
---|
| 50 | + |
---|
| 51 | +#define CC_NUM_IDRS 4 |
---|
| 52 | +#define CC_HW_RESET_LOOP_COUNT 10 |
---|
| 53 | + |
---|
| 54 | +/* Note: PIDR3 holds CMOD/Rev so ignored for HW identification purposes */ |
---|
| 55 | +static const u32 pidr_0124_offsets[CC_NUM_IDRS] = { |
---|
| 56 | + CC_REG(PERIPHERAL_ID_0), CC_REG(PERIPHERAL_ID_1), |
---|
| 57 | + CC_REG(PERIPHERAL_ID_2), CC_REG(PERIPHERAL_ID_4) |
---|
| 58 | +}; |
---|
| 59 | + |
---|
| 60 | +static const u32 cidr_0123_offsets[CC_NUM_IDRS] = { |
---|
| 61 | + CC_REG(COMPONENT_ID_0), CC_REG(COMPONENT_ID_1), |
---|
| 62 | + CC_REG(COMPONENT_ID_2), CC_REG(COMPONENT_ID_3) |
---|
42 | 63 | }; |
---|
43 | 64 | |
---|
44 | 65 | /* Hardware revisions defs. */ |
---|
45 | 66 | |
---|
| 67 | +/* The 703 is a OSCCA only variant of the 713 */ |
---|
| 68 | +static const struct cc_hw_data cc703_hw = { |
---|
| 69 | + .name = "703", .rev = CC_HW_REV_713, .cidr_0123 = 0xB105F00DU, |
---|
| 70 | + .pidr_0124 = 0x040BB0D0U, .std_bodies = CC_STD_OSCCA |
---|
| 71 | +}; |
---|
| 72 | + |
---|
| 73 | +static const struct cc_hw_data cc713_hw = { |
---|
| 74 | + .name = "713", .rev = CC_HW_REV_713, .cidr_0123 = 0xB105F00DU, |
---|
| 75 | + .pidr_0124 = 0x040BB0D0U, .std_bodies = CC_STD_ALL |
---|
| 76 | +}; |
---|
| 77 | + |
---|
46 | 78 | static const struct cc_hw_data cc712_hw = { |
---|
47 | | - .name = "712", .rev = CC_HW_REV_712, .sig = 0xDCC71200U |
---|
| 79 | + .name = "712", .rev = CC_HW_REV_712, .sig = 0xDCC71200U, |
---|
| 80 | + .std_bodies = CC_STD_ALL |
---|
48 | 81 | }; |
---|
49 | 82 | |
---|
50 | 83 | static const struct cc_hw_data cc710_hw = { |
---|
51 | | - .name = "710", .rev = CC_HW_REV_710, .sig = 0xDCC63200U |
---|
| 84 | + .name = "710", .rev = CC_HW_REV_710, .sig = 0xDCC63200U, |
---|
| 85 | + .std_bodies = CC_STD_ALL |
---|
52 | 86 | }; |
---|
53 | 87 | |
---|
54 | 88 | static const struct cc_hw_data cc630p_hw = { |
---|
55 | | - .name = "630P", .rev = CC_HW_REV_630, .sig = 0xDCC63000U |
---|
| 89 | + .name = "630P", .rev = CC_HW_REV_630, .sig = 0xDCC63000U, |
---|
| 90 | + .std_bodies = CC_STD_ALL |
---|
56 | 91 | }; |
---|
57 | 92 | |
---|
58 | 93 | static const struct of_device_id arm_ccree_dev_of_match[] = { |
---|
| 94 | + { .compatible = "arm,cryptocell-703-ree", .data = &cc703_hw }, |
---|
| 95 | + { .compatible = "arm,cryptocell-713-ree", .data = &cc713_hw }, |
---|
59 | 96 | { .compatible = "arm,cryptocell-712-ree", .data = &cc712_hw }, |
---|
60 | 97 | { .compatible = "arm,cryptocell-710-ree", .data = &cc710_hw }, |
---|
61 | 98 | { .compatible = "arm,cryptocell-630p-ree", .data = &cc630p_hw }, |
---|
62 | 99 | {} |
---|
63 | 100 | }; |
---|
64 | 101 | MODULE_DEVICE_TABLE(of, arm_ccree_dev_of_match); |
---|
| 102 | + |
---|
| 103 | +static u32 cc_read_idr(struct cc_drvdata *drvdata, const u32 *idr_offsets) |
---|
| 104 | +{ |
---|
| 105 | + int i; |
---|
| 106 | + union { |
---|
| 107 | + u8 regs[CC_NUM_IDRS]; |
---|
| 108 | + __le32 val; |
---|
| 109 | + } idr; |
---|
| 110 | + |
---|
| 111 | + for (i = 0; i < CC_NUM_IDRS; ++i) |
---|
| 112 | + idr.regs[i] = cc_ioread(drvdata, idr_offsets[i]); |
---|
| 113 | + |
---|
| 114 | + return le32_to_cpu(idr.val); |
---|
| 115 | +} |
---|
65 | 116 | |
---|
66 | 117 | void __dump_byte_array(const char *name, const u8 *buf, size_t len) |
---|
67 | 118 | { |
---|
.. | .. |
---|
84 | 135 | u32 imr; |
---|
85 | 136 | |
---|
86 | 137 | /* STAT_OP_TYPE_GENERIC STAT_PHASE_0: Interrupt */ |
---|
| 138 | + /* if driver suspended return, probably shared interrupt */ |
---|
| 139 | + if (pm_runtime_suspended(dev)) |
---|
| 140 | + return IRQ_NONE; |
---|
87 | 141 | |
---|
88 | 142 | /* read the interrupt status */ |
---|
89 | 143 | irr = cc_ioread(drvdata, CC_REG(HOST_IRR)); |
---|
90 | 144 | dev_dbg(dev, "Got IRR=0x%08X\n", irr); |
---|
91 | | - if (irr == 0) { /* Probably shared interrupt line */ |
---|
92 | | - dev_err(dev, "Got interrupt with empty IRR\n"); |
---|
| 145 | + |
---|
| 146 | + if (irr == 0) /* Probably shared interrupt line */ |
---|
93 | 147 | return IRQ_NONE; |
---|
94 | | - } |
---|
| 148 | + |
---|
95 | 149 | imr = cc_ioread(drvdata, CC_REG(HOST_IMR)); |
---|
96 | 150 | |
---|
97 | 151 | /* clear interrupt - must be before processing events */ |
---|
.. | .. |
---|
99 | 153 | |
---|
100 | 154 | drvdata->irq = irr; |
---|
101 | 155 | /* Completion interrupt - most probable */ |
---|
102 | | - if (irr & CC_COMP_IRQ_MASK) { |
---|
103 | | - /* Mask AXI completion interrupt - will be unmasked in |
---|
104 | | - * Deferred service handler |
---|
| 156 | + if (irr & drvdata->comp_mask) { |
---|
| 157 | + /* Mask all completion interrupts - will be unmasked in |
---|
| 158 | + * deferred service handler |
---|
105 | 159 | */ |
---|
106 | | - cc_iowrite(drvdata, CC_REG(HOST_IMR), imr | CC_COMP_IRQ_MASK); |
---|
107 | | - irr &= ~CC_COMP_IRQ_MASK; |
---|
| 160 | + cc_iowrite(drvdata, CC_REG(HOST_IMR), imr | drvdata->comp_mask); |
---|
| 161 | + irr &= ~drvdata->comp_mask; |
---|
108 | 162 | complete_request(drvdata); |
---|
109 | 163 | } |
---|
110 | 164 | #ifdef CONFIG_CRYPTO_FIPS |
---|
.. | .. |
---|
139 | 193 | return IRQ_HANDLED; |
---|
140 | 194 | } |
---|
141 | 195 | |
---|
| 196 | +bool cc_wait_for_reset_completion(struct cc_drvdata *drvdata) |
---|
| 197 | +{ |
---|
| 198 | + unsigned int val; |
---|
| 199 | + unsigned int i; |
---|
| 200 | + |
---|
| 201 | + /* 712/710/63 has no reset completion indication, always return true */ |
---|
| 202 | + if (drvdata->hw_rev <= CC_HW_REV_712) |
---|
| 203 | + return true; |
---|
| 204 | + |
---|
| 205 | + for (i = 0; i < CC_HW_RESET_LOOP_COUNT; i++) { |
---|
| 206 | + /* in cc7x3 NVM_IS_IDLE indicates that CC reset is |
---|
| 207 | + * completed and device is fully functional |
---|
| 208 | + */ |
---|
| 209 | + val = cc_ioread(drvdata, CC_REG(NVM_IS_IDLE)); |
---|
| 210 | + if (val & CC_NVM_IS_IDLE_MASK) { |
---|
| 211 | + /* hw indicate reset completed */ |
---|
| 212 | + return true; |
---|
| 213 | + } |
---|
| 214 | + /* allow scheduling other process on the processor */ |
---|
| 215 | + schedule(); |
---|
| 216 | + } |
---|
| 217 | + /* reset not completed */ |
---|
| 218 | + return false; |
---|
| 219 | +} |
---|
| 220 | + |
---|
142 | 221 | int init_cc_regs(struct cc_drvdata *drvdata, bool is_probe) |
---|
143 | 222 | { |
---|
144 | 223 | unsigned int val, cache_params; |
---|
145 | 224 | struct device *dev = drvdata_to_dev(drvdata); |
---|
146 | 225 | |
---|
147 | | - /* Unmask all AXI interrupt sources AXI_CFG1 register */ |
---|
148 | | - val = cc_ioread(drvdata, CC_REG(AXIM_CFG)); |
---|
149 | | - cc_iowrite(drvdata, CC_REG(AXIM_CFG), val & ~CC_AXI_IRQ_MASK); |
---|
150 | | - dev_dbg(dev, "AXIM_CFG=0x%08X\n", |
---|
151 | | - cc_ioread(drvdata, CC_REG(AXIM_CFG))); |
---|
| 226 | + /* Unmask all AXI interrupt sources AXI_CFG1 register */ |
---|
| 227 | + /* AXI interrupt config are obsoleted startign at cc7x3 */ |
---|
| 228 | + if (drvdata->hw_rev <= CC_HW_REV_712) { |
---|
| 229 | + val = cc_ioread(drvdata, CC_REG(AXIM_CFG)); |
---|
| 230 | + cc_iowrite(drvdata, CC_REG(AXIM_CFG), val & ~CC_AXI_IRQ_MASK); |
---|
| 231 | + dev_dbg(dev, "AXIM_CFG=0x%08X\n", |
---|
| 232 | + cc_ioread(drvdata, CC_REG(AXIM_CFG))); |
---|
| 233 | + } |
---|
152 | 234 | |
---|
153 | 235 | /* Clear all pending interrupts */ |
---|
154 | 236 | val = cc_ioread(drvdata, CC_REG(HOST_IRR)); |
---|
.. | .. |
---|
156 | 238 | cc_iowrite(drvdata, CC_REG(HOST_ICR), val); |
---|
157 | 239 | |
---|
158 | 240 | /* Unmask relevant interrupt cause */ |
---|
159 | | - val = CC_COMP_IRQ_MASK | CC_AXI_ERR_IRQ_MASK; |
---|
| 241 | + val = drvdata->comp_mask | CC_AXI_ERR_IRQ_MASK; |
---|
160 | 242 | |
---|
161 | 243 | if (drvdata->hw_rev >= CC_HW_REV_712) |
---|
162 | 244 | val |= CC_GPR0_IRQ_MASK; |
---|
.. | .. |
---|
186 | 268 | struct cc_drvdata *new_drvdata; |
---|
187 | 269 | struct device *dev = &plat_dev->dev; |
---|
188 | 270 | struct device_node *np = dev->of_node; |
---|
189 | | - u32 signature_val; |
---|
| 271 | + u32 val, hw_rev_pidr, sig_cidr; |
---|
190 | 272 | u64 dma_mask; |
---|
191 | 273 | const struct cc_hw_data *hw_rev; |
---|
192 | | - const struct of_device_id *dev_id; |
---|
193 | 274 | struct clk *clk; |
---|
| 275 | + int irq; |
---|
194 | 276 | int rc = 0; |
---|
195 | 277 | |
---|
196 | 278 | new_drvdata = devm_kzalloc(dev, sizeof(*new_drvdata), GFP_KERNEL); |
---|
197 | 279 | if (!new_drvdata) |
---|
198 | 280 | return -ENOMEM; |
---|
199 | 281 | |
---|
200 | | - dev_id = of_match_node(arm_ccree_dev_of_match, np); |
---|
201 | | - if (!dev_id) |
---|
202 | | - return -ENODEV; |
---|
203 | | - |
---|
204 | | - hw_rev = (struct cc_hw_data *)dev_id->data; |
---|
| 282 | + hw_rev = of_device_get_match_data(dev); |
---|
205 | 283 | new_drvdata->hw_rev_name = hw_rev->name; |
---|
206 | 284 | new_drvdata->hw_rev = hw_rev->rev; |
---|
| 285 | + new_drvdata->std_bodies = hw_rev->std_bodies; |
---|
207 | 286 | |
---|
208 | 287 | if (hw_rev->rev >= CC_HW_REV_712) { |
---|
209 | | - new_drvdata->hash_len_sz = HASH_LEN_SIZE_712; |
---|
210 | 288 | new_drvdata->axim_mon_offset = CC_REG(AXIM_MON_COMP); |
---|
211 | 289 | new_drvdata->sig_offset = CC_REG(HOST_SIGNATURE_712); |
---|
212 | 290 | new_drvdata->ver_offset = CC_REG(HOST_VERSION_712); |
---|
213 | 291 | } else { |
---|
214 | | - new_drvdata->hash_len_sz = HASH_LEN_SIZE_630; |
---|
215 | 292 | new_drvdata->axim_mon_offset = CC_REG(AXIM_MON_COMP8); |
---|
216 | 293 | new_drvdata->sig_offset = CC_REG(HOST_SIGNATURE_630); |
---|
217 | 294 | new_drvdata->ver_offset = CC_REG(HOST_VERSION_630); |
---|
218 | 295 | } |
---|
219 | 296 | |
---|
| 297 | + new_drvdata->comp_mask = CC_COMP_IRQ_MASK; |
---|
| 298 | + |
---|
220 | 299 | platform_set_drvdata(plat_dev, new_drvdata); |
---|
221 | 300 | new_drvdata->plat_dev = plat_dev; |
---|
222 | 301 | |
---|
223 | | - clk = devm_clk_get(dev, NULL); |
---|
| 302 | + clk = devm_clk_get_optional(dev, NULL); |
---|
224 | 303 | if (IS_ERR(clk)) |
---|
225 | | - switch (PTR_ERR(clk)) { |
---|
226 | | - /* Clock is optional so this might be fine */ |
---|
227 | | - case -ENOENT: |
---|
228 | | - break; |
---|
229 | | - |
---|
230 | | - /* Clock not available, let's try again soon */ |
---|
231 | | - case -EPROBE_DEFER: |
---|
232 | | - return -EPROBE_DEFER; |
---|
233 | | - |
---|
234 | | - default: |
---|
235 | | - dev_err(dev, "Error getting clock: %ld\n", |
---|
236 | | - PTR_ERR(clk)); |
---|
237 | | - return PTR_ERR(clk); |
---|
238 | | - } |
---|
| 304 | + return dev_err_probe(dev, PTR_ERR(clk), "Error getting clock\n"); |
---|
239 | 305 | new_drvdata->clk = clk; |
---|
240 | 306 | |
---|
241 | 307 | new_drvdata->coherent = of_dma_is_coherent(np); |
---|
.. | .. |
---|
256 | 322 | &req_mem_cc_regs->start, new_drvdata->cc_base); |
---|
257 | 323 | |
---|
258 | 324 | /* Then IRQ */ |
---|
259 | | - new_drvdata->irq = platform_get_irq(plat_dev, 0); |
---|
260 | | - if (new_drvdata->irq < 0) { |
---|
261 | | - dev_err(dev, "Failed getting IRQ resource\n"); |
---|
262 | | - return new_drvdata->irq; |
---|
263 | | - } |
---|
264 | | - |
---|
265 | | - rc = devm_request_irq(dev, new_drvdata->irq, cc_isr, |
---|
266 | | - IRQF_SHARED, "ccree", new_drvdata); |
---|
267 | | - if (rc) { |
---|
268 | | - dev_err(dev, "Could not register to interrupt %d\n", |
---|
269 | | - new_drvdata->irq); |
---|
270 | | - return rc; |
---|
271 | | - } |
---|
272 | | - dev_dbg(dev, "Registered to IRQ: %d\n", new_drvdata->irq); |
---|
| 325 | + irq = platform_get_irq(plat_dev, 0); |
---|
| 326 | + if (irq < 0) |
---|
| 327 | + return irq; |
---|
273 | 328 | |
---|
274 | 329 | init_completion(&new_drvdata->hw_queue_avail); |
---|
275 | 330 | |
---|
276 | | - if (!plat_dev->dev.dma_mask) |
---|
277 | | - plat_dev->dev.dma_mask = &plat_dev->dev.coherent_dma_mask; |
---|
| 331 | + if (!dev->dma_mask) |
---|
| 332 | + dev->dma_mask = &dev->coherent_dma_mask; |
---|
278 | 333 | |
---|
279 | 334 | dma_mask = DMA_BIT_MASK(DMA_BIT_MASK_LEN); |
---|
280 | 335 | while (dma_mask > 0x7fffffffUL) { |
---|
281 | | - if (dma_supported(&plat_dev->dev, dma_mask)) { |
---|
282 | | - rc = dma_set_coherent_mask(&plat_dev->dev, dma_mask); |
---|
| 336 | + if (dma_supported(dev, dma_mask)) { |
---|
| 337 | + rc = dma_set_coherent_mask(dev, dma_mask); |
---|
283 | 338 | if (!rc) |
---|
284 | 339 | break; |
---|
285 | 340 | } |
---|
.. | .. |
---|
291 | 346 | return rc; |
---|
292 | 347 | } |
---|
293 | 348 | |
---|
294 | | - rc = cc_clk_on(new_drvdata); |
---|
| 349 | + rc = clk_prepare_enable(new_drvdata->clk); |
---|
295 | 350 | if (rc) { |
---|
296 | 351 | dev_err(dev, "Failed to enable clock"); |
---|
297 | 352 | return rc; |
---|
298 | 353 | } |
---|
299 | 354 | |
---|
300 | | - /* Verify correct mapping */ |
---|
301 | | - signature_val = cc_ioread(new_drvdata, new_drvdata->sig_offset); |
---|
302 | | - if (signature_val != hw_rev->sig) { |
---|
303 | | - dev_err(dev, "Invalid CC signature: SIGNATURE=0x%08X != expected=0x%08X\n", |
---|
304 | | - signature_val, hw_rev->sig); |
---|
305 | | - rc = -EINVAL; |
---|
306 | | - goto post_clk_err; |
---|
| 355 | + new_drvdata->sec_disabled = cc_sec_disable; |
---|
| 356 | + |
---|
| 357 | + pm_runtime_set_autosuspend_delay(dev, CC_SUSPEND_TIMEOUT); |
---|
| 358 | + pm_runtime_use_autosuspend(dev); |
---|
| 359 | + pm_runtime_set_active(dev); |
---|
| 360 | + pm_runtime_enable(dev); |
---|
| 361 | + rc = pm_runtime_get_sync(dev); |
---|
| 362 | + if (rc < 0) { |
---|
| 363 | + dev_err(dev, "pm_runtime_get_sync() failed: %d\n", rc); |
---|
| 364 | + goto post_pm_err; |
---|
307 | 365 | } |
---|
308 | | - dev_dbg(dev, "CC SIGNATURE=0x%08X\n", signature_val); |
---|
| 366 | + |
---|
| 367 | + /* Wait for Cryptocell reset completion */ |
---|
| 368 | + if (!cc_wait_for_reset_completion(new_drvdata)) { |
---|
| 369 | + dev_err(dev, "Cryptocell reset not completed"); |
---|
| 370 | + } |
---|
| 371 | + |
---|
| 372 | + if (hw_rev->rev <= CC_HW_REV_712) { |
---|
| 373 | + /* Verify correct mapping */ |
---|
| 374 | + val = cc_ioread(new_drvdata, new_drvdata->sig_offset); |
---|
| 375 | + if (val != hw_rev->sig) { |
---|
| 376 | + dev_err(dev, "Invalid CC signature: SIGNATURE=0x%08X != expected=0x%08X\n", |
---|
| 377 | + val, hw_rev->sig); |
---|
| 378 | + rc = -EINVAL; |
---|
| 379 | + goto post_pm_err; |
---|
| 380 | + } |
---|
| 381 | + sig_cidr = val; |
---|
| 382 | + hw_rev_pidr = cc_ioread(new_drvdata, new_drvdata->ver_offset); |
---|
| 383 | + } else { |
---|
| 384 | + /* Verify correct mapping */ |
---|
| 385 | + val = cc_read_idr(new_drvdata, pidr_0124_offsets); |
---|
| 386 | + if (val != hw_rev->pidr_0124) { |
---|
| 387 | + dev_err(dev, "Invalid CC PIDR: PIDR0124=0x%08X != expected=0x%08X\n", |
---|
| 388 | + val, hw_rev->pidr_0124); |
---|
| 389 | + rc = -EINVAL; |
---|
| 390 | + goto post_pm_err; |
---|
| 391 | + } |
---|
| 392 | + hw_rev_pidr = val; |
---|
| 393 | + |
---|
| 394 | + val = cc_read_idr(new_drvdata, cidr_0123_offsets); |
---|
| 395 | + if (val != hw_rev->cidr_0123) { |
---|
| 396 | + dev_err(dev, "Invalid CC CIDR: CIDR0123=0x%08X != expected=0x%08X\n", |
---|
| 397 | + val, hw_rev->cidr_0123); |
---|
| 398 | + rc = -EINVAL; |
---|
| 399 | + goto post_pm_err; |
---|
| 400 | + } |
---|
| 401 | + sig_cidr = val; |
---|
| 402 | + |
---|
| 403 | + /* Check HW engine configuration */ |
---|
| 404 | + val = cc_ioread(new_drvdata, CC_REG(HOST_REMOVE_INPUT_PINS)); |
---|
| 405 | + switch (val) { |
---|
| 406 | + case CC_PINS_FULL: |
---|
| 407 | + /* This is fine */ |
---|
| 408 | + break; |
---|
| 409 | + case CC_PINS_SLIM: |
---|
| 410 | + if (new_drvdata->std_bodies & CC_STD_NIST) { |
---|
| 411 | + dev_warn(dev, "703 mode forced due to HW configuration.\n"); |
---|
| 412 | + new_drvdata->std_bodies = CC_STD_OSCCA; |
---|
| 413 | + } |
---|
| 414 | + break; |
---|
| 415 | + default: |
---|
| 416 | + dev_err(dev, "Unsupported engines configuration.\n"); |
---|
| 417 | + rc = -EINVAL; |
---|
| 418 | + goto post_pm_err; |
---|
| 419 | + } |
---|
| 420 | + |
---|
| 421 | + /* Check security disable state */ |
---|
| 422 | + val = cc_ioread(new_drvdata, CC_REG(SECURITY_DISABLED)); |
---|
| 423 | + val &= CC_SECURITY_DISABLED_MASK; |
---|
| 424 | + new_drvdata->sec_disabled |= !!val; |
---|
| 425 | + |
---|
| 426 | + if (!new_drvdata->sec_disabled) { |
---|
| 427 | + new_drvdata->comp_mask |= CC_CPP_SM4_ABORT_MASK; |
---|
| 428 | + if (new_drvdata->std_bodies & CC_STD_NIST) |
---|
| 429 | + new_drvdata->comp_mask |= CC_CPP_AES_ABORT_MASK; |
---|
| 430 | + } |
---|
| 431 | + } |
---|
| 432 | + |
---|
| 433 | + if (new_drvdata->sec_disabled) |
---|
| 434 | + dev_info(dev, "Security Disabled mode is in effect. Security functions disabled.\n"); |
---|
309 | 435 | |
---|
310 | 436 | /* Display HW versions */ |
---|
311 | | - dev_info(dev, "ARM CryptoCell %s Driver: HW version 0x%08X, Driver version %s\n", |
---|
312 | | - hw_rev->name, cc_ioread(new_drvdata, new_drvdata->ver_offset), |
---|
313 | | - DRV_MODULE_VERSION); |
---|
| 437 | + dev_info(dev, "ARM CryptoCell %s Driver: HW version 0x%08X/0x%8X, Driver version %s\n", |
---|
| 438 | + hw_rev->name, hw_rev_pidr, sig_cidr, DRV_MODULE_VERSION); |
---|
| 439 | + /* register the driver isr function */ |
---|
| 440 | + rc = devm_request_irq(dev, irq, cc_isr, IRQF_SHARED, "ccree", |
---|
| 441 | + new_drvdata); |
---|
| 442 | + if (rc) { |
---|
| 443 | + dev_err(dev, "Could not register to interrupt %d\n", irq); |
---|
| 444 | + goto post_pm_err; |
---|
| 445 | + } |
---|
| 446 | + dev_dbg(dev, "Registered to IRQ: %d\n", irq); |
---|
314 | 447 | |
---|
315 | 448 | rc = init_cc_regs(new_drvdata, true); |
---|
316 | 449 | if (rc) { |
---|
317 | 450 | dev_err(dev, "init_cc_regs failed\n"); |
---|
318 | | - goto post_clk_err; |
---|
| 451 | + goto post_pm_err; |
---|
319 | 452 | } |
---|
320 | 453 | |
---|
321 | 454 | rc = cc_debugfs_init(new_drvdata); |
---|
.. | .. |
---|
326 | 459 | |
---|
327 | 460 | rc = cc_fips_init(new_drvdata); |
---|
328 | 461 | if (rc) { |
---|
329 | | - dev_err(dev, "CC_FIPS_INIT failed 0x%x\n", rc); |
---|
| 462 | + dev_err(dev, "cc_fips_init failed 0x%x\n", rc); |
---|
330 | 463 | goto post_debugfs_err; |
---|
331 | 464 | } |
---|
332 | 465 | rc = cc_sram_mgr_init(new_drvdata); |
---|
.. | .. |
---|
338 | 471 | new_drvdata->mlli_sram_addr = |
---|
339 | 472 | cc_sram_alloc(new_drvdata, MAX_MLLI_BUFF_SIZE); |
---|
340 | 473 | if (new_drvdata->mlli_sram_addr == NULL_SRAM_ADDR) { |
---|
341 | | - dev_err(dev, "Failed to alloc MLLI Sram buffer\n"); |
---|
342 | 474 | rc = -ENOMEM; |
---|
343 | | - goto post_sram_mgr_err; |
---|
| 475 | + goto post_fips_init_err; |
---|
344 | 476 | } |
---|
345 | 477 | |
---|
346 | 478 | rc = cc_req_mgr_init(new_drvdata); |
---|
347 | 479 | if (rc) { |
---|
348 | 480 | dev_err(dev, "cc_req_mgr_init failed\n"); |
---|
349 | | - goto post_sram_mgr_err; |
---|
| 481 | + goto post_fips_init_err; |
---|
350 | 482 | } |
---|
351 | 483 | |
---|
352 | 484 | rc = cc_buffer_mgr_init(new_drvdata); |
---|
353 | 485 | if (rc) { |
---|
354 | | - dev_err(dev, "buffer_mgr_init failed\n"); |
---|
| 486 | + dev_err(dev, "cc_buffer_mgr_init failed\n"); |
---|
355 | 487 | goto post_req_mgr_err; |
---|
356 | | - } |
---|
357 | | - |
---|
358 | | - rc = cc_pm_init(new_drvdata); |
---|
359 | | - if (rc) { |
---|
360 | | - dev_err(dev, "ssi_power_mgr_init failed\n"); |
---|
361 | | - goto post_buf_mgr_err; |
---|
362 | | - } |
---|
363 | | - |
---|
364 | | - rc = cc_ivgen_init(new_drvdata); |
---|
365 | | - if (rc) { |
---|
366 | | - dev_err(dev, "cc_ivgen_init failed\n"); |
---|
367 | | - goto post_buf_mgr_err; |
---|
368 | 488 | } |
---|
369 | 489 | |
---|
370 | 490 | /* Allocate crypto algs */ |
---|
371 | 491 | rc = cc_cipher_alloc(new_drvdata); |
---|
372 | 492 | if (rc) { |
---|
373 | 493 | dev_err(dev, "cc_cipher_alloc failed\n"); |
---|
374 | | - goto post_ivgen_err; |
---|
| 494 | + goto post_buf_mgr_err; |
---|
375 | 495 | } |
---|
376 | 496 | |
---|
377 | 497 | /* hash must be allocated before aead since hash exports APIs */ |
---|
.. | .. |
---|
387 | 507 | goto post_hash_err; |
---|
388 | 508 | } |
---|
389 | 509 | |
---|
390 | | - /* All set, we can allow autosuspend */ |
---|
391 | | - cc_pm_go(new_drvdata); |
---|
392 | | - |
---|
393 | 510 | /* If we got here and FIPS mode is enabled |
---|
394 | 511 | * it means all FIPS test passed, so let TEE |
---|
395 | 512 | * know we're good. |
---|
396 | 513 | */ |
---|
397 | 514 | cc_set_ree_fips_status(new_drvdata, true); |
---|
398 | 515 | |
---|
| 516 | + pm_runtime_put(dev); |
---|
399 | 517 | return 0; |
---|
400 | 518 | |
---|
401 | 519 | post_hash_err: |
---|
402 | 520 | cc_hash_free(new_drvdata); |
---|
403 | 521 | post_cipher_err: |
---|
404 | 522 | cc_cipher_free(new_drvdata); |
---|
405 | | -post_ivgen_err: |
---|
406 | | - cc_ivgen_fini(new_drvdata); |
---|
407 | 523 | post_buf_mgr_err: |
---|
408 | 524 | cc_buffer_mgr_fini(new_drvdata); |
---|
409 | 525 | post_req_mgr_err: |
---|
410 | 526 | cc_req_mgr_fini(new_drvdata); |
---|
411 | | -post_sram_mgr_err: |
---|
412 | | - cc_sram_mgr_fini(new_drvdata); |
---|
413 | 527 | post_fips_init_err: |
---|
414 | 528 | cc_fips_fini(new_drvdata); |
---|
415 | 529 | post_debugfs_err: |
---|
416 | 530 | cc_debugfs_fini(new_drvdata); |
---|
417 | 531 | post_regs_err: |
---|
418 | 532 | fini_cc_regs(new_drvdata); |
---|
419 | | -post_clk_err: |
---|
420 | | - cc_clk_off(new_drvdata); |
---|
| 533 | +post_pm_err: |
---|
| 534 | + pm_runtime_put_noidle(dev); |
---|
| 535 | + pm_runtime_disable(dev); |
---|
| 536 | + pm_runtime_set_suspended(dev); |
---|
| 537 | + clk_disable_unprepare(new_drvdata->clk); |
---|
421 | 538 | return rc; |
---|
422 | 539 | } |
---|
423 | 540 | |
---|
.. | .. |
---|
429 | 546 | |
---|
430 | 547 | static void cleanup_cc_resources(struct platform_device *plat_dev) |
---|
431 | 548 | { |
---|
| 549 | + struct device *dev = &plat_dev->dev; |
---|
432 | 550 | struct cc_drvdata *drvdata = |
---|
433 | 551 | (struct cc_drvdata *)platform_get_drvdata(plat_dev); |
---|
434 | 552 | |
---|
435 | 553 | cc_aead_free(drvdata); |
---|
436 | 554 | cc_hash_free(drvdata); |
---|
437 | 555 | cc_cipher_free(drvdata); |
---|
438 | | - cc_ivgen_fini(drvdata); |
---|
439 | | - cc_pm_fini(drvdata); |
---|
440 | 556 | cc_buffer_mgr_fini(drvdata); |
---|
441 | 557 | cc_req_mgr_fini(drvdata); |
---|
442 | | - cc_sram_mgr_fini(drvdata); |
---|
443 | 558 | cc_fips_fini(drvdata); |
---|
444 | 559 | cc_debugfs_fini(drvdata); |
---|
445 | 560 | fini_cc_regs(drvdata); |
---|
446 | | - cc_clk_off(drvdata); |
---|
| 561 | + pm_runtime_put_noidle(dev); |
---|
| 562 | + pm_runtime_disable(dev); |
---|
| 563 | + pm_runtime_set_suspended(dev); |
---|
| 564 | + clk_disable_unprepare(drvdata->clk); |
---|
447 | 565 | } |
---|
448 | 566 | |
---|
449 | | -int cc_clk_on(struct cc_drvdata *drvdata) |
---|
| 567 | +unsigned int cc_get_default_hash_len(struct cc_drvdata *drvdata) |
---|
450 | 568 | { |
---|
451 | | - struct clk *clk = drvdata->clk; |
---|
452 | | - int rc; |
---|
453 | | - |
---|
454 | | - if (IS_ERR(clk)) |
---|
455 | | - /* Not all devices have a clock associated with CCREE */ |
---|
456 | | - return 0; |
---|
457 | | - |
---|
458 | | - rc = clk_prepare_enable(clk); |
---|
459 | | - if (rc) |
---|
460 | | - return rc; |
---|
461 | | - |
---|
462 | | - return 0; |
---|
463 | | -} |
---|
464 | | - |
---|
465 | | -void cc_clk_off(struct cc_drvdata *drvdata) |
---|
466 | | -{ |
---|
467 | | - struct clk *clk = drvdata->clk; |
---|
468 | | - |
---|
469 | | - if (IS_ERR(clk)) |
---|
470 | | - /* Not all devices have a clock associated with CCREE */ |
---|
471 | | - return; |
---|
472 | | - |
---|
473 | | - clk_disable_unprepare(clk); |
---|
| 569 | + if (drvdata->hw_rev >= CC_HW_REV_712) |
---|
| 570 | + return HASH_LEN_SIZE_712; |
---|
| 571 | + else |
---|
| 572 | + return HASH_LEN_SIZE_630; |
---|
474 | 573 | } |
---|
475 | 574 | |
---|
476 | 575 | static int ccree_probe(struct platform_device *plat_dev) |
---|
.. | .. |
---|
515 | 614 | |
---|
516 | 615 | static int __init ccree_init(void) |
---|
517 | 616 | { |
---|
518 | | - int ret; |
---|
| 617 | + int rc; |
---|
519 | 618 | |
---|
520 | | - cc_hash_global_init(); |
---|
| 619 | + cc_debugfs_global_init(); |
---|
521 | 620 | |
---|
522 | | - ret = cc_debugfs_global_init(); |
---|
523 | | - if (ret) |
---|
524 | | - return ret; |
---|
| 621 | + rc = platform_driver_register(&ccree_driver); |
---|
| 622 | + if (rc) { |
---|
| 623 | + cc_debugfs_global_fini(); |
---|
| 624 | + return rc; |
---|
| 625 | + } |
---|
525 | 626 | |
---|
526 | | - return platform_driver_register(&ccree_driver); |
---|
| 627 | + return 0; |
---|
527 | 628 | } |
---|
528 | 629 | module_init(ccree_init); |
---|
529 | 630 | |
---|