Tom Rini | 83d290c | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 2 | /* |
| 3 | * Copyright 2008-2014 Freescale Semiconductor, Inc. |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 4 | * Copyright 2018, 2021 NXP |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 5 | * |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 6 | * Based on CAAM driver in drivers/crypto/caam in Linux |
| 7 | */ |
| 8 | |
| 9 | #include <common.h> |
Simon Glass | 1eb69ae | 2019-11-14 12:57:39 -0700 | [diff] [blame] | 10 | #include <cpu_func.h> |
Michael Walle | b980f9e | 2020-06-27 22:58:52 +0200 | [diff] [blame] | 11 | #include <linux/kernel.h> |
Simon Glass | f7ae49f | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 12 | #include <log.h> |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 13 | #include <malloc.h> |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 14 | #include <power-domain.h> |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 15 | #include "jr.h" |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 16 | #include "jobdesc.h" |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 17 | #include "desc_constr.h" |
Simon Glass | 6887c5b | 2019-11-14 12:57:26 -0700 | [diff] [blame] | 18 | #include <time.h> |
Simon Glass | 90526e9 | 2020-05-10 11:39:56 -0600 | [diff] [blame] | 19 | #include <asm/cache.h> |
Aneesh Bansal | f698e9f | 2016-01-22 17:05:59 +0530 | [diff] [blame] | 20 | #ifdef CONFIG_FSL_CORENET |
Simon Glass | 90526e9 | 2020-05-10 11:39:56 -0600 | [diff] [blame] | 21 | #include <asm/cache.h> |
Aneesh Bansal | f698e9f | 2016-01-22 17:05:59 +0530 | [diff] [blame] | 22 | #include <asm/fsl_pamu.h> |
| 23 | #endif |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 24 | #include <dm.h> |
Michael Walle | ea95f21 | 2020-06-27 22:58:53 +0200 | [diff] [blame] | 25 | #include <dm/lists.h> |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 26 | #include <dm/root.h> |
| 27 | #include <dm/device-internal.h> |
Franck LENORMAND | 68a905d | 2021-03-25 17:30:22 +0800 | [diff] [blame] | 28 | #include <linux/delay.h> |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 29 | |
| 30 | #define CIRC_CNT(head, tail, size) (((head) - (tail)) & (size - 1)) |
| 31 | #define CIRC_SPACE(head, tail, size) CIRC_CNT((tail), (head) + 1, (size)) |
| 32 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 33 | uint32_t sec_offset[CONFIG_SYS_FSL_MAX_NUM_OF_SEC] = { |
| 34 | 0, |
York Sun | 4fd6474 | 2016-11-15 18:44:22 -0800 | [diff] [blame] | 35 | #if defined(CONFIG_ARCH_C29X) |
Tom Rini | 6cc0454 | 2022-10-28 20:27:13 -0400 | [diff] [blame] | 36 | CFG_SYS_FSL_SEC_IDX_OFFSET, |
| 37 | 2 * CFG_SYS_FSL_SEC_IDX_OFFSET |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 38 | #endif |
| 39 | }; |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 40 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 41 | #if CONFIG_IS_ENABLED(DM) |
| 42 | struct udevice *caam_dev; |
| 43 | #else |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 44 | #define SEC_ADDR(idx) \ |
Tom Rini | 6cc0454 | 2022-10-28 20:27:13 -0400 | [diff] [blame] | 45 | (ulong)((CFG_SYS_FSL_SEC_ADDR + sec_offset[idx])) |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 46 | |
| 47 | #define SEC_JR0_ADDR(idx) \ |
Aymen Sghaier | dde92e2 | 2021-03-25 17:30:26 +0800 | [diff] [blame] | 48 | (ulong)(SEC_ADDR(idx) + \ |
Tom Rini | 6cc0454 | 2022-10-28 20:27:13 -0400 | [diff] [blame] | 49 | (CFG_SYS_FSL_JR0_OFFSET - CFG_SYS_FSL_SEC_OFFSET)) |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 50 | struct caam_regs caam_st; |
| 51 | #endif |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 52 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 53 | static inline u32 jr_start_reg(u8 jrid) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 54 | { |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 55 | return (1 << jrid); |
| 56 | } |
| 57 | |
| 58 | static inline void start_jr(struct caam_regs *caam) |
| 59 | { |
| 60 | ccsr_sec_t *sec = caam->sec; |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 61 | u32 ctpr_ms = sec_in32(&sec->ctpr_ms); |
| 62 | u32 scfgr = sec_in32(&sec->scfgr); |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 63 | u32 jrstart = jr_start_reg(caam->jrid); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 64 | |
| 65 | if (ctpr_ms & SEC_CTPR_MS_VIRT_EN_INCL) { |
| 66 | /* VIRT_EN_INCL = 1 & VIRT_EN_POR = 1 or |
| 67 | * VIRT_EN_INCL = 1 & VIRT_EN_POR = 0 & SEC_SCFGR_VIRT_EN = 1 |
| 68 | */ |
| 69 | if ((ctpr_ms & SEC_CTPR_MS_VIRT_EN_POR) || |
xypron.glpk@gmx.de | d171056 | 2017-04-15 16:37:54 +0200 | [diff] [blame] | 70 | (scfgr & SEC_SCFGR_VIRT_EN)) |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 71 | sec_out32(&sec->jrstartr, jrstart); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 72 | } else { |
| 73 | /* VIRT_EN_INCL = 0 && VIRT_EN_POR_VALUE = 1 */ |
| 74 | if (ctpr_ms & SEC_CTPR_MS_VIRT_EN_POR) |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 75 | sec_out32(&sec->jrstartr, jrstart); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 76 | } |
| 77 | } |
| 78 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 79 | static inline void jr_disable_irq(struct jr_regs *regs) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 80 | { |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 81 | uint32_t jrcfg = sec_in32(®s->jrcfg1); |
| 82 | |
| 83 | jrcfg = jrcfg | JR_INTMASK; |
| 84 | |
| 85 | sec_out32(®s->jrcfg1, jrcfg); |
| 86 | } |
| 87 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 88 | static void jr_initregs(uint8_t sec_idx, struct caam_regs *caam) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 89 | { |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 90 | struct jr_regs *regs = caam->regs; |
| 91 | struct jobring *jr = &caam->jr[sec_idx]; |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 92 | caam_dma_addr_t ip_base = virt_to_phys((void *)jr->input_ring); |
| 93 | caam_dma_addr_t op_base = virt_to_phys((void *)jr->output_ring); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 94 | |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 95 | #ifdef CONFIG_CAAM_64BIT |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 96 | sec_out32(®s->irba_h, ip_base >> 32); |
| 97 | #else |
| 98 | sec_out32(®s->irba_h, 0x0); |
| 99 | #endif |
| 100 | sec_out32(®s->irba_l, (uint32_t)ip_base); |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 101 | #ifdef CONFIG_CAAM_64BIT |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 102 | sec_out32(®s->orba_h, op_base >> 32); |
| 103 | #else |
| 104 | sec_out32(®s->orba_h, 0x0); |
| 105 | #endif |
| 106 | sec_out32(®s->orba_l, (uint32_t)op_base); |
| 107 | sec_out32(®s->ors, JR_SIZE); |
| 108 | sec_out32(®s->irs, JR_SIZE); |
| 109 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 110 | if (!jr->irq) |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 111 | jr_disable_irq(regs); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 112 | } |
| 113 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 114 | static int jr_init(uint8_t sec_idx, struct caam_regs *caam) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 115 | { |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 116 | struct jobring *jr = &caam->jr[sec_idx]; |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 117 | #if CONFIG_IS_ENABLED(OF_CONTROL) |
| 118 | ofnode scu_node = ofnode_by_compatible(ofnode_null(), "fsl,imx8-mu"); |
| 119 | #endif |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 120 | memset(jr, 0, sizeof(struct jobring)); |
| 121 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 122 | jr->jq_id = caam->jrid; |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 123 | jr->irq = DEFAULT_IRQ; |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 124 | |
| 125 | #ifdef CONFIG_FSL_CORENET |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 126 | jr->liodn = DEFAULT_JR_LIODN; |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 127 | #endif |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 128 | jr->size = JR_SIZE; |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 129 | jr->input_ring = (caam_dma_addr_t *)memalign(ARCH_DMA_MINALIGN, |
| 130 | JR_SIZE * sizeof(caam_dma_addr_t)); |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 131 | if (!jr->input_ring) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 132 | return -1; |
Ruchika Gupta | 7f4736b | 2016-01-22 16:12:55 +0530 | [diff] [blame] | 133 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 134 | jr->op_size = roundup(JR_SIZE * sizeof(struct op_ring), |
| 135 | ARCH_DMA_MINALIGN); |
| 136 | jr->output_ring = |
| 137 | (struct op_ring *)memalign(ARCH_DMA_MINALIGN, jr->op_size); |
| 138 | if (!jr->output_ring) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 139 | return -1; |
| 140 | |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 141 | memset(jr->input_ring, 0, JR_SIZE * sizeof(caam_dma_addr_t)); |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 142 | memset(jr->output_ring, 0, jr->op_size); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 143 | |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 144 | #if CONFIG_IS_ENABLED(OF_CONTROL) |
| 145 | if (!ofnode_valid(scu_node)) |
| 146 | #endif |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 147 | start_jr(caam); |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 148 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 149 | jr_initregs(sec_idx, caam); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 150 | |
| 151 | return 0; |
| 152 | } |
| 153 | |
| 154 | /* -1 --- error, can't enqueue -- no space available */ |
| 155 | static int jr_enqueue(uint32_t *desc_addr, |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 156 | void (*callback)(uint32_t status, void *arg), |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 157 | void *arg, uint8_t sec_idx, struct caam_regs *caam) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 158 | { |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 159 | struct jr_regs *regs = caam->regs; |
| 160 | struct jobring *jr = &caam->jr[sec_idx]; |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 161 | int head = jr->head; |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 162 | uint32_t desc_word; |
| 163 | int length = desc_len(desc_addr); |
| 164 | int i; |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 165 | #ifdef CONFIG_CAAM_64BIT |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 166 | uint32_t *addr_hi, *addr_lo; |
| 167 | #endif |
| 168 | |
| 169 | /* The descriptor must be submitted to SEC block as per endianness |
| 170 | * of the SEC Block. |
| 171 | * So, if the endianness of Core and SEC block is different, each word |
| 172 | * of the descriptor will be byte-swapped. |
| 173 | */ |
| 174 | for (i = 0; i < length; i++) { |
| 175 | desc_word = desc_addr[i]; |
| 176 | sec_out32((uint32_t *)&desc_addr[i], desc_word); |
| 177 | } |
| 178 | |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 179 | caam_dma_addr_t desc_phys_addr = virt_to_phys(desc_addr); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 180 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 181 | jr->info[head].desc_phys_addr = desc_phys_addr; |
| 182 | jr->info[head].callback = (void *)callback; |
| 183 | jr->info[head].arg = arg; |
| 184 | jr->info[head].op_done = 0; |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 185 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 186 | unsigned long start = (unsigned long)&jr->info[head] & |
Raul Cardenas | 0200020 | 2015-02-27 11:22:06 -0600 | [diff] [blame] | 187 | ~(ARCH_DMA_MINALIGN - 1); |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 188 | unsigned long end = ALIGN((unsigned long)&jr->info[head] + |
Ruchika Gupta | 7f4736b | 2016-01-22 16:12:55 +0530 | [diff] [blame] | 189 | sizeof(struct jr_info), ARCH_DMA_MINALIGN); |
Raul Cardenas | 0200020 | 2015-02-27 11:22:06 -0600 | [diff] [blame] | 190 | flush_dcache_range(start, end); |
| 191 | |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 192 | #ifdef CONFIG_CAAM_64BIT |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 193 | /* Write the 64 bit Descriptor address on Input Ring. |
| 194 | * The 32 bit hign and low part of the address will |
| 195 | * depend on endianness of SEC block. |
| 196 | */ |
| 197 | #ifdef CONFIG_SYS_FSL_SEC_LE |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 198 | addr_lo = (uint32_t *)(&jr->input_ring[head]); |
| 199 | addr_hi = (uint32_t *)(&jr->input_ring[head]) + 1; |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 200 | #elif defined(CONFIG_SYS_FSL_SEC_BE) |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 201 | addr_hi = (uint32_t *)(&jr->input_ring[head]); |
| 202 | addr_lo = (uint32_t *)(&jr->input_ring[head]) + 1; |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 203 | #endif /* ifdef CONFIG_SYS_FSL_SEC_LE */ |
| 204 | |
| 205 | sec_out32(addr_hi, (uint32_t)(desc_phys_addr >> 32)); |
| 206 | sec_out32(addr_lo, (uint32_t)(desc_phys_addr)); |
| 207 | |
| 208 | #else |
| 209 | /* Write the 32 bit Descriptor address on Input Ring. */ |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 210 | sec_out32(&jr->input_ring[head], desc_phys_addr); |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 211 | #endif /* ifdef CONFIG_CAAM_64BIT */ |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 212 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 213 | start = (unsigned long)&jr->input_ring[head] & ~(ARCH_DMA_MINALIGN - 1); |
| 214 | end = ALIGN((unsigned long)&jr->input_ring[head] + |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 215 | sizeof(caam_dma_addr_t), ARCH_DMA_MINALIGN); |
Raul Cardenas | 0200020 | 2015-02-27 11:22:06 -0600 | [diff] [blame] | 216 | flush_dcache_range(start, end); |
| 217 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 218 | jr->head = (head + 1) & (jr->size - 1); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 219 | |
Ruchika Gupta | 7f4736b | 2016-01-22 16:12:55 +0530 | [diff] [blame] | 220 | /* Invalidate output ring */ |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 221 | start = (unsigned long)jr->output_ring & |
Ruchika Gupta | 7f4736b | 2016-01-22 16:12:55 +0530 | [diff] [blame] | 222 | ~(ARCH_DMA_MINALIGN - 1); |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 223 | end = ALIGN((unsigned long)jr->output_ring + jr->op_size, |
| 224 | ARCH_DMA_MINALIGN); |
Ruchika Gupta | 7f4736b | 2016-01-22 16:12:55 +0530 | [diff] [blame] | 225 | invalidate_dcache_range(start, end); |
| 226 | |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 227 | sec_out32(®s->irja, 1); |
| 228 | |
| 229 | return 0; |
| 230 | } |
| 231 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 232 | static int jr_dequeue(int sec_idx, struct caam_regs *caam) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 233 | { |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 234 | struct jr_regs *regs = caam->regs; |
| 235 | struct jobring *jr = &caam->jr[sec_idx]; |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 236 | int head = jr->head; |
| 237 | int tail = jr->tail; |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 238 | int idx, i, found; |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 239 | void (*callback)(uint32_t status, void *arg); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 240 | void *arg = NULL; |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 241 | #ifdef CONFIG_CAAM_64BIT |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 242 | uint32_t *addr_hi, *addr_lo; |
| 243 | #else |
| 244 | uint32_t *addr; |
| 245 | #endif |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 246 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 247 | while (sec_in32(®s->orsf) && CIRC_CNT(jr->head, jr->tail, |
| 248 | jr->size)) { |
Raul Cardenas | 0200020 | 2015-02-27 11:22:06 -0600 | [diff] [blame] | 249 | |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 250 | found = 0; |
| 251 | |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 252 | caam_dma_addr_t op_desc; |
| 253 | #ifdef CONFIG_CAAM_64BIT |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 254 | /* Read the 64 bit Descriptor address from Output Ring. |
| 255 | * The 32 bit hign and low part of the address will |
| 256 | * depend on endianness of SEC block. |
| 257 | */ |
| 258 | #ifdef CONFIG_SYS_FSL_SEC_LE |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 259 | addr_lo = (uint32_t *)(&jr->output_ring[jr->tail].desc); |
| 260 | addr_hi = (uint32_t *)(&jr->output_ring[jr->tail].desc) + 1; |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 261 | #elif defined(CONFIG_SYS_FSL_SEC_BE) |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 262 | addr_hi = (uint32_t *)(&jr->output_ring[jr->tail].desc); |
| 263 | addr_lo = (uint32_t *)(&jr->output_ring[jr->tail].desc) + 1; |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 264 | #endif /* ifdef CONFIG_SYS_FSL_SEC_LE */ |
| 265 | |
| 266 | op_desc = ((u64)sec_in32(addr_hi) << 32) | |
| 267 | ((u64)sec_in32(addr_lo)); |
| 268 | |
| 269 | #else |
| 270 | /* Read the 32 bit Descriptor address from Output Ring. */ |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 271 | addr = (uint32_t *)&jr->output_ring[jr->tail].desc; |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 272 | op_desc = sec_in32(addr); |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 273 | #endif /* ifdef CONFIG_CAAM_64BIT */ |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 274 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 275 | uint32_t status = sec_in32(&jr->output_ring[jr->tail].status); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 276 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 277 | for (i = 0; CIRC_CNT(head, tail + i, jr->size) >= 1; i++) { |
| 278 | idx = (tail + i) & (jr->size - 1); |
| 279 | if (op_desc == jr->info[idx].desc_phys_addr) { |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 280 | found = 1; |
| 281 | break; |
| 282 | } |
| 283 | } |
| 284 | |
| 285 | /* Error condition if match not found */ |
| 286 | if (!found) |
| 287 | return -1; |
| 288 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 289 | jr->info[idx].op_done = 1; |
| 290 | callback = (void *)jr->info[idx].callback; |
| 291 | arg = jr->info[idx].arg; |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 292 | |
| 293 | /* When the job on tail idx gets done, increment |
| 294 | * tail till the point where job completed out of oredr has |
| 295 | * been taken into account |
| 296 | */ |
| 297 | if (idx == tail) |
| 298 | do { |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 299 | tail = (tail + 1) & (jr->size - 1); |
| 300 | } while (jr->info[tail].op_done); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 301 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 302 | jr->tail = tail; |
| 303 | jr->read_idx = (jr->read_idx + 1) & (jr->size - 1); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 304 | |
| 305 | sec_out32(®s->orjr, 1); |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 306 | jr->info[idx].op_done = 0; |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 307 | |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 308 | callback(status, arg); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 309 | } |
| 310 | |
| 311 | return 0; |
| 312 | } |
| 313 | |
Aneesh Bansal | f59e69c | 2015-10-29 22:58:03 +0530 | [diff] [blame] | 314 | static void desc_done(uint32_t status, void *arg) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 315 | { |
| 316 | struct result *x = arg; |
| 317 | x->status = status; |
| 318 | caam_jr_strstatus(status); |
| 319 | x->done = 1; |
| 320 | } |
| 321 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 322 | static inline int run_descriptor_jr_idx(uint32_t *desc, uint8_t sec_idx) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 323 | { |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 324 | struct caam_regs *caam; |
| 325 | #if CONFIG_IS_ENABLED(DM) |
| 326 | caam = dev_get_priv(caam_dev); |
| 327 | #else |
| 328 | caam = &caam_st; |
| 329 | #endif |
Franck LENORMAND | 68a905d | 2021-03-25 17:30:22 +0800 | [diff] [blame] | 330 | unsigned long long timeval = 0; |
Tom Rini | 6e7df1d | 2023-01-10 11:19:45 -0500 | [diff] [blame] | 331 | unsigned long long timeout = CFG_USEC_DEQ_TIMEOUT; |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 332 | struct result op; |
| 333 | int ret = 0; |
| 334 | |
gaurav rana | 851c9db | 2014-12-04 13:00:41 +0530 | [diff] [blame] | 335 | memset(&op, 0, sizeof(op)); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 336 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 337 | ret = jr_enqueue(desc, desc_done, &op, sec_idx, caam); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 338 | if (ret) { |
| 339 | debug("Error in SEC enq\n"); |
| 340 | ret = JQ_ENQ_ERR; |
| 341 | goto out; |
| 342 | } |
| 343 | |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 344 | while (op.done != 1) { |
Franck LENORMAND | 68a905d | 2021-03-25 17:30:22 +0800 | [diff] [blame] | 345 | udelay(1); |
| 346 | timeval += 1; |
| 347 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 348 | ret = jr_dequeue(sec_idx, caam); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 349 | if (ret) { |
| 350 | debug("Error in SEC deq\n"); |
| 351 | ret = JQ_DEQ_ERR; |
| 352 | goto out; |
| 353 | } |
| 354 | |
Franck LENORMAND | 68a905d | 2021-03-25 17:30:22 +0800 | [diff] [blame] | 355 | if (timeval > timeout) { |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 356 | debug("SEC Dequeue timed out\n"); |
| 357 | ret = JQ_DEQ_TO_ERR; |
| 358 | goto out; |
| 359 | } |
| 360 | } |
| 361 | |
Aneesh Bansal | 6178e95 | 2016-02-11 14:36:51 +0530 | [diff] [blame] | 362 | if (op.status) { |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 363 | debug("Error %x\n", op.status); |
| 364 | ret = op.status; |
| 365 | } |
| 366 | out: |
| 367 | return ret; |
| 368 | } |
| 369 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 370 | int run_descriptor_jr(uint32_t *desc) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 371 | { |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 372 | return run_descriptor_jr_idx(desc, 0); |
| 373 | } |
| 374 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 375 | static int jr_sw_cleanup(uint8_t sec_idx, struct caam_regs *caam) |
| 376 | { |
| 377 | struct jobring *jr = &caam->jr[sec_idx]; |
| 378 | |
| 379 | jr->head = 0; |
| 380 | jr->tail = 0; |
| 381 | jr->read_idx = 0; |
| 382 | jr->write_idx = 0; |
| 383 | memset(jr->info, 0, sizeof(jr->info)); |
| 384 | memset(jr->input_ring, 0, jr->size * sizeof(caam_dma_addr_t)); |
| 385 | memset(jr->output_ring, 0, jr->size * sizeof(struct op_ring)); |
| 386 | |
| 387 | return 0; |
| 388 | } |
| 389 | |
| 390 | static int jr_hw_reset(struct jr_regs *regs) |
| 391 | { |
| 392 | uint32_t timeout = 100000; |
| 393 | uint32_t jrint, jrcr; |
| 394 | |
| 395 | sec_out32(®s->jrcr, JRCR_RESET); |
| 396 | do { |
| 397 | jrint = sec_in32(®s->jrint); |
| 398 | } while (((jrint & JRINT_ERR_HALT_MASK) == |
| 399 | JRINT_ERR_HALT_INPROGRESS) && --timeout); |
| 400 | |
| 401 | jrint = sec_in32(®s->jrint); |
| 402 | if (((jrint & JRINT_ERR_HALT_MASK) != |
| 403 | JRINT_ERR_HALT_INPROGRESS) && timeout == 0) |
| 404 | return -1; |
| 405 | |
| 406 | timeout = 100000; |
| 407 | sec_out32(®s->jrcr, JRCR_RESET); |
| 408 | do { |
| 409 | jrcr = sec_in32(®s->jrcr); |
| 410 | } while ((jrcr & JRCR_RESET) && --timeout); |
| 411 | |
| 412 | if (timeout == 0) |
| 413 | return -1; |
| 414 | |
| 415 | return 0; |
| 416 | } |
| 417 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 418 | static inline int jr_reset_sec(uint8_t sec_idx) |
| 419 | { |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 420 | struct caam_regs *caam; |
| 421 | #if CONFIG_IS_ENABLED(DM) |
| 422 | caam = dev_get_priv(caam_dev); |
| 423 | #else |
| 424 | caam = &caam_st; |
| 425 | #endif |
| 426 | if (jr_hw_reset(caam->regs) < 0) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 427 | return -1; |
| 428 | |
| 429 | /* Clean up the jobring structure maintained by software */ |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 430 | jr_sw_cleanup(sec_idx, caam); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 431 | |
| 432 | return 0; |
| 433 | } |
| 434 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 435 | int jr_reset(void) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 436 | { |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 437 | return jr_reset_sec(0); |
| 438 | } |
| 439 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 440 | int sec_reset(void) |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 441 | { |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 442 | struct caam_regs *caam; |
| 443 | #if CONFIG_IS_ENABLED(DM) |
| 444 | caam = dev_get_priv(caam_dev); |
| 445 | #else |
| 446 | caam = &caam_st; |
| 447 | #endif |
| 448 | ccsr_sec_t *sec = caam->sec; |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 449 | uint32_t mcfgr = sec_in32(&sec->mcfgr); |
| 450 | uint32_t timeout = 100000; |
| 451 | |
| 452 | mcfgr |= MCFGR_SWRST; |
| 453 | sec_out32(&sec->mcfgr, mcfgr); |
| 454 | |
| 455 | mcfgr |= MCFGR_DMA_RST; |
| 456 | sec_out32(&sec->mcfgr, mcfgr); |
| 457 | do { |
| 458 | mcfgr = sec_in32(&sec->mcfgr); |
| 459 | } while ((mcfgr & MCFGR_DMA_RST) == MCFGR_DMA_RST && --timeout); |
| 460 | |
| 461 | if (timeout == 0) |
| 462 | return -1; |
| 463 | |
| 464 | timeout = 100000; |
| 465 | do { |
| 466 | mcfgr = sec_in32(&sec->mcfgr); |
| 467 | } while ((mcfgr & MCFGR_SWRST) == MCFGR_SWRST && --timeout); |
| 468 | |
| 469 | if (timeout == 0) |
| 470 | return -1; |
| 471 | |
| 472 | return 0; |
| 473 | } |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 474 | |
Michael Walle | b980f9e | 2020-06-27 22:58:52 +0200 | [diff] [blame] | 475 | static int deinstantiate_rng(u8 sec_idx, int state_handle_mask) |
| 476 | { |
| 477 | u32 *desc; |
| 478 | int sh_idx, ret = 0; |
| 479 | int desc_size = ALIGN(sizeof(u32) * 2, ARCH_DMA_MINALIGN); |
| 480 | |
| 481 | desc = memalign(ARCH_DMA_MINALIGN, desc_size); |
| 482 | if (!desc) { |
| 483 | debug("cannot allocate RNG init descriptor memory\n"); |
| 484 | return -ENOMEM; |
| 485 | } |
| 486 | |
| 487 | for (sh_idx = 0; sh_idx < RNG4_MAX_HANDLES; sh_idx++) { |
| 488 | /* |
| 489 | * If the corresponding bit is set, then it means the state |
| 490 | * handle was initialized by us, and thus it needs to be |
| 491 | * deinitialized as well |
| 492 | */ |
| 493 | |
| 494 | if (state_handle_mask & RDSTA_IF(sh_idx)) { |
| 495 | /* |
| 496 | * Create the descriptor for deinstantating this state |
| 497 | * handle. |
| 498 | */ |
| 499 | inline_cnstr_jobdesc_rng_deinstantiation(desc, sh_idx); |
| 500 | flush_dcache_range((unsigned long)desc, |
| 501 | (unsigned long)desc + desc_size); |
| 502 | |
| 503 | ret = run_descriptor_jr_idx(desc, sec_idx); |
| 504 | if (ret) { |
| 505 | printf("SEC%u: RNG4 SH%d deinstantiation failed with error 0x%x\n", |
| 506 | sec_idx, sh_idx, ret); |
| 507 | ret = -EIO; |
| 508 | break; |
| 509 | } |
| 510 | |
| 511 | printf("SEC%u: Deinstantiated RNG4 SH%d\n", |
| 512 | sec_idx, sh_idx); |
| 513 | } |
| 514 | } |
| 515 | |
| 516 | free(desc); |
| 517 | return ret; |
| 518 | } |
| 519 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 520 | static int instantiate_rng(uint8_t sec_idx, ccsr_sec_t *sec, int gen_sk) |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 521 | { |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 522 | u32 *desc; |
| 523 | u32 rdsta_val; |
Lukas Auer | dfaec76 | 2018-01-25 14:11:17 +0100 | [diff] [blame] | 524 | int ret = 0, sh_idx, size; |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 525 | struct rng4tst __iomem *rng = |
| 526 | (struct rng4tst __iomem *)&sec->rng; |
| 527 | |
Raul Cardenas | 0200020 | 2015-02-27 11:22:06 -0600 | [diff] [blame] | 528 | desc = memalign(ARCH_DMA_MINALIGN, sizeof(uint32_t) * 6); |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 529 | if (!desc) { |
| 530 | printf("cannot allocate RNG init descriptor memory\n"); |
| 531 | return -1; |
| 532 | } |
| 533 | |
Lukas Auer | dfaec76 | 2018-01-25 14:11:17 +0100 | [diff] [blame] | 534 | for (sh_idx = 0; sh_idx < RNG4_MAX_HANDLES; sh_idx++) { |
| 535 | /* |
| 536 | * If the corresponding bit is set, this state handle |
| 537 | * was initialized by somebody else, so it's left alone. |
| 538 | */ |
Michael Walle | b980f9e | 2020-06-27 22:58:52 +0200 | [diff] [blame] | 539 | rdsta_val = sec_in32(&rng->rdsta); |
| 540 | if (rdsta_val & (RDSTA_IF(sh_idx))) { |
| 541 | if (rdsta_val & RDSTA_PR(sh_idx)) |
| 542 | continue; |
| 543 | |
| 544 | printf("SEC%u: RNG4 SH%d was instantiated w/o prediction resistance. Tearing it down\n", |
| 545 | sec_idx, sh_idx); |
| 546 | |
| 547 | ret = deinstantiate_rng(sec_idx, RDSTA_IF(sh_idx)); |
| 548 | if (ret) |
| 549 | break; |
| 550 | } |
Raul Cardenas | 0200020 | 2015-02-27 11:22:06 -0600 | [diff] [blame] | 551 | |
Michael Walle | c269a97 | 2020-06-27 22:58:51 +0200 | [diff] [blame] | 552 | inline_cnstr_jobdesc_rng_instantiation(desc, sh_idx, gen_sk); |
Lukas Auer | dfaec76 | 2018-01-25 14:11:17 +0100 | [diff] [blame] | 553 | size = roundup(sizeof(uint32_t) * 6, ARCH_DMA_MINALIGN); |
| 554 | flush_dcache_range((unsigned long)desc, |
| 555 | (unsigned long)desc + size); |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 556 | |
Lukas Auer | dfaec76 | 2018-01-25 14:11:17 +0100 | [diff] [blame] | 557 | ret = run_descriptor_jr_idx(desc, sec_idx); |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 558 | |
Lukas Auer | dfaec76 | 2018-01-25 14:11:17 +0100 | [diff] [blame] | 559 | if (ret) |
Michael Walle | 9b86bf2 | 2020-06-27 22:58:48 +0200 | [diff] [blame] | 560 | printf("SEC%u: RNG4 SH%d instantiation failed with error 0x%x\n", |
| 561 | sec_idx, sh_idx, ret); |
Lukas Auer | dfaec76 | 2018-01-25 14:11:17 +0100 | [diff] [blame] | 562 | |
Michael Walle | b980f9e | 2020-06-27 22:58:52 +0200 | [diff] [blame] | 563 | rdsta_val = sec_in32(&rng->rdsta); |
| 564 | if (!(rdsta_val & RDSTA_IF(sh_idx))) { |
Lukas Auer | dfaec76 | 2018-01-25 14:11:17 +0100 | [diff] [blame] | 565 | free(desc); |
| 566 | return -1; |
| 567 | } |
| 568 | |
| 569 | memset(desc, 0, sizeof(uint32_t) * 6); |
| 570 | } |
| 571 | |
| 572 | free(desc); |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 573 | |
| 574 | return ret; |
| 575 | } |
| 576 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 577 | static u8 get_rng_vid(ccsr_sec_t *sec) |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 578 | { |
Michael Walle | 0dc5961 | 2020-06-27 22:58:50 +0200 | [diff] [blame] | 579 | u8 vid; |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 580 | |
Michael Walle | 0dc5961 | 2020-06-27 22:58:50 +0200 | [diff] [blame] | 581 | if (caam_get_era() < 10) { |
| 582 | vid = (sec_in32(&sec->chavid_ls) & SEC_CHAVID_RNG_LS_MASK) |
| 583 | >> SEC_CHAVID_LS_RNG_SHIFT; |
| 584 | } else { |
| 585 | vid = (sec_in32(&sec->vreg.rng) & CHA_VER_VID_MASK) |
| 586 | >> CHA_VER_VID_SHIFT; |
| 587 | } |
| 588 | |
| 589 | return vid; |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 590 | } |
| 591 | |
| 592 | /* |
| 593 | * By default, the TRNG runs for 200 clocks per sample; |
| 594 | * 1200 clocks per sample generates better entropy. |
| 595 | */ |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 596 | static void kick_trng(int ent_delay, ccsr_sec_t *sec) |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 597 | { |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 598 | struct rng4tst __iomem *rng = |
| 599 | (struct rng4tst __iomem *)&sec->rng; |
| 600 | u32 val; |
| 601 | |
| 602 | /* put RNG4 into program mode */ |
| 603 | sec_setbits32(&rng->rtmctl, RTMCTL_PRGM); |
| 604 | /* rtsdctl bits 0-15 contain "Entropy Delay, which defines the |
| 605 | * length (in system clocks) of each Entropy sample taken |
| 606 | * */ |
| 607 | val = sec_in32(&rng->rtsdctl); |
| 608 | val = (val & ~RTSDCTL_ENT_DLY_MASK) | |
| 609 | (ent_delay << RTSDCTL_ENT_DLY_SHIFT); |
| 610 | sec_out32(&rng->rtsdctl, val); |
| 611 | /* min. freq. count, equal to 1/4 of the entropy sample length */ |
| 612 | sec_out32(&rng->rtfreqmin, ent_delay >> 2); |
Alex Porosanu | 026a3f1 | 2015-05-05 16:48:33 +0300 | [diff] [blame] | 613 | /* disable maximum frequency count */ |
| 614 | sec_out32(&rng->rtfreqmax, RTFRQMAX_DISABLE); |
Alex Porosanu | c406551 | 2015-05-05 16:48:35 +0300 | [diff] [blame] | 615 | /* |
| 616 | * select raw sampling in both entropy shifter |
| 617 | * and statistical checker |
| 618 | */ |
Aneesh Bansal | 3a4800a | 2015-12-08 13:54:30 +0530 | [diff] [blame] | 619 | sec_setbits32(&rng->rtmctl, RTMCTL_SAMP_MODE_RAW_ES_SC); |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 620 | /* put RNG4 into run mode */ |
Aneesh Bansal | 3a4800a | 2015-12-08 13:54:30 +0530 | [diff] [blame] | 621 | sec_clrbits32(&rng->rtmctl, RTMCTL_PRGM); |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 622 | } |
| 623 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 624 | static int rng_init(uint8_t sec_idx, ccsr_sec_t *sec) |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 625 | { |
Gaurav Jain | 0c45c77 | 2022-04-15 16:40:49 +0530 | [diff] [blame] | 626 | int ret, gen_sk, ent_delay = RTSDCTL_ENT_DLY; |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 627 | struct rng4tst __iomem *rng = |
| 628 | (struct rng4tst __iomem *)&sec->rng; |
Lukas Auer | dfaec76 | 2018-01-25 14:11:17 +0100 | [diff] [blame] | 629 | u32 inst_handles; |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 630 | |
Michael Walle | c269a97 | 2020-06-27 22:58:51 +0200 | [diff] [blame] | 631 | gen_sk = !(sec_in32(&rng->rdsta) & RDSTA_SKVN); |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 632 | do { |
Michael Walle | b980f9e | 2020-06-27 22:58:52 +0200 | [diff] [blame] | 633 | inst_handles = sec_in32(&rng->rdsta) & RDSTA_MASK; |
Lukas Auer | dfaec76 | 2018-01-25 14:11:17 +0100 | [diff] [blame] | 634 | |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 635 | /* |
| 636 | * If either of the SH's were instantiated by somebody else |
| 637 | * then it is assumed that the entropy |
| 638 | * parameters are properly set and thus the function |
| 639 | * setting these (kick_trng(...)) is skipped. |
| 640 | * Also, if a handle was instantiated, do not change |
| 641 | * the TRNG parameters. |
| 642 | */ |
Lukas Auer | dfaec76 | 2018-01-25 14:11:17 +0100 | [diff] [blame] | 643 | if (!inst_handles) { |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 644 | kick_trng(ent_delay, sec); |
Lukas Auer | dfaec76 | 2018-01-25 14:11:17 +0100 | [diff] [blame] | 645 | ent_delay += 400; |
| 646 | } |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 647 | /* |
| 648 | * if instantiate_rng(...) fails, the loop will rerun |
| 649 | * and the kick_trng(...) function will modfiy the |
| 650 | * upper and lower limits of the entropy sampling |
| 651 | * interval, leading to a sucessful initialization of |
| 652 | * the RNG. |
| 653 | */ |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 654 | ret = instantiate_rng(sec_idx, sec, gen_sk); |
Gaurav Jain | 0c45c77 | 2022-04-15 16:40:49 +0530 | [diff] [blame] | 655 | /* |
| 656 | * entropy delay is calculated via self-test method. |
| 657 | * self-test are run across different volatge, temp. |
| 658 | * if worst case value for ent_dly is identified, |
| 659 | * loop can be skipped for that platform. |
| 660 | */ |
| 661 | if (IS_ENABLED(CONFIG_MX6SX)) |
| 662 | break; |
| 663 | |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 664 | } while ((ret == -1) && (ent_delay < RTSDCTL_ENT_DLY_MAX)); |
| 665 | if (ret) { |
Michael Walle | 9b86bf2 | 2020-06-27 22:58:48 +0200 | [diff] [blame] | 666 | printf("SEC%u: Failed to instantiate RNG\n", sec_idx); |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 667 | return ret; |
| 668 | } |
| 669 | |
| 670 | /* Enable RDB bit so that RNG works faster */ |
| 671 | sec_setbits32(&sec->scfgr, SEC_SCFGR_RDBENABLE); |
| 672 | |
| 673 | return ret; |
| 674 | } |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 675 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 676 | int sec_init_idx(uint8_t sec_idx) |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 677 | { |
horia.geanta@freescale.com | 3ef2412 | 2015-07-08 17:24:57 +0300 | [diff] [blame] | 678 | int ret = 0; |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 679 | struct caam_regs *caam; |
| 680 | #if CONFIG_IS_ENABLED(DM) |
| 681 | if (!caam_dev) { |
| 682 | printf("caam_jr: caam not found\n"); |
| 683 | return -1; |
| 684 | } |
| 685 | caam = dev_get_priv(caam_dev); |
| 686 | #else |
| 687 | caam_st.sec = (void *)SEC_ADDR(sec_idx); |
| 688 | caam_st.regs = (struct jr_regs *)SEC_JR0_ADDR(sec_idx); |
| 689 | caam_st.jrid = 0; |
| 690 | caam = &caam_st; |
| 691 | #endif |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 692 | #if CONFIG_IS_ENABLED(OF_CONTROL) |
| 693 | ofnode scu_node = ofnode_by_compatible(ofnode_null(), "fsl,imx8-mu"); |
| 694 | |
| 695 | if (ofnode_valid(scu_node)) |
| 696 | goto init; |
| 697 | #endif |
| 698 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 699 | ccsr_sec_t *sec = caam->sec; |
| 700 | uint32_t mcr = sec_in32(&sec->mcfgr); |
| 701 | #if defined(CONFIG_SPL_BUILD) && defined(CONFIG_IMX8M) |
| 702 | uint32_t jrdid_ms = 0; |
| 703 | #endif |
Aneesh Bansal | f698e9f | 2016-01-22 17:05:59 +0530 | [diff] [blame] | 704 | #ifdef CONFIG_FSL_CORENET |
| 705 | uint32_t liodnr; |
| 706 | uint32_t liodn_ns; |
| 707 | uint32_t liodn_s; |
| 708 | #endif |
| 709 | |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 710 | if (!(sec_idx < CONFIG_SYS_FSL_MAX_NUM_OF_SEC)) { |
Michael Walle | 9b86bf2 | 2020-06-27 22:58:48 +0200 | [diff] [blame] | 711 | printf("SEC%u: initialization failed\n", sec_idx); |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 712 | return -1; |
| 713 | } |
| 714 | |
Saksham Jain | 8a6f83d | 2016-03-23 16:24:42 +0530 | [diff] [blame] | 715 | /* |
| 716 | * Modifying CAAM Read/Write Attributes |
York Sun | 3c1d218 | 2016-04-04 11:41:26 -0700 | [diff] [blame] | 717 | * For LS2080A |
Saksham Jain | 8a6f83d | 2016-03-23 16:24:42 +0530 | [diff] [blame] | 718 | * For AXI Write - Cacheable, Write Back, Write allocate |
| 719 | * For AXI Read - Cacheable, Read allocate |
York Sun | 3c1d218 | 2016-04-04 11:41:26 -0700 | [diff] [blame] | 720 | * Only For LS2080a, to solve CAAM coherency issues |
Saksham Jain | 8a6f83d | 2016-03-23 16:24:42 +0530 | [diff] [blame] | 721 | */ |
York Sun | 4a3ab19 | 2017-03-27 11:41:01 -0700 | [diff] [blame] | 722 | #ifdef CONFIG_ARCH_LS2080A |
Saksham Jain | 8a6f83d | 2016-03-23 16:24:42 +0530 | [diff] [blame] | 723 | mcr = (mcr & ~MCFGR_AWCACHE_MASK) | (0xb << MCFGR_AWCACHE_SHIFT); |
| 724 | mcr = (mcr & ~MCFGR_ARCACHE_MASK) | (0x6 << MCFGR_ARCACHE_SHIFT); |
| 725 | #else |
horia.geanta@freescale.com | 3ef2412 | 2015-07-08 17:24:57 +0300 | [diff] [blame] | 726 | mcr = (mcr & ~MCFGR_AWCACHE_MASK) | (0x2 << MCFGR_AWCACHE_SHIFT); |
Saksham Jain | 8a6f83d | 2016-03-23 16:24:42 +0530 | [diff] [blame] | 727 | #endif |
| 728 | |
Ye Li | 2ff17d2 | 2021-03-25 17:30:36 +0800 | [diff] [blame] | 729 | #ifdef CONFIG_CAAM_64BIT |
horia.geanta@freescale.com | 3ef2412 | 2015-07-08 17:24:57 +0300 | [diff] [blame] | 730 | mcr |= (1 << MCFGR_PS_SHIFT); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 731 | #endif |
horia.geanta@freescale.com | 3ef2412 | 2015-07-08 17:24:57 +0300 | [diff] [blame] | 732 | sec_out32(&sec->mcfgr, mcr); |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 733 | #if defined(CONFIG_SPL_BUILD) && defined(CONFIG_IMX8M) |
| 734 | jrdid_ms = JRDID_MS_TZ_OWN | JRDID_MS_PRIM_TZ | JRDID_MS_PRIM_DID; |
| 735 | sec_out32(&sec->jrliodnr[caam->jrid].ms, jrdid_ms); |
| 736 | #endif |
| 737 | jr_reset(); |
horia.geanta@freescale.com | 3ef2412 | 2015-07-08 17:24:57 +0300 | [diff] [blame] | 738 | |
Aneesh Bansal | f698e9f | 2016-01-22 17:05:59 +0530 | [diff] [blame] | 739 | #ifdef CONFIG_FSL_CORENET |
Sumit Garg | 8f01397 | 2016-07-14 12:27:51 -0400 | [diff] [blame] | 740 | #ifdef CONFIG_SPL_BUILD |
| 741 | /* |
| 742 | * For SPL Build, Set the Liodns in SEC JR0 for |
| 743 | * creating PAMU entries corresponding to these. |
| 744 | * For normal build, these are set in set_liodns(). |
| 745 | */ |
Tom Rini | 6e7df1d | 2023-01-10 11:19:45 -0500 | [diff] [blame] | 746 | liodn_ns = CFG_SPL_JR0_LIODN_NS & JRNSLIODN_MASK; |
| 747 | liodn_s = CFG_SPL_JR0_LIODN_S & JRSLIODN_MASK; |
Sumit Garg | 8f01397 | 2016-07-14 12:27:51 -0400 | [diff] [blame] | 748 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 749 | liodnr = sec_in32(&sec->jrliodnr[caam->jrid].ls) & |
Sumit Garg | 8f01397 | 2016-07-14 12:27:51 -0400 | [diff] [blame] | 750 | ~(JRNSLIODN_MASK | JRSLIODN_MASK); |
| 751 | liodnr = liodnr | |
| 752 | (liodn_ns << JRNSLIODN_SHIFT) | |
| 753 | (liodn_s << JRSLIODN_SHIFT); |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 754 | sec_out32(&sec->jrliodnr[caam->jrid].ls, liodnr); |
Sumit Garg | 8f01397 | 2016-07-14 12:27:51 -0400 | [diff] [blame] | 755 | #else |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 756 | liodnr = sec_in32(&sec->jrliodnr[caam->jrid].ls); |
Aneesh Bansal | f698e9f | 2016-01-22 17:05:59 +0530 | [diff] [blame] | 757 | liodn_ns = (liodnr & JRNSLIODN_MASK) >> JRNSLIODN_SHIFT; |
| 758 | liodn_s = (liodnr & JRSLIODN_MASK) >> JRSLIODN_SHIFT; |
| 759 | #endif |
Sumit Garg | 8f01397 | 2016-07-14 12:27:51 -0400 | [diff] [blame] | 760 | #endif |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 761 | #if CONFIG_IS_ENABLED(OF_CONTROL) |
| 762 | init: |
| 763 | #endif |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 764 | ret = jr_init(sec_idx, caam); |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 765 | if (ret < 0) { |
Michael Walle | 9b86bf2 | 2020-06-27 22:58:48 +0200 | [diff] [blame] | 766 | printf("SEC%u: initialization failed\n", sec_idx); |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 767 | return -1; |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 768 | } |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 769 | #if CONFIG_IS_ENABLED(OF_CONTROL) |
Gaurav Jain | db74ced | 2022-04-22 16:38:34 +0530 | [diff] [blame] | 770 | if (ofnode_valid(scu_node)) { |
| 771 | if (IS_ENABLED(CONFIG_DM_RNG)) { |
| 772 | ret = device_bind_driver(NULL, "caam-rng", "caam-rng", NULL); |
| 773 | if (ret) |
| 774 | printf("Couldn't bind rng driver (%d)\n", ret); |
| 775 | } |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 776 | return ret; |
Gaurav Jain | db74ced | 2022-04-22 16:38:34 +0530 | [diff] [blame] | 777 | } |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 778 | #endif |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 779 | |
Aneesh Bansal | f698e9f | 2016-01-22 17:05:59 +0530 | [diff] [blame] | 780 | #ifdef CONFIG_FSL_CORENET |
| 781 | ret = sec_config_pamu_table(liodn_ns, liodn_s); |
| 782 | if (ret < 0) |
| 783 | return -1; |
| 784 | |
| 785 | pamu_enable(); |
| 786 | #endif |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 787 | |
| 788 | if (get_rng_vid(caam->sec) >= 4) { |
| 789 | if (rng_init(sec_idx, caam->sec) < 0) { |
Michael Walle | 9b86bf2 | 2020-06-27 22:58:48 +0200 | [diff] [blame] | 790 | printf("SEC%u: RNG instantiation failed\n", sec_idx); |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 791 | return -1; |
| 792 | } |
Michael Walle | ea95f21 | 2020-06-27 22:58:53 +0200 | [diff] [blame] | 793 | |
| 794 | if (IS_ENABLED(CONFIG_DM_RNG)) { |
| 795 | ret = device_bind_driver(NULL, "caam-rng", "caam-rng", |
| 796 | NULL); |
| 797 | if (ret) |
| 798 | printf("Couldn't bind rng driver (%d)\n", ret); |
| 799 | } |
| 800 | |
Michael Walle | 9b86bf2 | 2020-06-27 22:58:48 +0200 | [diff] [blame] | 801 | printf("SEC%u: RNG instantiated\n", sec_idx); |
Ruchika Gupta | c5de15c | 2014-10-07 15:46:20 +0530 | [diff] [blame] | 802 | } |
Ruchika Gupta | b9eebfa | 2014-10-15 11:35:30 +0530 | [diff] [blame] | 803 | return ret; |
| 804 | } |
Alex Porosanu | 76394c9 | 2016-04-29 15:18:00 +0300 | [diff] [blame] | 805 | |
| 806 | int sec_init(void) |
| 807 | { |
| 808 | return sec_init_idx(0); |
| 809 | } |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 810 | |
| 811 | #if CONFIG_IS_ENABLED(DM) |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 812 | static int jr_power_on(ofnode node) |
| 813 | { |
| 814 | #if CONFIG_IS_ENABLED(POWER_DOMAIN) |
| 815 | struct udevice __maybe_unused jr_dev; |
| 816 | struct power_domain pd; |
| 817 | |
| 818 | dev_set_ofnode(&jr_dev, node); |
| 819 | |
| 820 | /* Power on Job Ring before access it */ |
| 821 | if (!power_domain_get(&jr_dev, &pd)) { |
| 822 | if (power_domain_on(&pd)) |
| 823 | return -EINVAL; |
| 824 | } |
| 825 | #endif |
| 826 | return 0; |
| 827 | } |
| 828 | |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 829 | static int caam_jr_ioctl(struct udevice *dev, unsigned long request, void *buf) |
| 830 | { |
| 831 | if (request != CAAM_JR_RUN_DESC) |
| 832 | return -ENOSYS; |
| 833 | |
| 834 | return run_descriptor_jr(buf); |
| 835 | } |
| 836 | |
| 837 | static int caam_jr_probe(struct udevice *dev) |
| 838 | { |
| 839 | struct caam_regs *caam = dev_get_priv(dev); |
| 840 | fdt_addr_t addr; |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 841 | ofnode node, scu_node; |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 842 | unsigned int jr_node = 0; |
| 843 | |
| 844 | caam_dev = dev; |
| 845 | |
| 846 | addr = dev_read_addr(dev); |
| 847 | if (addr == FDT_ADDR_T_NONE) { |
| 848 | printf("caam_jr: crypto not found\n"); |
| 849 | return -EINVAL; |
| 850 | } |
| 851 | caam->sec = (ccsr_sec_t *)(uintptr_t)addr; |
| 852 | caam->regs = (struct jr_regs *)caam->sec; |
| 853 | |
| 854 | /* Check for enabled job ring node */ |
| 855 | ofnode_for_each_subnode(node, dev_ofnode(dev)) { |
Simon Glass | 8909066 | 2022-09-06 20:27:17 -0600 | [diff] [blame] | 856 | if (!ofnode_is_enabled(node)) |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 857 | continue; |
| 858 | |
| 859 | jr_node = ofnode_read_u32_default(node, "reg", -1); |
| 860 | if (jr_node > 0) { |
| 861 | caam->regs = (struct jr_regs *)((ulong)caam->sec + jr_node); |
| 862 | while (!(jr_node & 0x0F)) |
| 863 | jr_node = jr_node >> 4; |
| 864 | |
| 865 | caam->jrid = jr_node - 1; |
Gaurav Jain | cb5d041 | 2022-03-24 11:50:33 +0530 | [diff] [blame] | 866 | scu_node = ofnode_by_compatible(ofnode_null(), "fsl,imx8-mu"); |
| 867 | if (ofnode_valid(scu_node)) { |
| 868 | if (jr_power_on(node)) |
| 869 | return -EINVAL; |
| 870 | } |
Gaurav Jain | 4556cf8 | 2022-03-24 11:50:25 +0530 | [diff] [blame] | 871 | break; |
| 872 | } |
| 873 | } |
| 874 | |
| 875 | if (sec_init()) |
| 876 | printf("\nsec_init failed!\n"); |
| 877 | |
| 878 | return 0; |
| 879 | } |
| 880 | |
| 881 | static int caam_jr_bind(struct udevice *dev) |
| 882 | { |
| 883 | return 0; |
| 884 | } |
| 885 | |
| 886 | static const struct misc_ops caam_jr_ops = { |
| 887 | .ioctl = caam_jr_ioctl, |
| 888 | }; |
| 889 | |
| 890 | static const struct udevice_id caam_jr_match[] = { |
| 891 | { .compatible = "fsl,sec-v4.0" }, |
| 892 | { } |
| 893 | }; |
| 894 | |
| 895 | U_BOOT_DRIVER(caam_jr) = { |
| 896 | .name = "caam_jr", |
| 897 | .id = UCLASS_MISC, |
| 898 | .of_match = caam_jr_match, |
| 899 | .ops = &caam_jr_ops, |
| 900 | .bind = caam_jr_bind, |
| 901 | .probe = caam_jr_probe, |
| 902 | .priv_auto = sizeof(struct caam_regs), |
| 903 | }; |
| 904 | #endif |