Lines Matching refs:tee

18 #include <linux/psp-tee.h>
21 #include "tee-dev.h"
25 static int tee_alloc_ring(struct psp_tee_device *tee, int ring_size)
27 	struct ring_buf_manager *rb_mgr = &tee->rb_mgr;
49 static void tee_free_ring(struct psp_tee_device *tee)
51 	struct ring_buf_manager *rb_mgr = &tee->rb_mgr;
65 static int tee_wait_cmd_poll(struct psp_tee_device *tee, unsigned int timeout,
72 		*reg = ioread32(tee->io_regs + tee->vdata->cmdresp_reg);
79 	dev_err(tee->dev, "tee: command timed out, disabling PSP\n");
86 struct tee_init_ring_cmd *tee_alloc_cmd_buffer(struct psp_tee_device *tee)
94 	cmd->hi_addr = upper_32_bits(tee->rb_mgr.ring_pa);
95 	cmd->low_addr = lower_32_bits(tee->rb_mgr.ring_pa);
96 	cmd->size = tee->rb_mgr.ring_size;
98 	dev_dbg(tee->dev, "tee: ring address: high = 0x%x low = 0x%x size = %u\n",
109 static int tee_init_ring(struct psp_tee_device *tee)
119 	ret = tee_alloc_ring(tee, ring_size);
121 		dev_err(tee->dev, "tee: ring allocation failed %d\n", ret);
125 	tee->rb_mgr.wptr = 0;
127 	cmd = tee_alloc_cmd_buffer(tee);
129 		tee_free_ring(tee);
140 		  tee->io_regs + tee->vdata->cmdbuff_addr_lo_reg);
142 		  tee->io_regs + tee->vdata->cmdbuff_addr_hi_reg);
144 		  tee->io_regs + tee->vdata->cmdresp_reg);
146 	ret = tee_wait_cmd_poll(tee, TEE_DEFAULT_TIMEOUT, &reg);
148 		dev_err(tee->dev, "tee: ring init command timed out\n");
149 		tee_free_ring(tee);
154 		dev_err(tee->dev, "tee: ring init command failed (%#010lx)\n",
156 		tee_free_ring(tee);
166 static void tee_destroy_ring(struct psp_tee_device *tee)
171 	if (!tee->rb_mgr.ring_start)
178 		  tee->io_regs + tee->vdata->cmdresp_reg);
180 	ret = tee_wait_cmd_poll(tee, TEE_DEFAULT_TIMEOUT, &reg);
182 		dev_err(tee->dev, "tee: ring destroy command timed out\n");
184 		dev_err(tee->dev, "tee: ring destroy command failed (%#010lx)\n",
189 	tee_free_ring(tee);
195 	struct psp_tee_device *tee;
199 	tee = devm_kzalloc(dev, sizeof(*tee), GFP_KERNEL);
200 	if (!tee)
203 	psp->tee_data = tee;
205 	tee->dev = dev;
206 	tee->psp = psp;
208 	tee->io_regs = psp->io_regs;
210 	tee->vdata = (struct tee_vdata *)psp->vdata->tee;
211 	if (!tee->vdata) {
213 		dev_err(dev, "tee: missing driver data\n");
217 	ret = tee_init_ring(tee);
219 		dev_err(dev, "tee: failed to init ring buffer\n");
223 	dev_notice(dev, "tee enabled\n");
230 	dev_notice(dev, "tee initialization failed\n");
237 	struct psp_tee_device *tee = psp->tee_data;
239 	if (!tee)
242 	tee_destroy_ring(tee);
245 static int tee_submit_cmd(struct psp_tee_device *tee, enum tee_cmd_id cmd_id,
254 	mutex_lock(&tee->rb_mgr.mutex);
260 			(tee->rb_mgr.ring_start + tee->rb_mgr.wptr);
262 		rptr = ioread32(tee->io_regs + tee->vdata->ring_rptr_reg);
267 		if (!(tee->rb_mgr.wptr + sizeof(struct tee_ring_cmd) == rptr ||
271 		dev_dbg(tee->dev, "tee: ring buffer full. rptr = %u wptr = %u\n",
272 			rptr, tee->rb_mgr.wptr);
275 		mutex_unlock(&tee->rb_mgr.mutex);
277 		mutex_lock(&tee->rb_mgr.mutex);
282 	    (tee->rb_mgr.wptr + sizeof(struct tee_ring_cmd) == rptr ||
284 		dev_err(tee->dev, "tee: ring buffer full. rptr = %u wptr = %u response flag %u\n",
285 			rptr, tee->rb_mgr.wptr, cmd->flag);
308 	tee->rb_mgr.wptr += sizeof(struct tee_ring_cmd);
309 	if (tee->rb_mgr.wptr >= tee->rb_mgr.ring_size)
310 		tee->rb_mgr.wptr = 0;
313 	iowrite32(tee->rb_mgr.wptr, tee->io_regs + tee->vdata->ring_wptr_reg);
321 	mutex_unlock(&tee->rb_mgr.mutex);
326 static int tee_wait_cmd_completion(struct psp_tee_device *tee,
340 	dev_err(tee->dev, "tee: command 0x%x timed out, disabling PSP\n",
352 	struct psp_tee_device *tee;
367 	tee = psp->tee_data;
369 	ret = tee_submit_cmd(tee, cmd_id, buf, len, &resp);
373 	ret = tee_wait_cmd_completion(tee, resp, TEE_DEFAULT_TIMEOUT);