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/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
;