treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / gpu / drm / lima / lima_pp.c
blob8fef224b93c8568fc70bd483739a7cd84d5e49e6
1 // SPDX-License-Identifier: GPL-2.0 OR MIT
2 /* Copyright 2017-2019 Qiang Yu <yuq825@gmail.com> */
4 #include <linux/interrupt.h>
5 #include <linux/io.h>
6 #include <linux/device.h>
7 #include <linux/slab.h>
9 #include <drm/lima_drm.h>
11 #include "lima_device.h"
12 #include "lima_pp.h"
13 #include "lima_dlbu.h"
14 #include "lima_bcast.h"
15 #include "lima_vm.h"
16 #include "lima_regs.h"
18 #define pp_write(reg, data) writel(data, ip->iomem + reg)
19 #define pp_read(reg) readl(ip->iomem + reg)
21 static void lima_pp_handle_irq(struct lima_ip *ip, u32 state)
23 struct lima_device *dev = ip->dev;
24 struct lima_sched_pipe *pipe = dev->pipe + lima_pipe_pp;
26 if (state & LIMA_PP_IRQ_MASK_ERROR) {
27 u32 status = pp_read(LIMA_PP_STATUS);
29 dev_err(dev->dev, "pp error irq state=%x status=%x\n",
30 state, status);
32 pipe->error = true;
34 /* mask all interrupts before hard reset */
35 pp_write(LIMA_PP_INT_MASK, 0);
38 pp_write(LIMA_PP_INT_CLEAR, state);
41 static irqreturn_t lima_pp_irq_handler(int irq, void *data)
43 struct lima_ip *ip = data;
44 struct lima_device *dev = ip->dev;
45 struct lima_sched_pipe *pipe = dev->pipe + lima_pipe_pp;
46 u32 state = pp_read(LIMA_PP_INT_STATUS);
48 /* for shared irq case */
49 if (!state)
50 return IRQ_NONE;
52 lima_pp_handle_irq(ip, state);
54 if (atomic_dec_and_test(&pipe->task))
55 lima_sched_pipe_task_done(pipe);
57 return IRQ_HANDLED;
60 static irqreturn_t lima_pp_bcast_irq_handler(int irq, void *data)
62 int i;
63 irqreturn_t ret = IRQ_NONE;
64 struct lima_ip *pp_bcast = data;
65 struct lima_device *dev = pp_bcast->dev;
66 struct lima_sched_pipe *pipe = dev->pipe + lima_pipe_pp;
67 struct drm_lima_m450_pp_frame *frame;
69 /* for shared irq case */
70 if (!pipe->current_task)
71 return IRQ_NONE;
73 frame = pipe->current_task->frame;
75 for (i = 0; i < frame->num_pp; i++) {
76 struct lima_ip *ip = pipe->processor[i];
77 u32 status, state;
79 if (pipe->done & (1 << i))
80 continue;
82 /* status read first in case int state change in the middle
83 * which may miss the interrupt handling
85 status = pp_read(LIMA_PP_STATUS);
86 state = pp_read(LIMA_PP_INT_STATUS);
88 if (state) {
89 lima_pp_handle_irq(ip, state);
90 ret = IRQ_HANDLED;
91 } else {
92 if (status & LIMA_PP_STATUS_RENDERING_ACTIVE)
93 continue;
96 pipe->done |= (1 << i);
97 if (atomic_dec_and_test(&pipe->task))
98 lima_sched_pipe_task_done(pipe);
101 return ret;
104 static void lima_pp_soft_reset_async(struct lima_ip *ip)
106 if (ip->data.async_reset)
107 return;
109 pp_write(LIMA_PP_INT_MASK, 0);
110 pp_write(LIMA_PP_INT_RAWSTAT, LIMA_PP_IRQ_MASK_ALL);
111 pp_write(LIMA_PP_CTRL, LIMA_PP_CTRL_SOFT_RESET);
112 ip->data.async_reset = true;
115 static int lima_pp_soft_reset_poll(struct lima_ip *ip)
117 return !(pp_read(LIMA_PP_STATUS) & LIMA_PP_STATUS_RENDERING_ACTIVE) &&
118 pp_read(LIMA_PP_INT_RAWSTAT) == LIMA_PP_IRQ_RESET_COMPLETED;
121 static int lima_pp_soft_reset_async_wait_one(struct lima_ip *ip)
123 struct lima_device *dev = ip->dev;
124 int ret;
126 ret = lima_poll_timeout(ip, lima_pp_soft_reset_poll, 0, 100);
127 if (ret) {
128 dev_err(dev->dev, "pp %s reset time out\n", lima_ip_name(ip));
129 return ret;
132 pp_write(LIMA_PP_INT_CLEAR, LIMA_PP_IRQ_MASK_ALL);
133 pp_write(LIMA_PP_INT_MASK, LIMA_PP_IRQ_MASK_USED);
134 return 0;
137 static int lima_pp_soft_reset_async_wait(struct lima_ip *ip)
139 int i, err = 0;
141 if (!ip->data.async_reset)
142 return 0;
144 if (ip->id == lima_ip_pp_bcast) {
145 struct lima_device *dev = ip->dev;
146 struct lima_sched_pipe *pipe = dev->pipe + lima_pipe_pp;
147 struct drm_lima_m450_pp_frame *frame = pipe->current_task->frame;
149 for (i = 0; i < frame->num_pp; i++)
150 err |= lima_pp_soft_reset_async_wait_one(pipe->processor[i]);
151 } else
152 err = lima_pp_soft_reset_async_wait_one(ip);
154 ip->data.async_reset = false;
155 return err;
158 static void lima_pp_write_frame(struct lima_ip *ip, u32 *frame, u32 *wb)
160 int i, j, n = 0;
162 for (i = 0; i < LIMA_PP_FRAME_REG_NUM; i++)
163 writel(frame[i], ip->iomem + LIMA_PP_FRAME + i * 4);
165 for (i = 0; i < 3; i++) {
166 for (j = 0; j < LIMA_PP_WB_REG_NUM; j++)
167 writel(wb[n++], ip->iomem + LIMA_PP_WB(i) + j * 4);
171 static int lima_pp_hard_reset_poll(struct lima_ip *ip)
173 pp_write(LIMA_PP_PERF_CNT_0_LIMIT, 0xC01A0000);
174 return pp_read(LIMA_PP_PERF_CNT_0_LIMIT) == 0xC01A0000;
177 static int lima_pp_hard_reset(struct lima_ip *ip)
179 struct lima_device *dev = ip->dev;
180 int ret;
182 pp_write(LIMA_PP_PERF_CNT_0_LIMIT, 0xC0FFE000);
183 pp_write(LIMA_PP_INT_MASK, 0);
184 pp_write(LIMA_PP_CTRL, LIMA_PP_CTRL_FORCE_RESET);
185 ret = lima_poll_timeout(ip, lima_pp_hard_reset_poll, 10, 100);
186 if (ret) {
187 dev_err(dev->dev, "pp hard reset timeout\n");
188 return ret;
191 pp_write(LIMA_PP_PERF_CNT_0_LIMIT, 0);
192 pp_write(LIMA_PP_INT_CLEAR, LIMA_PP_IRQ_MASK_ALL);
193 pp_write(LIMA_PP_INT_MASK, LIMA_PP_IRQ_MASK_USED);
194 return 0;
197 static void lima_pp_print_version(struct lima_ip *ip)
199 u32 version, major, minor;
200 char *name;
202 version = pp_read(LIMA_PP_VERSION);
203 major = (version >> 8) & 0xFF;
204 minor = version & 0xFF;
205 switch (version >> 16) {
206 case 0xC807:
207 name = "mali200";
208 break;
209 case 0xCE07:
210 name = "mali300";
211 break;
212 case 0xCD07:
213 name = "mali400";
214 break;
215 case 0xCF07:
216 name = "mali450";
217 break;
218 default:
219 name = "unknown";
220 break;
222 dev_info(ip->dev->dev, "%s - %s version major %d minor %d\n",
223 lima_ip_name(ip), name, major, minor);
226 int lima_pp_init(struct lima_ip *ip)
228 struct lima_device *dev = ip->dev;
229 int err;
231 lima_pp_print_version(ip);
233 ip->data.async_reset = false;
234 lima_pp_soft_reset_async(ip);
235 err = lima_pp_soft_reset_async_wait(ip);
236 if (err)
237 return err;
239 err = devm_request_irq(dev->dev, ip->irq, lima_pp_irq_handler,
240 IRQF_SHARED, lima_ip_name(ip), ip);
241 if (err) {
242 dev_err(dev->dev, "pp %s fail to request irq\n",
243 lima_ip_name(ip));
244 return err;
247 dev->pp_version = pp_read(LIMA_PP_VERSION);
249 return 0;
252 void lima_pp_fini(struct lima_ip *ip)
257 int lima_pp_bcast_init(struct lima_ip *ip)
259 struct lima_device *dev = ip->dev;
260 int err;
262 err = devm_request_irq(dev->dev, ip->irq, lima_pp_bcast_irq_handler,
263 IRQF_SHARED, lima_ip_name(ip), ip);
264 if (err) {
265 dev_err(dev->dev, "pp %s fail to request irq\n",
266 lima_ip_name(ip));
267 return err;
270 return 0;
273 void lima_pp_bcast_fini(struct lima_ip *ip)
278 static int lima_pp_task_validate(struct lima_sched_pipe *pipe,
279 struct lima_sched_task *task)
281 u32 num_pp;
283 if (pipe->bcast_processor) {
284 struct drm_lima_m450_pp_frame *f = task->frame;
286 num_pp = f->num_pp;
288 if (f->_pad)
289 return -EINVAL;
290 } else {
291 struct drm_lima_m400_pp_frame *f = task->frame;
293 num_pp = f->num_pp;
296 if (num_pp == 0 || num_pp > pipe->num_processor)
297 return -EINVAL;
299 return 0;
302 static void lima_pp_task_run(struct lima_sched_pipe *pipe,
303 struct lima_sched_task *task)
305 if (pipe->bcast_processor) {
306 struct drm_lima_m450_pp_frame *frame = task->frame;
307 struct lima_device *dev = pipe->bcast_processor->dev;
308 struct lima_ip *ip = pipe->bcast_processor;
309 int i;
311 pipe->done = 0;
312 atomic_set(&pipe->task, frame->num_pp);
314 if (frame->use_dlbu) {
315 lima_dlbu_enable(dev, frame->num_pp);
317 frame->frame[LIMA_PP_FRAME >> 2] = LIMA_VA_RESERVE_DLBU;
318 lima_dlbu_set_reg(dev->ip + lima_ip_dlbu, frame->dlbu_regs);
319 } else
320 lima_dlbu_disable(dev);
322 lima_bcast_enable(dev, frame->num_pp);
324 lima_pp_soft_reset_async_wait(ip);
326 lima_pp_write_frame(ip, frame->frame, frame->wb);
328 for (i = 0; i < frame->num_pp; i++) {
329 struct lima_ip *ip = pipe->processor[i];
331 pp_write(LIMA_PP_STACK, frame->fragment_stack_address[i]);
332 if (!frame->use_dlbu)
333 pp_write(LIMA_PP_FRAME, frame->plbu_array_address[i]);
336 pp_write(LIMA_PP_CTRL, LIMA_PP_CTRL_START_RENDERING);
337 } else {
338 struct drm_lima_m400_pp_frame *frame = task->frame;
339 int i;
341 atomic_set(&pipe->task, frame->num_pp);
343 for (i = 0; i < frame->num_pp; i++) {
344 struct lima_ip *ip = pipe->processor[i];
346 frame->frame[LIMA_PP_FRAME >> 2] =
347 frame->plbu_array_address[i];
348 frame->frame[LIMA_PP_STACK >> 2] =
349 frame->fragment_stack_address[i];
351 lima_pp_soft_reset_async_wait(ip);
353 lima_pp_write_frame(ip, frame->frame, frame->wb);
355 pp_write(LIMA_PP_CTRL, LIMA_PP_CTRL_START_RENDERING);
360 static void lima_pp_task_fini(struct lima_sched_pipe *pipe)
362 if (pipe->bcast_processor)
363 lima_pp_soft_reset_async(pipe->bcast_processor);
364 else {
365 int i;
367 for (i = 0; i < pipe->num_processor; i++)
368 lima_pp_soft_reset_async(pipe->processor[i]);
372 static void lima_pp_task_error(struct lima_sched_pipe *pipe)
374 int i;
376 for (i = 0; i < pipe->num_processor; i++) {
377 struct lima_ip *ip = pipe->processor[i];
379 dev_err(ip->dev->dev, "pp task error %d int_state=%x status=%x\n",
380 i, pp_read(LIMA_PP_INT_STATUS), pp_read(LIMA_PP_STATUS));
382 lima_pp_hard_reset(ip);
386 static void lima_pp_task_mmu_error(struct lima_sched_pipe *pipe)
388 if (atomic_dec_and_test(&pipe->task))
389 lima_sched_pipe_task_done(pipe);
392 static struct kmem_cache *lima_pp_task_slab;
393 static int lima_pp_task_slab_refcnt;
395 int lima_pp_pipe_init(struct lima_device *dev)
397 int frame_size;
398 struct lima_sched_pipe *pipe = dev->pipe + lima_pipe_pp;
400 if (dev->id == lima_gpu_mali400)
401 frame_size = sizeof(struct drm_lima_m400_pp_frame);
402 else
403 frame_size = sizeof(struct drm_lima_m450_pp_frame);
405 if (!lima_pp_task_slab) {
406 lima_pp_task_slab = kmem_cache_create_usercopy(
407 "lima_pp_task", sizeof(struct lima_sched_task) + frame_size,
408 0, SLAB_HWCACHE_ALIGN, sizeof(struct lima_sched_task),
409 frame_size, NULL);
410 if (!lima_pp_task_slab)
411 return -ENOMEM;
413 lima_pp_task_slab_refcnt++;
415 pipe->frame_size = frame_size;
416 pipe->task_slab = lima_pp_task_slab;
418 pipe->task_validate = lima_pp_task_validate;
419 pipe->task_run = lima_pp_task_run;
420 pipe->task_fini = lima_pp_task_fini;
421 pipe->task_error = lima_pp_task_error;
422 pipe->task_mmu_error = lima_pp_task_mmu_error;
424 return 0;
427 void lima_pp_pipe_fini(struct lima_device *dev)
429 if (!--lima_pp_task_slab_refcnt) {
430 kmem_cache_destroy(lima_pp_task_slab);
431 lima_pp_task_slab = NULL;