1 // SPDX-License-Identifier: GPL-2.0 OR MIT
4 #include <linux/interrupt.h>
5 #include <linux/iopoll.h>
6 #include <linux/device.h>
7 #include <linux/slab.h>
9 #include <drm/lima_drm.h>
11 #include "lima_device.h"
13 #include "lima_regs.h"
15 #define gp_write(reg, data) writel(data, ip->iomem + reg)
16 #define gp_read(reg) readl(ip->iomem + reg)
18 static irqreturn_t lima_gp_irq_handler(int irq, void *data)
20 struct lima_ip *ip = data;
21 struct lima_device *dev = ip->dev;
22 struct lima_sched_pipe *pipe = dev->pipe + lima_pipe_gp;
23 u32 state = gp_read(LIMA_GP_INT_STAT);
24 u32 status = gp_read(LIMA_GP_STATUS);
27 /* for shared irq case */
31 if (state & LIMA_GP_IRQ_MASK_ERROR) {
32 dev_err(dev->dev, "gp error irq state=%x status=%x\n",
35 /* mask all interrupts before hard reset */
36 gp_write(LIMA_GP_INT_MASK, 0);
41 bool valid = state & (LIMA_GP_IRQ_VS_END_CMD_LST |
42 LIMA_GP_IRQ_PLBU_END_CMD_LST);
43 bool active = status & (LIMA_GP_STATUS_VS_ACTIVE |
44 LIMA_GP_STATUS_PLBU_ACTIVE);
45 done = valid && !active;
48 gp_write(LIMA_GP_INT_CLEAR, state);
51 lima_sched_pipe_task_done(pipe);
56 static void lima_gp_soft_reset_async(struct lima_ip *ip)
58 if (ip->data.async_reset)
61 gp_write(LIMA_GP_INT_MASK, 0);
62 gp_write(LIMA_GP_INT_CLEAR, LIMA_GP_IRQ_RESET_COMPLETED);
63 gp_write(LIMA_GP_CMD, LIMA_GP_CMD_SOFT_RESET);
64 ip->data.async_reset = true;
67 static int lima_gp_soft_reset_async_wait(struct lima_ip *ip)
69 struct lima_device *dev = ip->dev;
73 if (!ip->data.async_reset)
76 err = readl_poll_timeout(ip->iomem + LIMA_GP_INT_RAWSTAT, v,
77 v & LIMA_GP_IRQ_RESET_COMPLETED,
80 dev_err(dev->dev, "gp soft reset time out\n");
84 gp_write(LIMA_GP_INT_CLEAR, LIMA_GP_IRQ_MASK_ALL);
85 gp_write(LIMA_GP_INT_MASK, LIMA_GP_IRQ_MASK_USED);
87 ip->data.async_reset = false;
91 static int lima_gp_task_validate(struct lima_sched_pipe *pipe,
92 struct lima_sched_task *task)
94 struct drm_lima_gp_frame *frame = task->frame;
95 u32 *f = frame->frame;
98 if (f[LIMA_GP_VSCL_START_ADDR >> 2] >
99 f[LIMA_GP_VSCL_END_ADDR >> 2] ||
100 f[LIMA_GP_PLBUCL_START_ADDR >> 2] >
101 f[LIMA_GP_PLBUCL_END_ADDR >> 2] ||
102 f[LIMA_GP_PLBU_ALLOC_START_ADDR >> 2] >
103 f[LIMA_GP_PLBU_ALLOC_END_ADDR >> 2])
106 if (f[LIMA_GP_VSCL_START_ADDR >> 2] ==
107 f[LIMA_GP_VSCL_END_ADDR >> 2] &&
108 f[LIMA_GP_PLBUCL_START_ADDR >> 2] ==
109 f[LIMA_GP_PLBUCL_END_ADDR >> 2])
115 static void lima_gp_task_run(struct lima_sched_pipe *pipe,
116 struct lima_sched_task *task)
118 struct lima_ip *ip = pipe->processor[0];
119 struct drm_lima_gp_frame *frame = task->frame;
120 u32 *f = frame->frame;
124 if (f[LIMA_GP_VSCL_START_ADDR >> 2] !=
125 f[LIMA_GP_VSCL_END_ADDR >> 2])
126 cmd |= LIMA_GP_CMD_START_VS;
127 if (f[LIMA_GP_PLBUCL_START_ADDR >> 2] !=
128 f[LIMA_GP_PLBUCL_END_ADDR >> 2])
129 cmd |= LIMA_GP_CMD_START_PLBU;
131 /* before any hw ops, wait last success task async soft reset */
132 lima_gp_soft_reset_async_wait(ip);
134 for (i = 0; i < LIMA_GP_FRAME_REG_NUM; i++)
135 writel(f[i], ip->iomem + LIMA_GP_VSCL_START_ADDR + i * 4);
137 gp_write(LIMA_GP_CMD, LIMA_GP_CMD_UPDATE_PLBU_ALLOC);
138 gp_write(LIMA_GP_CMD, cmd);
141 static int lima_gp_hard_reset_poll(struct lima_ip *ip)
143 gp_write(LIMA_GP_PERF_CNT_0_LIMIT, 0xC01A0000);
144 return gp_read(LIMA_GP_PERF_CNT_0_LIMIT) == 0xC01A0000;
147 static int lima_gp_hard_reset(struct lima_ip *ip)
149 struct lima_device *dev = ip->dev;
152 gp_write(LIMA_GP_PERF_CNT_0_LIMIT, 0xC0FFE000);
153 gp_write(LIMA_GP_INT_MASK, 0);
154 gp_write(LIMA_GP_CMD, LIMA_GP_CMD_RESET);
155 ret = lima_poll_timeout(ip, lima_gp_hard_reset_poll, 10, 100);
157 dev_err(dev->dev, "gp hard reset timeout\n");
161 gp_write(LIMA_GP_PERF_CNT_0_LIMIT, 0);
162 gp_write(LIMA_GP_INT_CLEAR, LIMA_GP_IRQ_MASK_ALL);
163 gp_write(LIMA_GP_INT_MASK, LIMA_GP_IRQ_MASK_USED);
167 static void lima_gp_task_fini(struct lima_sched_pipe *pipe)
169 lima_gp_soft_reset_async(pipe->processor[0]);
172 static void lima_gp_task_error(struct lima_sched_pipe *pipe)
174 struct lima_ip *ip = pipe->processor[0];
176 dev_err(ip->dev->dev, "gp task error int_state=%x status=%x\n",
177 gp_read(LIMA_GP_INT_STAT), gp_read(LIMA_GP_STATUS));
179 lima_gp_hard_reset(ip);
182 static void lima_gp_task_mmu_error(struct lima_sched_pipe *pipe)
184 lima_sched_pipe_task_done(pipe);
187 static void lima_gp_print_version(struct lima_ip *ip)
189 u32 version, major, minor;
192 version = gp_read(LIMA_GP_VERSION);
193 major = (version >> 8) & 0xFF;
194 minor = version & 0xFF;
195 switch (version >> 16) {
212 dev_info(ip->dev->dev, "%s - %s version major %d minor %d\n",
213 lima_ip_name(ip), name, major, minor);
216 static struct kmem_cache *lima_gp_task_slab;
217 static int lima_gp_task_slab_refcnt;
219 int lima_gp_init(struct lima_ip *ip)
221 struct lima_device *dev = ip->dev;
224 lima_gp_print_version(ip);
226 ip->data.async_reset = false;
227 lima_gp_soft_reset_async(ip);
228 err = lima_gp_soft_reset_async_wait(ip);
232 err = devm_request_irq(dev->dev, ip->irq, lima_gp_irq_handler,
233 IRQF_SHARED, lima_ip_name(ip), ip);
235 dev_err(dev->dev, "gp %s fail to request irq\n",
240 dev->gp_version = gp_read(LIMA_GP_VERSION);
245 void lima_gp_fini(struct lima_ip *ip)
250 int lima_gp_pipe_init(struct lima_device *dev)
252 int frame_size = sizeof(struct drm_lima_gp_frame);
253 struct lima_sched_pipe *pipe = dev->pipe + lima_pipe_gp;
255 if (!lima_gp_task_slab) {
256 lima_gp_task_slab = kmem_cache_create_usercopy(
257 "lima_gp_task", sizeof(struct lima_sched_task) + frame_size,
258 0, SLAB_HWCACHE_ALIGN, sizeof(struct lima_sched_task),
260 if (!lima_gp_task_slab)
263 lima_gp_task_slab_refcnt++;
265 pipe->frame_size = frame_size;
266 pipe->task_slab = lima_gp_task_slab;
268 pipe->task_validate = lima_gp_task_validate;
269 pipe->task_run = lima_gp_task_run;
270 pipe->task_fini = lima_gp_task_fini;
271 pipe->task_error = lima_gp_task_error;
272 pipe->task_mmu_error = lima_gp_task_mmu_error;
277 void lima_gp_pipe_fini(struct lima_device *dev)
279 if (!--lima_gp_task_slab_refcnt) {
280 kmem_cache_destroy(lima_gp_task_slab);
281 lima_gp_task_slab = NULL;