Lines Matching refs:tee

17 #include <linux/psp-tee.h>
20 #include "tee-dev.h"
24 static int tee_alloc_ring(struct psp_tee_device *tee, int ring_size)
26 	struct ring_buf_manager *rb_mgr = &tee->rb_mgr;
48 static void tee_free_ring(struct psp_tee_device *tee)
50 	struct ring_buf_manager *rb_mgr = &tee->rb_mgr;
64 static int tee_wait_cmd_poll(struct psp_tee_device *tee, unsigned int timeout,
71 		*reg = ioread32(tee->io_regs + tee->vdata->cmdresp_reg);
78 	dev_err(tee->dev, "tee: command timed out, disabling PSP\n");
85 struct tee_init_ring_cmd *tee_alloc_cmd_buffer(struct psp_tee_device *tee)
93 	cmd->hi_addr = upper_32_bits(tee->rb_mgr.ring_pa);
94 	cmd->low_addr = lower_32_bits(tee->rb_mgr.ring_pa);
95 	cmd->size = tee->rb_mgr.ring_size;
97 	dev_dbg(tee->dev, "tee: ring address: high = 0x%x low = 0x%x size = %u\n",
108 static int tee_init_ring(struct psp_tee_device *tee)
118 	ret = tee_alloc_ring(tee, ring_size);
120 		dev_err(tee->dev, "tee: ring allocation failed %d\n", ret);
124 	tee->rb_mgr.wptr = 0;
126 	cmd = tee_alloc_cmd_buffer(tee);
128 		tee_free_ring(tee);
139 		  tee->io_regs + tee->vdata->cmdbuff_addr_lo_reg);
141 		  tee->io_regs + tee->vdata->cmdbuff_addr_hi_reg);
143 		  tee->io_regs + tee->vdata->cmdresp_reg);
145 	ret = tee_wait_cmd_poll(tee, TEE_DEFAULT_TIMEOUT, &reg);
147 		dev_err(tee->dev, "tee: ring init command timed out\n");
148 		tee_free_ring(tee);
153 		dev_err(tee->dev, "tee: ring init command failed (%#010x)\n",
155 		tee_free_ring(tee);
165 static void tee_destroy_ring(struct psp_tee_device *tee)
170 	if (!tee->rb_mgr.ring_start)
177 		  tee->io_regs + tee->vdata->cmdresp_reg);
179 	ret = tee_wait_cmd_poll(tee, TEE_DEFAULT_TIMEOUT, &reg);
181 		dev_err(tee->dev, "tee: ring destroy command timed out\n");
183 		dev_err(tee->dev, "tee: ring destroy command failed (%#010x)\n",
188 	tee_free_ring(tee);
194 	struct psp_tee_device *tee;
198 	tee = devm_kzalloc(dev, sizeof(*tee), GFP_KERNEL);
199 	if (!tee)
202 	psp->tee_data = tee;
204 	tee->dev = dev;
205 	tee->psp = psp;
207 	tee->io_regs = psp->io_regs;
209 	tee->vdata = (struct tee_vdata *)psp->vdata->tee;
210 	if (!tee->vdata) {
212 		dev_err(dev, "tee: missing driver data\n");
216 	ret = tee_init_ring(tee);
218 		dev_err(dev, "tee: failed to init ring buffer\n");
222 	dev_notice(dev, "tee enabled\n");
229 	dev_notice(dev, "tee initialization failed\n");
236 	struct psp_tee_device *tee = psp->tee_data;
238 	if (!tee)
241 	tee_destroy_ring(tee);
244 static int tee_submit_cmd(struct psp_tee_device *tee, enum tee_cmd_id cmd_id,
253 	mutex_lock(&tee->rb_mgr.mutex);
259 			(tee->rb_mgr.ring_start + tee->rb_mgr.wptr);
261 		rptr = ioread32(tee->io_regs + tee->vdata->ring_rptr_reg);
266 		if (!(tee->rb_mgr.wptr + sizeof(struct tee_ring_cmd) == rptr ||
270 		dev_dbg(tee->dev, "tee: ring buffer full. rptr = %u wptr = %u\n",
271 			rptr, tee->rb_mgr.wptr);
274 		mutex_unlock(&tee->rb_mgr.mutex);
276 		mutex_lock(&tee->rb_mgr.mutex);
281 	    (tee->rb_mgr.wptr + sizeof(struct tee_ring_cmd) == rptr ||
283 		dev_err(tee->dev, "tee: ring buffer full. rptr = %u wptr = %u response flag %u\n",
284 			rptr, tee->rb_mgr.wptr, cmd->flag);
307 	tee->rb_mgr.wptr += sizeof(struct tee_ring_cmd);
308 	if (tee->rb_mgr.wptr >= tee->rb_mgr.ring_size)
309 		tee->rb_mgr.wptr = 0;
312 	iowrite32(tee->rb_mgr.wptr, tee->io_regs + tee->vdata->ring_wptr_reg);
320 	mutex_unlock(&tee->rb_mgr.mutex);
325 static int tee_wait_cmd_completion(struct psp_tee_device *tee,
339 	dev_err(tee->dev, "tee: command 0x%x timed out, disabling PSP\n",
351 	struct psp_tee_device *tee;
366 	tee = psp->tee_data;
368 	ret = tee_submit_cmd(tee, cmd_id, buf, len, &resp);
372 	ret = tee_wait_cmd_completion(tee, resp, TEE_DEFAULT_TIMEOUT);