Lines Matching refs:tee
24 static int tee_alloc_ring(struct psp_tee_device *tee, int ring_size) in tee_alloc_ring() argument
26 struct ring_buf_manager *rb_mgr = &tee->rb_mgr; in tee_alloc_ring()
47 static void tee_free_ring(struct psp_tee_device *tee) in tee_free_ring() argument
49 struct ring_buf_manager *rb_mgr = &tee->rb_mgr; in tee_free_ring()
63 static int tee_wait_cmd_poll(struct psp_tee_device *tee, unsigned int timeout, in tee_wait_cmd_poll() argument
70 *reg = ioread32(tee->io_regs + tee->vdata->cmdresp_reg); in tee_wait_cmd_poll()
77 dev_err(tee->dev, "tee: command timed out, disabling PSP\n"); in tee_wait_cmd_poll()
84 struct tee_init_ring_cmd *tee_alloc_cmd_buffer(struct psp_tee_device *tee) in tee_alloc_cmd_buffer() argument
92 cmd->hi_addr = upper_32_bits(tee->rb_mgr.ring_pa); in tee_alloc_cmd_buffer()
93 cmd->low_addr = lower_32_bits(tee->rb_mgr.ring_pa); in tee_alloc_cmd_buffer()
94 cmd->size = tee->rb_mgr.ring_size; in tee_alloc_cmd_buffer()
96 dev_dbg(tee->dev, "tee: ring address: high = 0x%x low = 0x%x size = %u\n", in tee_alloc_cmd_buffer()
107 static int tee_init_ring(struct psp_tee_device *tee) in tee_init_ring() argument
117 ret = tee_alloc_ring(tee, ring_size); in tee_init_ring()
119 dev_err(tee->dev, "tee: ring allocation failed %d\n", ret); in tee_init_ring()
123 tee->rb_mgr.wptr = 0; in tee_init_ring()
125 cmd = tee_alloc_cmd_buffer(tee); in tee_init_ring()
127 tee_free_ring(tee); in tee_init_ring()
138 tee->io_regs + tee->vdata->cmdbuff_addr_lo_reg); in tee_init_ring()
140 tee->io_regs + tee->vdata->cmdbuff_addr_hi_reg); in tee_init_ring()
142 tee->io_regs + tee->vdata->cmdresp_reg); in tee_init_ring()
144 ret = tee_wait_cmd_poll(tee, TEE_DEFAULT_TIMEOUT, ®); in tee_init_ring()
146 dev_err(tee->dev, "tee: ring init command timed out\n"); in tee_init_ring()
147 tee_free_ring(tee); in tee_init_ring()
152 dev_err(tee->dev, "tee: ring init command failed (%#010x)\n", in tee_init_ring()
154 tee_free_ring(tee); in tee_init_ring()
164 static void tee_destroy_ring(struct psp_tee_device *tee) in tee_destroy_ring() argument
169 if (!tee->rb_mgr.ring_start) in tee_destroy_ring()
176 tee->io_regs + tee->vdata->cmdresp_reg); in tee_destroy_ring()
178 ret = tee_wait_cmd_poll(tee, TEE_DEFAULT_TIMEOUT, ®); in tee_destroy_ring()
180 dev_err(tee->dev, "tee: ring destroy command timed out\n"); in tee_destroy_ring()
182 dev_err(tee->dev, "tee: ring destroy command failed (%#010x)\n", in tee_destroy_ring()
187 tee_free_ring(tee); in tee_destroy_ring()
193 struct psp_tee_device *tee; in tee_dev_init() local
197 tee = devm_kzalloc(dev, sizeof(*tee), GFP_KERNEL); in tee_dev_init()
198 if (!tee) in tee_dev_init()
201 psp->tee_data = tee; in tee_dev_init()
203 tee->dev = dev; in tee_dev_init()
204 tee->psp = psp; in tee_dev_init()
206 tee->io_regs = psp->io_regs; in tee_dev_init()
208 tee->vdata = (struct tee_vdata *)psp->vdata->tee; in tee_dev_init()
209 if (!tee->vdata) { in tee_dev_init()
215 ret = tee_init_ring(tee); in tee_dev_init()
235 struct psp_tee_device *tee = psp->tee_data; in tee_dev_destroy() local
237 if (!tee) in tee_dev_destroy()
240 tee_destroy_ring(tee); in tee_dev_destroy()
243 static int tee_submit_cmd(struct psp_tee_device *tee, enum tee_cmd_id cmd_id, in tee_submit_cmd() argument
252 mutex_lock(&tee->rb_mgr.mutex); in tee_submit_cmd()
254 wptr = tee->rb_mgr.wptr; in tee_submit_cmd()
258 rptr = ioread32(tee->io_regs + tee->vdata->ring_rptr_reg); in tee_submit_cmd()
263 dev_info(tee->dev, "tee: ring buffer full. rptr = %u wptr = %u\n", in tee_submit_cmd()
267 mutex_unlock(&tee->rb_mgr.mutex); in tee_submit_cmd()
269 mutex_lock(&tee->rb_mgr.mutex); in tee_submit_cmd()
274 dev_err(tee->dev, "tee: ring buffer full. rptr = %u wptr = %u\n", in tee_submit_cmd()
281 cmd = (struct tee_ring_cmd *)(tee->rb_mgr.ring_start + wptr); in tee_submit_cmd()
290 tee->rb_mgr.wptr += sizeof(struct tee_ring_cmd); in tee_submit_cmd()
291 if (tee->rb_mgr.wptr >= tee->rb_mgr.ring_size) in tee_submit_cmd()
292 tee->rb_mgr.wptr = 0; in tee_submit_cmd()
295 iowrite32(tee->rb_mgr.wptr, tee->io_regs + tee->vdata->ring_wptr_reg); in tee_submit_cmd()
303 mutex_unlock(&tee->rb_mgr.mutex); in tee_submit_cmd()
308 static int tee_wait_cmd_completion(struct psp_tee_device *tee, in tee_wait_cmd_completion() argument
322 dev_err(tee->dev, "tee: command 0x%x timed out, disabling PSP\n", in tee_wait_cmd_completion()
334 struct psp_tee_device *tee; in psp_tee_process_cmd() local
349 tee = psp->tee_data; in psp_tee_process_cmd()
351 ret = tee_submit_cmd(tee, cmd_id, buf, len, &resp); in psp_tee_process_cmd()
355 ret = tee_wait_cmd_completion(tee, resp, TEE_DEFAULT_TIMEOUT); in psp_tee_process_cmd()