blob: 44b2ba7b5cc963a82ee971d875c2d35460fbdf9a [file] [log] [blame]
Mark Yao2048e322014-08-22 18:36:26 +08001/*
2 * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
3 * Author:Mark Yao <mark.yao@rock-chips.com>
4 *
5 * This software is licensed under the terms of the GNU General Public
6 * License version 2, as published by the Free Software Foundation, and
7 * may be copied, distributed, and modified under those terms.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 */
14
15#include <drm/drm.h>
16#include <drm/drmP.h>
Mark Yao63ebb9f2015-11-30 18:22:42 +080017#include <drm/drm_atomic.h>
Mark Yao2048e322014-08-22 18:36:26 +080018#include <drm/drm_crtc.h>
19#include <drm/drm_crtc_helper.h>
20#include <drm/drm_plane_helper.h>
21
22#include <linux/kernel.h>
Paul Gortmaker00fe6142015-05-01 20:02:30 -040023#include <linux/module.h>
Mark Yao2048e322014-08-22 18:36:26 +080024#include <linux/platform_device.h>
25#include <linux/clk.h>
26#include <linux/of.h>
27#include <linux/of_device.h>
28#include <linux/pm_runtime.h>
29#include <linux/component.h>
30
31#include <linux/reset.h>
32#include <linux/delay.h>
33
34#include "rockchip_drm_drv.h"
35#include "rockchip_drm_gem.h"
36#include "rockchip_drm_fb.h"
37#include "rockchip_drm_vop.h"
38
Mark Yao2048e322014-08-22 18:36:26 +080039#define __REG_SET_RELAXED(x, off, mask, shift, v) \
40 vop_mask_write_relaxed(x, off, (mask) << shift, (v) << shift)
41#define __REG_SET_NORMAL(x, off, mask, shift, v) \
42 vop_mask_write(x, off, (mask) << shift, (v) << shift)
43
44#define REG_SET(x, base, reg, v, mode) \
45 __REG_SET_##mode(x, base + reg.offset, reg.mask, reg.shift, v)
John Keepingc7647f82016-01-12 18:05:18 +000046#define REG_SET_MASK(x, base, reg, mask, v, mode) \
47 __REG_SET_##mode(x, base + reg.offset, mask, reg.shift, v)
Mark Yao2048e322014-08-22 18:36:26 +080048
49#define VOP_WIN_SET(x, win, name, v) \
50 REG_SET(x, win->base, win->phy->name, v, RELAXED)
Mark Yao4c156c22015-06-26 17:14:46 +080051#define VOP_SCL_SET(x, win, name, v) \
52 REG_SET(x, win->base, win->phy->scl->name, v, RELAXED)
Mark Yao1194fff2015-12-15 09:08:43 +080053#define VOP_SCL_SET_EXT(x, win, name, v) \
54 REG_SET(x, win->base, win->phy->scl->ext->name, v, RELAXED)
Mark Yao2048e322014-08-22 18:36:26 +080055#define VOP_CTRL_SET(x, name, v) \
56 REG_SET(x, 0, (x)->data->ctrl->name, v, NORMAL)
57
Mark Yaodbb3d942015-12-15 08:36:55 +080058#define VOP_INTR_GET(vop, name) \
59 vop_read_reg(vop, 0, &vop->data->ctrl->name)
60
John Keepingc7647f82016-01-12 18:05:18 +000061#define VOP_INTR_SET(vop, name, mask, v) \
62 REG_SET_MASK(vop, 0, vop->data->intr->name, mask, v, NORMAL)
Mark Yaodbb3d942015-12-15 08:36:55 +080063#define VOP_INTR_SET_TYPE(vop, name, type, v) \
64 do { \
John Keepingc7647f82016-01-12 18:05:18 +000065 int i, reg = 0, mask = 0; \
Mark Yaodbb3d942015-12-15 08:36:55 +080066 for (i = 0; i < vop->data->intr->nintrs; i++) { \
John Keepingc7647f82016-01-12 18:05:18 +000067 if (vop->data->intr->intrs[i] & type) { \
Mark Yaodbb3d942015-12-15 08:36:55 +080068 reg |= (v) << i; \
John Keepingc7647f82016-01-12 18:05:18 +000069 mask |= 1 << i; \
70 } \
Mark Yaodbb3d942015-12-15 08:36:55 +080071 } \
John Keepingc7647f82016-01-12 18:05:18 +000072 VOP_INTR_SET(vop, name, mask, reg); \
Mark Yaodbb3d942015-12-15 08:36:55 +080073 } while (0)
74#define VOP_INTR_GET_TYPE(vop, name, type) \
75 vop_get_intr_type(vop, &vop->data->intr->name, type)
76
Mark Yao2048e322014-08-22 18:36:26 +080077#define VOP_WIN_GET(x, win, name) \
78 vop_read_reg(x, win->base, &win->phy->name)
79
80#define VOP_WIN_GET_YRGBADDR(vop, win) \
81 vop_readl(vop, win->base + win->phy->yrgb_mst.offset)
82
83#define to_vop(x) container_of(x, struct vop, crtc)
84#define to_vop_win(x) container_of(x, struct vop_win, base)
Mark Yao63ebb9f2015-11-30 18:22:42 +080085#define to_vop_plane_state(x) container_of(x, struct vop_plane_state, base)
Mark Yao2048e322014-08-22 18:36:26 +080086
Mark Yao63ebb9f2015-11-30 18:22:42 +080087struct vop_plane_state {
88 struct drm_plane_state base;
89 int format;
90 struct drm_rect src;
91 struct drm_rect dest;
Mark Yao2048e322014-08-22 18:36:26 +080092 dma_addr_t yrgb_mst;
Mark Yao63ebb9f2015-11-30 18:22:42 +080093 bool enable;
Mark Yao2048e322014-08-22 18:36:26 +080094};
95
96struct vop_win {
97 struct drm_plane base;
98 const struct vop_win_data *data;
99 struct vop *vop;
100
Mark Yao63ebb9f2015-11-30 18:22:42 +0800101 struct vop_plane_state state;
Mark Yao2048e322014-08-22 18:36:26 +0800102};
103
104struct vop {
105 struct drm_crtc crtc;
106 struct device *dev;
107 struct drm_device *drm_dev;
Mark Yao31e980c2015-01-22 14:37:56 +0800108 bool is_enabled;
Mark Yao2048e322014-08-22 18:36:26 +0800109
Mark Yao2048e322014-08-22 18:36:26 +0800110 /* mutex vsync_ work */
111 struct mutex vsync_mutex;
112 bool vsync_work_pending;
Mark Yao10672192015-02-04 13:10:31 +0800113 struct completion dsp_hold_completion;
Mark Yao63ebb9f2015-11-30 18:22:42 +0800114 struct completion wait_update_complete;
115 struct drm_pending_vblank_event *event;
Mark Yao2048e322014-08-22 18:36:26 +0800116
117 const struct vop_data *data;
118
119 uint32_t *regsbak;
120 void __iomem *regs;
121
122 /* physical map length of vop register */
123 uint32_t len;
124
125 /* one time only one process allowed to config the register */
126 spinlock_t reg_lock;
127 /* lock vop irq reg */
128 spinlock_t irq_lock;
129
130 unsigned int irq;
131
132 /* vop AHP clk */
133 struct clk *hclk;
134 /* vop dclk */
135 struct clk *dclk;
136 /* vop share memory frequency */
137 struct clk *aclk;
138
139 /* vop dclk reset */
140 struct reset_control *dclk_rst;
141
Mark Yao2048e322014-08-22 18:36:26 +0800142 struct vop_win win[];
143};
144
Mark Yao2048e322014-08-22 18:36:26 +0800145static inline void vop_writel(struct vop *vop, uint32_t offset, uint32_t v)
146{
147 writel(v, vop->regs + offset);
148 vop->regsbak[offset >> 2] = v;
149}
150
151static inline uint32_t vop_readl(struct vop *vop, uint32_t offset)
152{
153 return readl(vop->regs + offset);
154}
155
156static inline uint32_t vop_read_reg(struct vop *vop, uint32_t base,
157 const struct vop_reg *reg)
158{
159 return (vop_readl(vop, base + reg->offset) >> reg->shift) & reg->mask;
160}
161
Mark Yao2048e322014-08-22 18:36:26 +0800162static inline void vop_mask_write(struct vop *vop, uint32_t offset,
163 uint32_t mask, uint32_t v)
164{
165 if (mask) {
166 uint32_t cached_val = vop->regsbak[offset >> 2];
167
168 cached_val = (cached_val & ~mask) | v;
169 writel(cached_val, vop->regs + offset);
170 vop->regsbak[offset >> 2] = cached_val;
171 }
172}
173
174static inline void vop_mask_write_relaxed(struct vop *vop, uint32_t offset,
175 uint32_t mask, uint32_t v)
176{
177 if (mask) {
178 uint32_t cached_val = vop->regsbak[offset >> 2];
179
180 cached_val = (cached_val & ~mask) | v;
181 writel_relaxed(cached_val, vop->regs + offset);
182 vop->regsbak[offset >> 2] = cached_val;
183 }
184}
185
Mark Yaodbb3d942015-12-15 08:36:55 +0800186static inline uint32_t vop_get_intr_type(struct vop *vop,
187 const struct vop_reg *reg, int type)
188{
189 uint32_t i, ret = 0;
190 uint32_t regs = vop_read_reg(vop, 0, reg);
191
192 for (i = 0; i < vop->data->intr->nintrs; i++) {
193 if ((type & vop->data->intr->intrs[i]) && (regs & 1 << i))
194 ret |= vop->data->intr->intrs[i];
195 }
196
197 return ret;
198}
199
Mark Yao0cf33fe2015-12-14 18:14:36 +0800200static inline void vop_cfg_done(struct vop *vop)
201{
202 VOP_CTRL_SET(vop, cfg_done, 1);
203}
204
Tomasz Figa85a359f2015-05-11 19:55:39 +0900205static bool has_rb_swapped(uint32_t format)
206{
207 switch (format) {
208 case DRM_FORMAT_XBGR8888:
209 case DRM_FORMAT_ABGR8888:
210 case DRM_FORMAT_BGR888:
211 case DRM_FORMAT_BGR565:
212 return true;
213 default:
214 return false;
215 }
216}
217
Mark Yao2048e322014-08-22 18:36:26 +0800218static enum vop_data_format vop_convert_format(uint32_t format)
219{
220 switch (format) {
221 case DRM_FORMAT_XRGB8888:
222 case DRM_FORMAT_ARGB8888:
Tomasz Figa85a359f2015-05-11 19:55:39 +0900223 case DRM_FORMAT_XBGR8888:
224 case DRM_FORMAT_ABGR8888:
Mark Yao2048e322014-08-22 18:36:26 +0800225 return VOP_FMT_ARGB8888;
226 case DRM_FORMAT_RGB888:
Tomasz Figa85a359f2015-05-11 19:55:39 +0900227 case DRM_FORMAT_BGR888:
Mark Yao2048e322014-08-22 18:36:26 +0800228 return VOP_FMT_RGB888;
229 case DRM_FORMAT_RGB565:
Tomasz Figa85a359f2015-05-11 19:55:39 +0900230 case DRM_FORMAT_BGR565:
Mark Yao2048e322014-08-22 18:36:26 +0800231 return VOP_FMT_RGB565;
232 case DRM_FORMAT_NV12:
233 return VOP_FMT_YUV420SP;
234 case DRM_FORMAT_NV16:
235 return VOP_FMT_YUV422SP;
236 case DRM_FORMAT_NV24:
237 return VOP_FMT_YUV444SP;
238 default:
239 DRM_ERROR("unsupport format[%08x]\n", format);
240 return -EINVAL;
241 }
242}
243
Mark Yao84c7f8c2015-07-20 16:16:49 +0800244static bool is_yuv_support(uint32_t format)
245{
246 switch (format) {
247 case DRM_FORMAT_NV12:
248 case DRM_FORMAT_NV16:
249 case DRM_FORMAT_NV24:
250 return true;
251 default:
252 return false;
253 }
254}
255
Mark Yao2048e322014-08-22 18:36:26 +0800256static bool is_alpha_support(uint32_t format)
257{
258 switch (format) {
259 case DRM_FORMAT_ARGB8888:
Tomasz Figa85a359f2015-05-11 19:55:39 +0900260 case DRM_FORMAT_ABGR8888:
Mark Yao2048e322014-08-22 18:36:26 +0800261 return true;
262 default:
263 return false;
264 }
265}
266
Mark Yao4c156c22015-06-26 17:14:46 +0800267static uint16_t scl_vop_cal_scale(enum scale_mode mode, uint32_t src,
268 uint32_t dst, bool is_horizontal,
269 int vsu_mode, int *vskiplines)
270{
271 uint16_t val = 1 << SCL_FT_DEFAULT_FIXPOINT_SHIFT;
272
273 if (is_horizontal) {
274 if (mode == SCALE_UP)
275 val = GET_SCL_FT_BIC(src, dst);
276 else if (mode == SCALE_DOWN)
277 val = GET_SCL_FT_BILI_DN(src, dst);
278 } else {
279 if (mode == SCALE_UP) {
280 if (vsu_mode == SCALE_UP_BIL)
281 val = GET_SCL_FT_BILI_UP(src, dst);
282 else
283 val = GET_SCL_FT_BIC(src, dst);
284 } else if (mode == SCALE_DOWN) {
285 if (vskiplines) {
286 *vskiplines = scl_get_vskiplines(src, dst);
287 val = scl_get_bili_dn_vskip(src, dst,
288 *vskiplines);
289 } else {
290 val = GET_SCL_FT_BILI_DN(src, dst);
291 }
292 }
293 }
294
295 return val;
296}
297
298static void scl_vop_cal_scl_fac(struct vop *vop, const struct vop_win_data *win,
299 uint32_t src_w, uint32_t src_h, uint32_t dst_w,
300 uint32_t dst_h, uint32_t pixel_format)
301{
302 uint16_t yrgb_hor_scl_mode, yrgb_ver_scl_mode;
303 uint16_t cbcr_hor_scl_mode = SCALE_NONE;
304 uint16_t cbcr_ver_scl_mode = SCALE_NONE;
305 int hsub = drm_format_horz_chroma_subsampling(pixel_format);
306 int vsub = drm_format_vert_chroma_subsampling(pixel_format);
307 bool is_yuv = is_yuv_support(pixel_format);
308 uint16_t cbcr_src_w = src_w / hsub;
309 uint16_t cbcr_src_h = src_h / vsub;
310 uint16_t vsu_mode;
311 uint16_t lb_mode;
312 uint32_t val;
313 int vskiplines;
314
315 if (dst_w > 3840) {
316 DRM_ERROR("Maximum destination width (3840) exceeded\n");
317 return;
318 }
319
Mark Yao1194fff2015-12-15 09:08:43 +0800320 if (!win->phy->scl->ext) {
321 VOP_SCL_SET(vop, win, scale_yrgb_x,
322 scl_cal_scale2(src_w, dst_w));
323 VOP_SCL_SET(vop, win, scale_yrgb_y,
324 scl_cal_scale2(src_h, dst_h));
325 if (is_yuv) {
326 VOP_SCL_SET(vop, win, scale_cbcr_x,
327 scl_cal_scale2(src_w, dst_w));
328 VOP_SCL_SET(vop, win, scale_cbcr_y,
329 scl_cal_scale2(src_h, dst_h));
330 }
331 return;
332 }
333
Mark Yao4c156c22015-06-26 17:14:46 +0800334 yrgb_hor_scl_mode = scl_get_scl_mode(src_w, dst_w);
335 yrgb_ver_scl_mode = scl_get_scl_mode(src_h, dst_h);
336
337 if (is_yuv) {
338 cbcr_hor_scl_mode = scl_get_scl_mode(cbcr_src_w, dst_w);
339 cbcr_ver_scl_mode = scl_get_scl_mode(cbcr_src_h, dst_h);
340 if (cbcr_hor_scl_mode == SCALE_DOWN)
341 lb_mode = scl_vop_cal_lb_mode(dst_w, true);
342 else
343 lb_mode = scl_vop_cal_lb_mode(cbcr_src_w, true);
344 } else {
345 if (yrgb_hor_scl_mode == SCALE_DOWN)
346 lb_mode = scl_vop_cal_lb_mode(dst_w, false);
347 else
348 lb_mode = scl_vop_cal_lb_mode(src_w, false);
349 }
350
Mark Yao1194fff2015-12-15 09:08:43 +0800351 VOP_SCL_SET_EXT(vop, win, lb_mode, lb_mode);
Mark Yao4c156c22015-06-26 17:14:46 +0800352 if (lb_mode == LB_RGB_3840X2) {
353 if (yrgb_ver_scl_mode != SCALE_NONE) {
354 DRM_ERROR("ERROR : not allow yrgb ver scale\n");
355 return;
356 }
357 if (cbcr_ver_scl_mode != SCALE_NONE) {
358 DRM_ERROR("ERROR : not allow cbcr ver scale\n");
359 return;
360 }
361 vsu_mode = SCALE_UP_BIL;
362 } else if (lb_mode == LB_RGB_2560X4) {
363 vsu_mode = SCALE_UP_BIL;
364 } else {
365 vsu_mode = SCALE_UP_BIC;
366 }
367
368 val = scl_vop_cal_scale(yrgb_hor_scl_mode, src_w, dst_w,
369 true, 0, NULL);
370 VOP_SCL_SET(vop, win, scale_yrgb_x, val);
371 val = scl_vop_cal_scale(yrgb_ver_scl_mode, src_h, dst_h,
372 false, vsu_mode, &vskiplines);
373 VOP_SCL_SET(vop, win, scale_yrgb_y, val);
374
Mark Yao1194fff2015-12-15 09:08:43 +0800375 VOP_SCL_SET_EXT(vop, win, vsd_yrgb_gt4, vskiplines == 4);
376 VOP_SCL_SET_EXT(vop, win, vsd_yrgb_gt2, vskiplines == 2);
Mark Yao4c156c22015-06-26 17:14:46 +0800377
Mark Yao1194fff2015-12-15 09:08:43 +0800378 VOP_SCL_SET_EXT(vop, win, yrgb_hor_scl_mode, yrgb_hor_scl_mode);
379 VOP_SCL_SET_EXT(vop, win, yrgb_ver_scl_mode, yrgb_ver_scl_mode);
380 VOP_SCL_SET_EXT(vop, win, yrgb_hsd_mode, SCALE_DOWN_BIL);
381 VOP_SCL_SET_EXT(vop, win, yrgb_vsd_mode, SCALE_DOWN_BIL);
382 VOP_SCL_SET_EXT(vop, win, yrgb_vsu_mode, vsu_mode);
Mark Yao4c156c22015-06-26 17:14:46 +0800383 if (is_yuv) {
384 val = scl_vop_cal_scale(cbcr_hor_scl_mode, cbcr_src_w,
385 dst_w, true, 0, NULL);
386 VOP_SCL_SET(vop, win, scale_cbcr_x, val);
387 val = scl_vop_cal_scale(cbcr_ver_scl_mode, cbcr_src_h,
388 dst_h, false, vsu_mode, &vskiplines);
389 VOP_SCL_SET(vop, win, scale_cbcr_y, val);
390
Mark Yao1194fff2015-12-15 09:08:43 +0800391 VOP_SCL_SET_EXT(vop, win, vsd_cbcr_gt4, vskiplines == 4);
392 VOP_SCL_SET_EXT(vop, win, vsd_cbcr_gt2, vskiplines == 2);
393 VOP_SCL_SET_EXT(vop, win, cbcr_hor_scl_mode, cbcr_hor_scl_mode);
394 VOP_SCL_SET_EXT(vop, win, cbcr_ver_scl_mode, cbcr_ver_scl_mode);
395 VOP_SCL_SET_EXT(vop, win, cbcr_hsd_mode, SCALE_DOWN_BIL);
396 VOP_SCL_SET_EXT(vop, win, cbcr_vsd_mode, SCALE_DOWN_BIL);
397 VOP_SCL_SET_EXT(vop, win, cbcr_vsu_mode, vsu_mode);
Mark Yao4c156c22015-06-26 17:14:46 +0800398 }
399}
400
Mark Yao10672192015-02-04 13:10:31 +0800401static void vop_dsp_hold_valid_irq_enable(struct vop *vop)
402{
403 unsigned long flags;
404
405 if (WARN_ON(!vop->is_enabled))
406 return;
407
408 spin_lock_irqsave(&vop->irq_lock, flags);
409
Mark Yaodbb3d942015-12-15 08:36:55 +0800410 VOP_INTR_SET_TYPE(vop, enable, DSP_HOLD_VALID_INTR, 1);
Mark Yao10672192015-02-04 13:10:31 +0800411
412 spin_unlock_irqrestore(&vop->irq_lock, flags);
413}
414
415static void vop_dsp_hold_valid_irq_disable(struct vop *vop)
416{
417 unsigned long flags;
418
419 if (WARN_ON(!vop->is_enabled))
420 return;
421
422 spin_lock_irqsave(&vop->irq_lock, flags);
423
Mark Yaodbb3d942015-12-15 08:36:55 +0800424 VOP_INTR_SET_TYPE(vop, enable, DSP_HOLD_VALID_INTR, 0);
Mark Yao10672192015-02-04 13:10:31 +0800425
426 spin_unlock_irqrestore(&vop->irq_lock, flags);
427}
428
Mark Yao63ebb9f2015-11-30 18:22:42 +0800429static void vop_enable(struct drm_crtc *crtc)
Mark Yao2048e322014-08-22 18:36:26 +0800430{
431 struct vop *vop = to_vop(crtc);
432 int ret;
433
Mark Yao31e980c2015-01-22 14:37:56 +0800434 if (vop->is_enabled)
435 return;
436
Mark Yao5d82d1a2015-04-01 13:48:53 +0800437 ret = pm_runtime_get_sync(vop->dev);
438 if (ret < 0) {
439 dev_err(vop->dev, "failed to get pm runtime: %d\n", ret);
440 return;
441 }
442
Mark Yao2048e322014-08-22 18:36:26 +0800443 ret = clk_enable(vop->hclk);
444 if (ret < 0) {
445 dev_err(vop->dev, "failed to enable hclk - %d\n", ret);
446 return;
447 }
448
449 ret = clk_enable(vop->dclk);
450 if (ret < 0) {
451 dev_err(vop->dev, "failed to enable dclk - %d\n", ret);
452 goto err_disable_hclk;
453 }
454
455 ret = clk_enable(vop->aclk);
456 if (ret < 0) {
457 dev_err(vop->dev, "failed to enable aclk - %d\n", ret);
458 goto err_disable_dclk;
459 }
460
461 /*
462 * Slave iommu shares power, irq and clock with vop. It was associated
463 * automatically with this master device via common driver code.
464 * Now that we have enabled the clock we attach it to the shared drm
465 * mapping.
466 */
467 ret = rockchip_drm_dma_attach_device(vop->drm_dev, vop->dev);
468 if (ret) {
469 dev_err(vop->dev, "failed to attach dma mapping, %d\n", ret);
470 goto err_disable_aclk;
471 }
472
Mark Yao77faa162015-07-20 16:25:20 +0800473 memcpy(vop->regs, vop->regsbak, vop->len);
Mark Yao52ab7892015-01-22 18:29:57 +0800474 /*
475 * At here, vop clock & iommu is enable, R/W vop regs would be safe.
476 */
477 vop->is_enabled = true;
478
Mark Yao2048e322014-08-22 18:36:26 +0800479 spin_lock(&vop->reg_lock);
480
481 VOP_CTRL_SET(vop, standby, 0);
482
483 spin_unlock(&vop->reg_lock);
484
485 enable_irq(vop->irq);
486
Mark Yaob5f7b752015-11-23 15:21:08 +0800487 drm_crtc_vblank_on(crtc);
Mark Yao2048e322014-08-22 18:36:26 +0800488
489 return;
490
491err_disable_aclk:
492 clk_disable(vop->aclk);
493err_disable_dclk:
494 clk_disable(vop->dclk);
495err_disable_hclk:
496 clk_disable(vop->hclk);
497}
498
Mark Yao0ad36752015-11-09 11:33:16 +0800499static void vop_crtc_disable(struct drm_crtc *crtc)
Mark Yao2048e322014-08-22 18:36:26 +0800500{
501 struct vop *vop = to_vop(crtc);
502
Mark Yao31e980c2015-01-22 14:37:56 +0800503 if (!vop->is_enabled)
504 return;
505
Mark Yaob5f7b752015-11-23 15:21:08 +0800506 drm_crtc_vblank_off(crtc);
Mark Yao2048e322014-08-22 18:36:26 +0800507
Mark Yao2048e322014-08-22 18:36:26 +0800508 /*
Mark Yao10672192015-02-04 13:10:31 +0800509 * Vop standby will take effect at end of current frame,
510 * if dsp hold valid irq happen, it means standby complete.
511 *
512 * we must wait standby complete when we want to disable aclk,
513 * if not, memory bus maybe dead.
Mark Yao2048e322014-08-22 18:36:26 +0800514 */
Mark Yao10672192015-02-04 13:10:31 +0800515 reinit_completion(&vop->dsp_hold_completion);
516 vop_dsp_hold_valid_irq_enable(vop);
517
Mark Yao2048e322014-08-22 18:36:26 +0800518 spin_lock(&vop->reg_lock);
519
520 VOP_CTRL_SET(vop, standby, 1);
521
522 spin_unlock(&vop->reg_lock);
Mark Yao52ab7892015-01-22 18:29:57 +0800523
Mark Yao10672192015-02-04 13:10:31 +0800524 wait_for_completion(&vop->dsp_hold_completion);
Mark Yao2048e322014-08-22 18:36:26 +0800525
Mark Yao10672192015-02-04 13:10:31 +0800526 vop_dsp_hold_valid_irq_disable(vop);
527
528 disable_irq(vop->irq);
529
530 vop->is_enabled = false;
531
532 /*
533 * vop standby complete, so iommu detach is safe.
534 */
Mark Yao2048e322014-08-22 18:36:26 +0800535 rockchip_drm_dma_detach_device(vop->drm_dev, vop->dev);
536
Mark Yao10672192015-02-04 13:10:31 +0800537 clk_disable(vop->dclk);
Mark Yao2048e322014-08-22 18:36:26 +0800538 clk_disable(vop->aclk);
539 clk_disable(vop->hclk);
Mark Yao5d82d1a2015-04-01 13:48:53 +0800540 pm_runtime_put(vop->dev);
Mark Yao2048e322014-08-22 18:36:26 +0800541}
542
Mark Yao63ebb9f2015-11-30 18:22:42 +0800543static void vop_plane_destroy(struct drm_plane *plane)
Mark Yao2048e322014-08-22 18:36:26 +0800544{
Mark Yao63ebb9f2015-11-30 18:22:42 +0800545 drm_plane_cleanup(plane);
Mark Yao2048e322014-08-22 18:36:26 +0800546}
547
Mark Yao63ebb9f2015-11-30 18:22:42 +0800548static int vop_plane_atomic_check(struct drm_plane *plane,
549 struct drm_plane_state *state)
Mark Yao2048e322014-08-22 18:36:26 +0800550{
Mark Yao63ebb9f2015-11-30 18:22:42 +0800551 struct drm_crtc *crtc = state->crtc;
John Keeping92915da2016-03-04 11:04:03 +0000552 struct drm_crtc_state *crtc_state;
Mark Yao63ebb9f2015-11-30 18:22:42 +0800553 struct drm_framebuffer *fb = state->fb;
Mark Yao2048e322014-08-22 18:36:26 +0800554 struct vop_win *vop_win = to_vop_win(plane);
Mark Yao63ebb9f2015-11-30 18:22:42 +0800555 struct vop_plane_state *vop_plane_state = to_vop_plane_state(state);
Mark Yao2048e322014-08-22 18:36:26 +0800556 const struct vop_win_data *win = vop_win->data;
Mark Yao2048e322014-08-22 18:36:26 +0800557 bool visible;
558 int ret;
Mark Yao63ebb9f2015-11-30 18:22:42 +0800559 struct drm_rect *dest = &vop_plane_state->dest;
560 struct drm_rect *src = &vop_plane_state->src;
561 struct drm_rect clip;
Mark Yao4c156c22015-06-26 17:14:46 +0800562 int min_scale = win->phy->scl ? FRAC_16_16(1, 8) :
563 DRM_PLANE_HELPER_NO_SCALING;
564 int max_scale = win->phy->scl ? FRAC_16_16(8, 1) :
565 DRM_PLANE_HELPER_NO_SCALING;
Mark Yao2048e322014-08-22 18:36:26 +0800566
Mark Yao63ebb9f2015-11-30 18:22:42 +0800567 if (!crtc || !fb)
568 goto out_disable;
John Keeping92915da2016-03-04 11:04:03 +0000569
570 crtc_state = drm_atomic_get_existing_crtc_state(state->state, crtc);
571 if (WARN_ON(!crtc_state))
572 return -EINVAL;
573
Mark Yao63ebb9f2015-11-30 18:22:42 +0800574 src->x1 = state->src_x;
575 src->y1 = state->src_y;
576 src->x2 = state->src_x + state->src_w;
577 src->y2 = state->src_y + state->src_h;
578 dest->x1 = state->crtc_x;
579 dest->y1 = state->crtc_y;
580 dest->x2 = state->crtc_x + state->crtc_w;
581 dest->y2 = state->crtc_y + state->crtc_h;
582
583 clip.x1 = 0;
584 clip.y1 = 0;
John Keeping92915da2016-03-04 11:04:03 +0000585 clip.x2 = crtc_state->adjusted_mode.hdisplay;
586 clip.y2 = crtc_state->adjusted_mode.vdisplay;
Mark Yao63ebb9f2015-11-30 18:22:42 +0800587
588 ret = drm_plane_helper_check_update(plane, crtc, state->fb,
589 src, dest, &clip,
Mark Yao4c156c22015-06-26 17:14:46 +0800590 min_scale,
591 max_scale,
Mark Yao63ebb9f2015-11-30 18:22:42 +0800592 true, true, &visible);
Mark Yao2048e322014-08-22 18:36:26 +0800593 if (ret)
594 return ret;
595
596 if (!visible)
Mark Yao63ebb9f2015-11-30 18:22:42 +0800597 goto out_disable;
Mark Yao2048e322014-08-22 18:36:26 +0800598
Mark Yao63ebb9f2015-11-30 18:22:42 +0800599 vop_plane_state->format = vop_convert_format(fb->pixel_format);
600 if (vop_plane_state->format < 0)
601 return vop_plane_state->format;
Mark Yao84c7f8c2015-07-20 16:16:49 +0800602
Mark Yao63ebb9f2015-11-30 18:22:42 +0800603 /*
604 * Src.x1 can be odd when do clip, but yuv plane start point
605 * need align with 2 pixel.
606 */
607 if (is_yuv_support(fb->pixel_format) && ((src->x1 >> 16) % 2))
608 return -EINVAL;
609
610 vop_plane_state->enable = true;
611
612 return 0;
613
614out_disable:
615 vop_plane_state->enable = false;
616 return 0;
617}
618
619static void vop_plane_atomic_disable(struct drm_plane *plane,
620 struct drm_plane_state *old_state)
621{
622 struct vop_plane_state *vop_plane_state = to_vop_plane_state(old_state);
623 struct vop_win *vop_win = to_vop_win(plane);
624 const struct vop_win_data *win = vop_win->data;
625 struct vop *vop = to_vop(old_state->crtc);
626
627 if (!old_state->crtc)
628 return;
629
630 spin_lock(&vop->reg_lock);
631
632 VOP_WIN_SET(vop, win, enable, 0);
633
634 spin_unlock(&vop->reg_lock);
635
636 vop_plane_state->enable = false;
637}
638
639static void vop_plane_atomic_update(struct drm_plane *plane,
640 struct drm_plane_state *old_state)
641{
642 struct drm_plane_state *state = plane->state;
643 struct drm_crtc *crtc = state->crtc;
644 struct vop_win *vop_win = to_vop_win(plane);
645 struct vop_plane_state *vop_plane_state = to_vop_plane_state(state);
646 const struct vop_win_data *win = vop_win->data;
647 struct vop *vop = to_vop(state->crtc);
648 struct drm_framebuffer *fb = state->fb;
649 unsigned int actual_w, actual_h;
650 unsigned int dsp_stx, dsp_sty;
651 uint32_t act_info, dsp_info, dsp_st;
652 struct drm_rect *src = &vop_plane_state->src;
653 struct drm_rect *dest = &vop_plane_state->dest;
654 struct drm_gem_object *obj, *uv_obj;
655 struct rockchip_gem_object *rk_obj, *rk_uv_obj;
656 unsigned long offset;
657 dma_addr_t dma_addr;
658 uint32_t val;
659 bool rb_swap;
660
661 /*
662 * can't update plane when vop is disabled.
663 */
664 if (!crtc)
665 return;
666
667 if (WARN_ON(!vop->is_enabled))
668 return;
669
670 if (!vop_plane_state->enable) {
671 vop_plane_atomic_disable(plane, old_state);
672 return;
673 }
Mark Yao2048e322014-08-22 18:36:26 +0800674
675 obj = rockchip_fb_get_gem_obj(fb, 0);
Mark Yao2048e322014-08-22 18:36:26 +0800676 rk_obj = to_rockchip_obj(obj);
677
Mark Yao63ebb9f2015-11-30 18:22:42 +0800678 actual_w = drm_rect_width(src) >> 16;
679 actual_h = drm_rect_height(src) >> 16;
680 act_info = (actual_h - 1) << 16 | ((actual_w - 1) & 0xffff);
Mark Yao84c7f8c2015-07-20 16:16:49 +0800681
Mark Yao63ebb9f2015-11-30 18:22:42 +0800682 dsp_info = (drm_rect_height(dest) - 1) << 16;
683 dsp_info |= (drm_rect_width(dest) - 1) & 0xffff;
Mark Yao2048e322014-08-22 18:36:26 +0800684
Mark Yao63ebb9f2015-11-30 18:22:42 +0800685 dsp_stx = dest->x1 + crtc->mode.htotal - crtc->mode.hsync_start;
686 dsp_sty = dest->y1 + crtc->mode.vtotal - crtc->mode.vsync_start;
687 dsp_st = dsp_sty << 16 | (dsp_stx & 0xffff);
Mark Yao2048e322014-08-22 18:36:26 +0800688
Mark Yao63ebb9f2015-11-30 18:22:42 +0800689 offset = (src->x1 >> 16) * drm_format_plane_cpp(fb->pixel_format, 0);
690 offset += (src->y1 >> 16) * fb->pitches[0];
691 vop_plane_state->yrgb_mst = rk_obj->dma_addr + offset + fb->offsets[0];
Mark Yao2048e322014-08-22 18:36:26 +0800692
Mark Yao63ebb9f2015-11-30 18:22:42 +0800693 spin_lock(&vop->reg_lock);
Mark Yao2048e322014-08-22 18:36:26 +0800694
Mark Yao63ebb9f2015-11-30 18:22:42 +0800695 VOP_WIN_SET(vop, win, format, vop_plane_state->format);
696 VOP_WIN_SET(vop, win, yrgb_vir, fb->pitches[0] >> 2);
697 VOP_WIN_SET(vop, win, yrgb_mst, vop_plane_state->yrgb_mst);
698 if (is_yuv_support(fb->pixel_format)) {
Mark Yao84c7f8c2015-07-20 16:16:49 +0800699 int hsub = drm_format_horz_chroma_subsampling(fb->pixel_format);
700 int vsub = drm_format_vert_chroma_subsampling(fb->pixel_format);
701 int bpp = drm_format_plane_cpp(fb->pixel_format, 1);
702
703 uv_obj = rockchip_fb_get_gem_obj(fb, 1);
Mark Yao84c7f8c2015-07-20 16:16:49 +0800704 rk_uv_obj = to_rockchip_obj(uv_obj);
Mark Yao84c7f8c2015-07-20 16:16:49 +0800705
Mark Yao63ebb9f2015-11-30 18:22:42 +0800706 offset = (src->x1 >> 16) * bpp / hsub;
707 offset += (src->y1 >> 16) * fb->pitches[1] / vsub;
Mark Yao84c7f8c2015-07-20 16:16:49 +0800708
Mark Yao63ebb9f2015-11-30 18:22:42 +0800709 dma_addr = rk_uv_obj->dma_addr + offset + fb->offsets[1];
710 VOP_WIN_SET(vop, win, uv_vir, fb->pitches[1] >> 2);
711 VOP_WIN_SET(vop, win, uv_mst, dma_addr);
Mark Yao84c7f8c2015-07-20 16:16:49 +0800712 }
Mark Yao4c156c22015-06-26 17:14:46 +0800713
714 if (win->phy->scl)
715 scl_vop_cal_scl_fac(vop, win, actual_w, actual_h,
Mark Yao63ebb9f2015-11-30 18:22:42 +0800716 drm_rect_width(dest), drm_rect_height(dest),
Mark Yao4c156c22015-06-26 17:14:46 +0800717 fb->pixel_format);
718
Mark Yao63ebb9f2015-11-30 18:22:42 +0800719 VOP_WIN_SET(vop, win, act_info, act_info);
720 VOP_WIN_SET(vop, win, dsp_info, dsp_info);
721 VOP_WIN_SET(vop, win, dsp_st, dsp_st);
Mark Yao4c156c22015-06-26 17:14:46 +0800722
Mark Yao63ebb9f2015-11-30 18:22:42 +0800723 rb_swap = has_rb_swapped(fb->pixel_format);
Tomasz Figa85a359f2015-05-11 19:55:39 +0900724 VOP_WIN_SET(vop, win, rb_swap, rb_swap);
Mark Yao2048e322014-08-22 18:36:26 +0800725
Mark Yao63ebb9f2015-11-30 18:22:42 +0800726 if (is_alpha_support(fb->pixel_format)) {
Mark Yao2048e322014-08-22 18:36:26 +0800727 VOP_WIN_SET(vop, win, dst_alpha_ctl,
728 DST_FACTOR_M0(ALPHA_SRC_INVERSE));
729 val = SRC_ALPHA_EN(1) | SRC_COLOR_M0(ALPHA_SRC_PRE_MUL) |
730 SRC_ALPHA_M0(ALPHA_STRAIGHT) |
731 SRC_BLEND_M0(ALPHA_PER_PIX) |
732 SRC_ALPHA_CAL_M0(ALPHA_NO_SATURATION) |
733 SRC_FACTOR_M0(ALPHA_ONE);
734 VOP_WIN_SET(vop, win, src_alpha_ctl, val);
735 } else {
736 VOP_WIN_SET(vop, win, src_alpha_ctl, SRC_ALPHA_EN(0));
737 }
738
739 VOP_WIN_SET(vop, win, enable, 1);
Mark Yao2048e322014-08-22 18:36:26 +0800740 spin_unlock(&vop->reg_lock);
Mark Yao2048e322014-08-22 18:36:26 +0800741}
742
Mark Yao63ebb9f2015-11-30 18:22:42 +0800743static const struct drm_plane_helper_funcs plane_helper_funcs = {
744 .atomic_check = vop_plane_atomic_check,
745 .atomic_update = vop_plane_atomic_update,
746 .atomic_disable = vop_plane_atomic_disable,
747};
748
749void vop_atomic_plane_reset(struct drm_plane *plane)
Mark Yao2048e322014-08-22 18:36:26 +0800750{
Mark Yao63ebb9f2015-11-30 18:22:42 +0800751 struct vop_plane_state *vop_plane_state =
752 to_vop_plane_state(plane->state);
753
754 if (plane->state && plane->state->fb)
755 drm_framebuffer_unreference(plane->state->fb);
756
757 kfree(vop_plane_state);
758 vop_plane_state = kzalloc(sizeof(*vop_plane_state), GFP_KERNEL);
759 if (!vop_plane_state)
760 return;
761
762 plane->state = &vop_plane_state->base;
763 plane->state->plane = plane;
Mark Yao2048e322014-08-22 18:36:26 +0800764}
765
Mark Yao63ebb9f2015-11-30 18:22:42 +0800766struct drm_plane_state *
767vop_atomic_plane_duplicate_state(struct drm_plane *plane)
Mark Yao2048e322014-08-22 18:36:26 +0800768{
Mark Yao63ebb9f2015-11-30 18:22:42 +0800769 struct vop_plane_state *old_vop_plane_state;
770 struct vop_plane_state *vop_plane_state;
Mark Yao2048e322014-08-22 18:36:26 +0800771
Mark Yao63ebb9f2015-11-30 18:22:42 +0800772 if (WARN_ON(!plane->state))
773 return NULL;
Mark Yao2048e322014-08-22 18:36:26 +0800774
Mark Yao63ebb9f2015-11-30 18:22:42 +0800775 old_vop_plane_state = to_vop_plane_state(plane->state);
776 vop_plane_state = kmemdup(old_vop_plane_state,
777 sizeof(*vop_plane_state), GFP_KERNEL);
778 if (!vop_plane_state)
779 return NULL;
780
781 __drm_atomic_helper_plane_duplicate_state(plane,
782 &vop_plane_state->base);
783
784 return &vop_plane_state->base;
Mark Yao2048e322014-08-22 18:36:26 +0800785}
786
Mark Yao63ebb9f2015-11-30 18:22:42 +0800787static void vop_atomic_plane_destroy_state(struct drm_plane *plane,
788 struct drm_plane_state *state)
Mark Yao2048e322014-08-22 18:36:26 +0800789{
Mark Yao63ebb9f2015-11-30 18:22:42 +0800790 struct vop_plane_state *vop_state = to_vop_plane_state(state);
Mark Yao2048e322014-08-22 18:36:26 +0800791
Mark Yao63ebb9f2015-11-30 18:22:42 +0800792 __drm_atomic_helper_plane_destroy_state(plane, state);
Mark Yao2048e322014-08-22 18:36:26 +0800793
Mark Yao63ebb9f2015-11-30 18:22:42 +0800794 kfree(vop_state);
Mark Yao2048e322014-08-22 18:36:26 +0800795}
796
797static const struct drm_plane_funcs vop_plane_funcs = {
Mark Yao63ebb9f2015-11-30 18:22:42 +0800798 .update_plane = drm_atomic_helper_update_plane,
799 .disable_plane = drm_atomic_helper_disable_plane,
Mark Yao2048e322014-08-22 18:36:26 +0800800 .destroy = vop_plane_destroy,
Mark Yao63ebb9f2015-11-30 18:22:42 +0800801 .reset = vop_atomic_plane_reset,
802 .atomic_duplicate_state = vop_atomic_plane_duplicate_state,
803 .atomic_destroy_state = vop_atomic_plane_destroy_state,
Mark Yao2048e322014-08-22 18:36:26 +0800804};
805
806int rockchip_drm_crtc_mode_config(struct drm_crtc *crtc,
807 int connector_type,
808 int out_mode)
809{
810 struct vop *vop = to_vop(crtc);
811
Mark Yaod0e20d02015-12-16 18:11:24 +0800812 if (WARN_ON(!vop->is_enabled))
813 return -EINVAL;
814
815 switch (connector_type) {
816 case DRM_MODE_CONNECTOR_LVDS:
817 VOP_CTRL_SET(vop, rgb_en, 1);
818 break;
819 case DRM_MODE_CONNECTOR_eDP:
820 VOP_CTRL_SET(vop, edp_en, 1);
821 break;
822 case DRM_MODE_CONNECTOR_HDMIA:
823 VOP_CTRL_SET(vop, hdmi_en, 1);
824 break;
Chris Zhong84e05402016-01-06 16:12:54 +0800825 case DRM_MODE_CONNECTOR_DSI:
826 VOP_CTRL_SET(vop, mipi_en, 1);
827 break;
Mark Yaod0e20d02015-12-16 18:11:24 +0800828 default:
829 DRM_ERROR("unsupport connector_type[%d]\n", connector_type);
830 return -EINVAL;
831 };
832 VOP_CTRL_SET(vop, out_mode, out_mode);
Mark Yao2048e322014-08-22 18:36:26 +0800833
834 return 0;
835}
Philipp Zabelf66a1622015-01-07 16:16:18 +0100836EXPORT_SYMBOL_GPL(rockchip_drm_crtc_mode_config);
Mark Yao2048e322014-08-22 18:36:26 +0800837
838static int vop_crtc_enable_vblank(struct drm_crtc *crtc)
839{
840 struct vop *vop = to_vop(crtc);
841 unsigned long flags;
842
Mark Yao63ebb9f2015-11-30 18:22:42 +0800843 if (WARN_ON(!vop->is_enabled))
Mark Yao2048e322014-08-22 18:36:26 +0800844 return -EPERM;
845
846 spin_lock_irqsave(&vop->irq_lock, flags);
847
Mark Yaodbb3d942015-12-15 08:36:55 +0800848 VOP_INTR_SET_TYPE(vop, enable, FS_INTR, 1);
Mark Yao2048e322014-08-22 18:36:26 +0800849
850 spin_unlock_irqrestore(&vop->irq_lock, flags);
851
852 return 0;
853}
854
855static void vop_crtc_disable_vblank(struct drm_crtc *crtc)
856{
857 struct vop *vop = to_vop(crtc);
858 unsigned long flags;
859
Mark Yao63ebb9f2015-11-30 18:22:42 +0800860 if (WARN_ON(!vop->is_enabled))
Mark Yao2048e322014-08-22 18:36:26 +0800861 return;
Mark Yao31e980c2015-01-22 14:37:56 +0800862
Mark Yao2048e322014-08-22 18:36:26 +0800863 spin_lock_irqsave(&vop->irq_lock, flags);
Mark Yaodbb3d942015-12-15 08:36:55 +0800864
865 VOP_INTR_SET_TYPE(vop, enable, FS_INTR, 0);
866
Mark Yao2048e322014-08-22 18:36:26 +0800867 spin_unlock_irqrestore(&vop->irq_lock, flags);
868}
869
Mark Yao63ebb9f2015-11-30 18:22:42 +0800870static void vop_crtc_wait_for_update(struct drm_crtc *crtc)
871{
872 struct vop *vop = to_vop(crtc);
873
874 reinit_completion(&vop->wait_update_complete);
875 WARN_ON(!wait_for_completion_timeout(&vop->wait_update_complete, 100));
876}
877
John Keepingf1350462016-03-11 17:21:17 +0000878static void vop_crtc_cancel_pending_vblank(struct drm_crtc *crtc,
879 struct drm_file *file_priv)
880{
881 struct drm_device *drm = crtc->dev;
882 struct vop *vop = to_vop(crtc);
883 struct drm_pending_vblank_event *e;
884 unsigned long flags;
885
886 spin_lock_irqsave(&drm->event_lock, flags);
887 e = vop->event;
888 if (e && e->base.file_priv == file_priv) {
889 vop->event = NULL;
890
891 e->base.destroy(&e->base);
892 file_priv->event_space += sizeof(e->event);
893 }
894 spin_unlock_irqrestore(&drm->event_lock, flags);
895}
896
Mark Yao2048e322014-08-22 18:36:26 +0800897static const struct rockchip_crtc_funcs private_crtc_funcs = {
898 .enable_vblank = vop_crtc_enable_vblank,
899 .disable_vblank = vop_crtc_disable_vblank,
Mark Yao63ebb9f2015-11-30 18:22:42 +0800900 .wait_for_update = vop_crtc_wait_for_update,
John Keepingf1350462016-03-11 17:21:17 +0000901 .cancel_pending_vblank = vop_crtc_cancel_pending_vblank,
Mark Yao2048e322014-08-22 18:36:26 +0800902};
903
Mark Yao2048e322014-08-22 18:36:26 +0800904static bool vop_crtc_mode_fixup(struct drm_crtc *crtc,
905 const struct drm_display_mode *mode,
906 struct drm_display_mode *adjusted_mode)
907{
Chris Zhongb59b8de2016-01-06 12:03:53 +0800908 struct vop *vop = to_vop(crtc);
909
Mark Yao2048e322014-08-22 18:36:26 +0800910 if (adjusted_mode->htotal == 0 || adjusted_mode->vtotal == 0)
911 return false;
912
Chris Zhongb59b8de2016-01-06 12:03:53 +0800913 adjusted_mode->clock =
914 clk_round_rate(vop->dclk, mode->clock * 1000) / 1000;
915
Mark Yao2048e322014-08-22 18:36:26 +0800916 return true;
917}
918
Mark Yao63ebb9f2015-11-30 18:22:42 +0800919static void vop_crtc_enable(struct drm_crtc *crtc)
Mark Yao2048e322014-08-22 18:36:26 +0800920{
921 struct vop *vop = to_vop(crtc);
Mark Yao63ebb9f2015-11-30 18:22:42 +0800922 struct drm_display_mode *adjusted_mode = &crtc->state->adjusted_mode;
Mark Yao2048e322014-08-22 18:36:26 +0800923 u16 hsync_len = adjusted_mode->hsync_end - adjusted_mode->hsync_start;
924 u16 hdisplay = adjusted_mode->hdisplay;
925 u16 htotal = adjusted_mode->htotal;
926 u16 hact_st = adjusted_mode->htotal - adjusted_mode->hsync_start;
927 u16 hact_end = hact_st + hdisplay;
928 u16 vdisplay = adjusted_mode->vdisplay;
929 u16 vtotal = adjusted_mode->vtotal;
930 u16 vsync_len = adjusted_mode->vsync_end - adjusted_mode->vsync_start;
931 u16 vact_st = adjusted_mode->vtotal - adjusted_mode->vsync_start;
932 u16 vact_end = vact_st + vdisplay;
Mark Yao2048e322014-08-22 18:36:26 +0800933 uint32_t val;
934
Mark Yao63ebb9f2015-11-30 18:22:42 +0800935 vop_enable(crtc);
Mark Yao2048e322014-08-22 18:36:26 +0800936 /*
Mark Yaoce3887e2015-12-16 18:08:17 +0800937 * If dclk rate is zero, mean that scanout is stop,
938 * we don't need wait any more.
Mark Yao2048e322014-08-22 18:36:26 +0800939 */
Mark Yaoce3887e2015-12-16 18:08:17 +0800940 if (clk_get_rate(vop->dclk)) {
941 /*
942 * Rk3288 vop timing register is immediately, when configure
943 * display timing on display time, may cause tearing.
944 *
945 * Vop standby will take effect at end of current frame,
946 * if dsp hold valid irq happen, it means standby complete.
947 *
948 * mode set:
949 * standby and wait complete --> |----
950 * | display time
951 * |----
952 * |---> dsp hold irq
953 * configure display timing --> |
954 * standby exit |
955 * | new frame start.
956 */
957
958 reinit_completion(&vop->dsp_hold_completion);
959 vop_dsp_hold_valid_irq_enable(vop);
960
961 spin_lock(&vop->reg_lock);
962
963 VOP_CTRL_SET(vop, standby, 1);
964
965 spin_unlock(&vop->reg_lock);
966
967 wait_for_completion(&vop->dsp_hold_completion);
968
969 vop_dsp_hold_valid_irq_disable(vop);
970 }
Mark Yao2048e322014-08-22 18:36:26 +0800971
Mark Yao2048e322014-08-22 18:36:26 +0800972 val = 0x8;
Mark Yao44ddb7e2015-01-22 11:15:02 +0800973 val |= (adjusted_mode->flags & DRM_MODE_FLAG_NHSYNC) ? 0 : 1;
974 val |= (adjusted_mode->flags & DRM_MODE_FLAG_NVSYNC) ? 0 : (1 << 1);
Mark Yao2048e322014-08-22 18:36:26 +0800975 VOP_CTRL_SET(vop, pin_pol, val);
976
977 VOP_CTRL_SET(vop, htotal_pw, (htotal << 16) | hsync_len);
978 val = hact_st << 16;
979 val |= hact_end;
980 VOP_CTRL_SET(vop, hact_st_end, val);
981 VOP_CTRL_SET(vop, hpost_st_end, val);
982
983 VOP_CTRL_SET(vop, vtotal_pw, (vtotal << 16) | vsync_len);
984 val = vact_st << 16;
985 val |= vact_end;
986 VOP_CTRL_SET(vop, vact_st_end, val);
987 VOP_CTRL_SET(vop, vpost_st_end, val);
988
Mark Yao2048e322014-08-22 18:36:26 +0800989 clk_set_rate(vop->dclk, adjusted_mode->clock * 1000);
Mark Yaoce3887e2015-12-16 18:08:17 +0800990
991 VOP_CTRL_SET(vop, standby, 0);
Mark Yao63ebb9f2015-11-30 18:22:42 +0800992}
Mark Yao2048e322014-08-22 18:36:26 +0800993
Mark Yao63ebb9f2015-11-30 18:22:42 +0800994static void vop_crtc_atomic_flush(struct drm_crtc *crtc,
995 struct drm_crtc_state *old_crtc_state)
996{
997 struct vop *vop = to_vop(crtc);
998
999 if (WARN_ON(!vop->is_enabled))
1000 return;
1001
1002 spin_lock(&vop->reg_lock);
1003
1004 vop_cfg_done(vop);
1005
1006 spin_unlock(&vop->reg_lock);
1007}
1008
1009static void vop_crtc_atomic_begin(struct drm_crtc *crtc,
1010 struct drm_crtc_state *old_crtc_state)
1011{
1012 struct vop *vop = to_vop(crtc);
1013
1014 if (crtc->state->event) {
1015 WARN_ON(drm_crtc_vblank_get(crtc) != 0);
1016
1017 vop->event = crtc->state->event;
1018 crtc->state->event = NULL;
1019 }
Mark Yao2048e322014-08-22 18:36:26 +08001020}
1021
Mark Yao2048e322014-08-22 18:36:26 +08001022static const struct drm_crtc_helper_funcs vop_crtc_helper_funcs = {
Mark Yao0ad36752015-11-09 11:33:16 +08001023 .enable = vop_crtc_enable,
1024 .disable = vop_crtc_disable,
Mark Yao2048e322014-08-22 18:36:26 +08001025 .mode_fixup = vop_crtc_mode_fixup,
Mark Yao63ebb9f2015-11-30 18:22:42 +08001026 .atomic_flush = vop_crtc_atomic_flush,
1027 .atomic_begin = vop_crtc_atomic_begin,
Mark Yao2048e322014-08-22 18:36:26 +08001028};
1029
Mark Yao2048e322014-08-22 18:36:26 +08001030static void vop_crtc_destroy(struct drm_crtc *crtc)
1031{
1032 drm_crtc_cleanup(crtc);
1033}
1034
1035static const struct drm_crtc_funcs vop_crtc_funcs = {
Mark Yao63ebb9f2015-11-30 18:22:42 +08001036 .set_config = drm_atomic_helper_set_config,
1037 .page_flip = drm_atomic_helper_page_flip,
Mark Yao2048e322014-08-22 18:36:26 +08001038 .destroy = vop_crtc_destroy,
Mark Yao63ebb9f2015-11-30 18:22:42 +08001039 .reset = drm_atomic_helper_crtc_reset,
1040 .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
1041 .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
Mark Yao2048e322014-08-22 18:36:26 +08001042};
1043
Mark Yao63ebb9f2015-11-30 18:22:42 +08001044static bool vop_win_pending_is_complete(struct vop_win *vop_win)
Mark Yao2048e322014-08-22 18:36:26 +08001045{
Mark Yao63ebb9f2015-11-30 18:22:42 +08001046 struct drm_plane *plane = &vop_win->base;
1047 struct vop_plane_state *state = to_vop_plane_state(plane->state);
1048 dma_addr_t yrgb_mst;
Mark Yao2048e322014-08-22 18:36:26 +08001049
Mark Yao63ebb9f2015-11-30 18:22:42 +08001050 if (!state->enable)
1051 return VOP_WIN_GET(vop_win->vop, vop_win->data, enable) == 0;
Mark Yao2048e322014-08-22 18:36:26 +08001052
Mark Yao63ebb9f2015-11-30 18:22:42 +08001053 yrgb_mst = VOP_WIN_GET_YRGBADDR(vop_win->vop, vop_win->data);
Mark Yao2048e322014-08-22 18:36:26 +08001054
Mark Yao63ebb9f2015-11-30 18:22:42 +08001055 return yrgb_mst == state->yrgb_mst;
1056}
Mark Yao2048e322014-08-22 18:36:26 +08001057
Mark Yao63ebb9f2015-11-30 18:22:42 +08001058static void vop_handle_vblank(struct vop *vop)
1059{
1060 struct drm_device *drm = vop->drm_dev;
1061 struct drm_crtc *crtc = &vop->crtc;
1062 unsigned long flags;
1063 int i;
Mark Yao2048e322014-08-22 18:36:26 +08001064
Mark Yao63ebb9f2015-11-30 18:22:42 +08001065 for (i = 0; i < vop->data->win_size; i++) {
1066 if (!vop_win_pending_is_complete(&vop->win[i]))
1067 return;
Mark Yao2048e322014-08-22 18:36:26 +08001068 }
1069
Mark Yao63ebb9f2015-11-30 18:22:42 +08001070 if (vop->event) {
1071 spin_lock_irqsave(&drm->event_lock, flags);
Mark Yao2048e322014-08-22 18:36:26 +08001072
Mark Yao63ebb9f2015-11-30 18:22:42 +08001073 drm_crtc_send_vblank_event(crtc, vop->event);
1074 drm_crtc_vblank_put(crtc);
1075 vop->event = NULL;
Mark Yao2048e322014-08-22 18:36:26 +08001076
Mark Yao63ebb9f2015-11-30 18:22:42 +08001077 spin_unlock_irqrestore(&drm->event_lock, flags);
Mark Yao2048e322014-08-22 18:36:26 +08001078 }
Mark Yao63ebb9f2015-11-30 18:22:42 +08001079 if (!completion_done(&vop->wait_update_complete))
1080 complete(&vop->wait_update_complete);
Mark Yao2048e322014-08-22 18:36:26 +08001081}
1082
1083static irqreturn_t vop_isr(int irq, void *data)
1084{
1085 struct vop *vop = data;
Mark Yaob5f7b752015-11-23 15:21:08 +08001086 struct drm_crtc *crtc = &vop->crtc;
Mark Yaodbb3d942015-12-15 08:36:55 +08001087 uint32_t active_irqs;
Mark Yao2048e322014-08-22 18:36:26 +08001088 unsigned long flags;
Mark Yao10672192015-02-04 13:10:31 +08001089 int ret = IRQ_NONE;
Mark Yao2048e322014-08-22 18:36:26 +08001090
1091 /*
Mark Yaodbb3d942015-12-15 08:36:55 +08001092 * interrupt register has interrupt status, enable and clear bits, we
Mark Yao2048e322014-08-22 18:36:26 +08001093 * must hold irq_lock to avoid a race with enable/disable_vblank().
1094 */
1095 spin_lock_irqsave(&vop->irq_lock, flags);
Mark Yaodbb3d942015-12-15 08:36:55 +08001096
1097 active_irqs = VOP_INTR_GET_TYPE(vop, status, INTR_MASK);
Mark Yao2048e322014-08-22 18:36:26 +08001098 /* Clear all active interrupt sources */
1099 if (active_irqs)
Mark Yaodbb3d942015-12-15 08:36:55 +08001100 VOP_INTR_SET_TYPE(vop, clear, active_irqs, 1);
1101
Mark Yao2048e322014-08-22 18:36:26 +08001102 spin_unlock_irqrestore(&vop->irq_lock, flags);
1103
1104 /* This is expected for vop iommu irqs, since the irq is shared */
1105 if (!active_irqs)
1106 return IRQ_NONE;
1107
Mark Yao10672192015-02-04 13:10:31 +08001108 if (active_irqs & DSP_HOLD_VALID_INTR) {
1109 complete(&vop->dsp_hold_completion);
1110 active_irqs &= ~DSP_HOLD_VALID_INTR;
1111 ret = IRQ_HANDLED;
Mark Yao2048e322014-08-22 18:36:26 +08001112 }
1113
Mark Yao10672192015-02-04 13:10:31 +08001114 if (active_irqs & FS_INTR) {
Mark Yaob5f7b752015-11-23 15:21:08 +08001115 drm_crtc_handle_vblank(crtc);
Mark Yao63ebb9f2015-11-30 18:22:42 +08001116 vop_handle_vblank(vop);
Mark Yao10672192015-02-04 13:10:31 +08001117 active_irqs &= ~FS_INTR;
Mark Yao63ebb9f2015-11-30 18:22:42 +08001118 ret = IRQ_HANDLED;
Mark Yao10672192015-02-04 13:10:31 +08001119 }
Mark Yao2048e322014-08-22 18:36:26 +08001120
Mark Yao10672192015-02-04 13:10:31 +08001121 /* Unhandled irqs are spurious. */
1122 if (active_irqs)
1123 DRM_ERROR("Unknown VOP IRQs: %#02x\n", active_irqs);
1124
1125 return ret;
Mark Yao2048e322014-08-22 18:36:26 +08001126}
1127
1128static int vop_create_crtc(struct vop *vop)
1129{
1130 const struct vop_data *vop_data = vop->data;
1131 struct device *dev = vop->dev;
1132 struct drm_device *drm_dev = vop->drm_dev;
1133 struct drm_plane *primary = NULL, *cursor = NULL, *plane;
1134 struct drm_crtc *crtc = &vop->crtc;
1135 struct device_node *port;
1136 int ret;
1137 int i;
1138
1139 /*
1140 * Create drm_plane for primary and cursor planes first, since we need
1141 * to pass them to drm_crtc_init_with_planes, which sets the
1142 * "possible_crtcs" to the newly initialized crtc.
1143 */
1144 for (i = 0; i < vop_data->win_size; i++) {
1145 struct vop_win *vop_win = &vop->win[i];
1146 const struct vop_win_data *win_data = vop_win->data;
1147
1148 if (win_data->type != DRM_PLANE_TYPE_PRIMARY &&
1149 win_data->type != DRM_PLANE_TYPE_CURSOR)
1150 continue;
1151
1152 ret = drm_universal_plane_init(vop->drm_dev, &vop_win->base,
1153 0, &vop_plane_funcs,
1154 win_data->phy->data_formats,
1155 win_data->phy->nformats,
Ville Syrjäläb0b3b792015-12-09 16:19:55 +02001156 win_data->type, NULL);
Mark Yao2048e322014-08-22 18:36:26 +08001157 if (ret) {
1158 DRM_ERROR("failed to initialize plane\n");
1159 goto err_cleanup_planes;
1160 }
1161
1162 plane = &vop_win->base;
Mark Yao63ebb9f2015-11-30 18:22:42 +08001163 drm_plane_helper_add(plane, &plane_helper_funcs);
Mark Yao2048e322014-08-22 18:36:26 +08001164 if (plane->type == DRM_PLANE_TYPE_PRIMARY)
1165 primary = plane;
1166 else if (plane->type == DRM_PLANE_TYPE_CURSOR)
1167 cursor = plane;
1168 }
1169
1170 ret = drm_crtc_init_with_planes(drm_dev, crtc, primary, cursor,
Ville Syrjäläf9882872015-12-09 16:19:31 +02001171 &vop_crtc_funcs, NULL);
Mark Yao2048e322014-08-22 18:36:26 +08001172 if (ret)
1173 return ret;
1174
1175 drm_crtc_helper_add(crtc, &vop_crtc_helper_funcs);
1176
1177 /*
1178 * Create drm_planes for overlay windows with possible_crtcs restricted
1179 * to the newly created crtc.
1180 */
1181 for (i = 0; i < vop_data->win_size; i++) {
1182 struct vop_win *vop_win = &vop->win[i];
1183 const struct vop_win_data *win_data = vop_win->data;
1184 unsigned long possible_crtcs = 1 << drm_crtc_index(crtc);
1185
1186 if (win_data->type != DRM_PLANE_TYPE_OVERLAY)
1187 continue;
1188
1189 ret = drm_universal_plane_init(vop->drm_dev, &vop_win->base,
1190 possible_crtcs,
1191 &vop_plane_funcs,
1192 win_data->phy->data_formats,
1193 win_data->phy->nformats,
Ville Syrjäläb0b3b792015-12-09 16:19:55 +02001194 win_data->type, NULL);
Mark Yao2048e322014-08-22 18:36:26 +08001195 if (ret) {
1196 DRM_ERROR("failed to initialize overlay plane\n");
1197 goto err_cleanup_crtc;
1198 }
Mark Yao63ebb9f2015-11-30 18:22:42 +08001199 drm_plane_helper_add(&vop_win->base, &plane_helper_funcs);
Mark Yao2048e322014-08-22 18:36:26 +08001200 }
1201
1202 port = of_get_child_by_name(dev->of_node, "port");
1203 if (!port) {
1204 DRM_ERROR("no port node found in %s\n",
1205 dev->of_node->full_name);
1206 goto err_cleanup_crtc;
1207 }
1208
Mark Yao10672192015-02-04 13:10:31 +08001209 init_completion(&vop->dsp_hold_completion);
Mark Yao63ebb9f2015-11-30 18:22:42 +08001210 init_completion(&vop->wait_update_complete);
Mark Yao2048e322014-08-22 18:36:26 +08001211 crtc->port = port;
Mark Yaob5f7b752015-11-23 15:21:08 +08001212 rockchip_register_crtc_funcs(crtc, &private_crtc_funcs);
Mark Yao2048e322014-08-22 18:36:26 +08001213
1214 return 0;
1215
1216err_cleanup_crtc:
1217 drm_crtc_cleanup(crtc);
1218err_cleanup_planes:
1219 list_for_each_entry(plane, &drm_dev->mode_config.plane_list, head)
1220 drm_plane_cleanup(plane);
1221 return ret;
1222}
1223
1224static void vop_destroy_crtc(struct vop *vop)
1225{
1226 struct drm_crtc *crtc = &vop->crtc;
1227
Mark Yaob5f7b752015-11-23 15:21:08 +08001228 rockchip_unregister_crtc_funcs(crtc);
Mark Yao2048e322014-08-22 18:36:26 +08001229 of_node_put(crtc->port);
1230 drm_crtc_cleanup(crtc);
1231}
1232
1233static int vop_initial(struct vop *vop)
1234{
1235 const struct vop_data *vop_data = vop->data;
1236 const struct vop_reg_data *init_table = vop_data->init_table;
1237 struct reset_control *ahb_rst;
1238 int i, ret;
1239
1240 vop->hclk = devm_clk_get(vop->dev, "hclk_vop");
1241 if (IS_ERR(vop->hclk)) {
1242 dev_err(vop->dev, "failed to get hclk source\n");
1243 return PTR_ERR(vop->hclk);
1244 }
1245 vop->aclk = devm_clk_get(vop->dev, "aclk_vop");
1246 if (IS_ERR(vop->aclk)) {
1247 dev_err(vop->dev, "failed to get aclk source\n");
1248 return PTR_ERR(vop->aclk);
1249 }
1250 vop->dclk = devm_clk_get(vop->dev, "dclk_vop");
1251 if (IS_ERR(vop->dclk)) {
1252 dev_err(vop->dev, "failed to get dclk source\n");
1253 return PTR_ERR(vop->dclk);
1254 }
1255
Mark Yao2048e322014-08-22 18:36:26 +08001256 ret = clk_prepare(vop->dclk);
1257 if (ret < 0) {
1258 dev_err(vop->dev, "failed to prepare dclk\n");
Sjoerd Simonsd7b53fd2015-11-06 13:22:24 +01001259 return ret;
Mark Yao2048e322014-08-22 18:36:26 +08001260 }
1261
Sjoerd Simonsd7b53fd2015-11-06 13:22:24 +01001262 /* Enable both the hclk and aclk to setup the vop */
1263 ret = clk_prepare_enable(vop->hclk);
Mark Yao2048e322014-08-22 18:36:26 +08001264 if (ret < 0) {
Sjoerd Simonsd7b53fd2015-11-06 13:22:24 +01001265 dev_err(vop->dev, "failed to prepare/enable hclk\n");
Mark Yao2048e322014-08-22 18:36:26 +08001266 goto err_unprepare_dclk;
1267 }
1268
Sjoerd Simonsd7b53fd2015-11-06 13:22:24 +01001269 ret = clk_prepare_enable(vop->aclk);
Mark Yao2048e322014-08-22 18:36:26 +08001270 if (ret < 0) {
Sjoerd Simonsd7b53fd2015-11-06 13:22:24 +01001271 dev_err(vop->dev, "failed to prepare/enable aclk\n");
1272 goto err_disable_hclk;
Mark Yao2048e322014-08-22 18:36:26 +08001273 }
Sjoerd Simonsd7b53fd2015-11-06 13:22:24 +01001274
Mark Yao2048e322014-08-22 18:36:26 +08001275 /*
1276 * do hclk_reset, reset all vop registers.
1277 */
1278 ahb_rst = devm_reset_control_get(vop->dev, "ahb");
1279 if (IS_ERR(ahb_rst)) {
1280 dev_err(vop->dev, "failed to get ahb reset\n");
1281 ret = PTR_ERR(ahb_rst);
Sjoerd Simonsd7b53fd2015-11-06 13:22:24 +01001282 goto err_disable_aclk;
Mark Yao2048e322014-08-22 18:36:26 +08001283 }
1284 reset_control_assert(ahb_rst);
1285 usleep_range(10, 20);
1286 reset_control_deassert(ahb_rst);
1287
1288 memcpy(vop->regsbak, vop->regs, vop->len);
1289
1290 for (i = 0; i < vop_data->table_size; i++)
1291 vop_writel(vop, init_table[i].offset, init_table[i].value);
1292
1293 for (i = 0; i < vop_data->win_size; i++) {
1294 const struct vop_win_data *win = &vop_data->win[i];
1295
1296 VOP_WIN_SET(vop, win, enable, 0);
1297 }
1298
1299 vop_cfg_done(vop);
1300
1301 /*
1302 * do dclk_reset, let all config take affect.
1303 */
1304 vop->dclk_rst = devm_reset_control_get(vop->dev, "dclk");
1305 if (IS_ERR(vop->dclk_rst)) {
1306 dev_err(vop->dev, "failed to get dclk reset\n");
1307 ret = PTR_ERR(vop->dclk_rst);
Sjoerd Simonsd7b53fd2015-11-06 13:22:24 +01001308 goto err_disable_aclk;
Mark Yao2048e322014-08-22 18:36:26 +08001309 }
1310 reset_control_assert(vop->dclk_rst);
1311 usleep_range(10, 20);
1312 reset_control_deassert(vop->dclk_rst);
1313
1314 clk_disable(vop->hclk);
Sjoerd Simonsd7b53fd2015-11-06 13:22:24 +01001315 clk_disable(vop->aclk);
Mark Yao2048e322014-08-22 18:36:26 +08001316
Mark Yao31e980c2015-01-22 14:37:56 +08001317 vop->is_enabled = false;
Mark Yao2048e322014-08-22 18:36:26 +08001318
1319 return 0;
1320
Sjoerd Simonsd7b53fd2015-11-06 13:22:24 +01001321err_disable_aclk:
1322 clk_disable_unprepare(vop->aclk);
Mark Yao2048e322014-08-22 18:36:26 +08001323err_disable_hclk:
Sjoerd Simonsd7b53fd2015-11-06 13:22:24 +01001324 clk_disable_unprepare(vop->hclk);
Mark Yao2048e322014-08-22 18:36:26 +08001325err_unprepare_dclk:
1326 clk_unprepare(vop->dclk);
Mark Yao2048e322014-08-22 18:36:26 +08001327 return ret;
1328}
1329
1330/*
1331 * Initialize the vop->win array elements.
1332 */
1333static void vop_win_init(struct vop *vop)
1334{
1335 const struct vop_data *vop_data = vop->data;
1336 unsigned int i;
1337
1338 for (i = 0; i < vop_data->win_size; i++) {
1339 struct vop_win *vop_win = &vop->win[i];
1340 const struct vop_win_data *win_data = &vop_data->win[i];
1341
1342 vop_win->data = win_data;
1343 vop_win->vop = vop;
Mark Yao2048e322014-08-22 18:36:26 +08001344 }
1345}
1346
1347static int vop_bind(struct device *dev, struct device *master, void *data)
1348{
1349 struct platform_device *pdev = to_platform_device(dev);
Mark Yao2048e322014-08-22 18:36:26 +08001350 const struct vop_data *vop_data;
1351 struct drm_device *drm_dev = data;
1352 struct vop *vop;
1353 struct resource *res;
1354 size_t alloc_size;
Heiko Stuebner3ea68922015-04-20 01:00:53 +02001355 int ret, irq;
Mark Yao2048e322014-08-22 18:36:26 +08001356
Mark Yaoa67719d2015-12-15 08:58:26 +08001357 vop_data = of_device_get_match_data(dev);
Mark Yao2048e322014-08-22 18:36:26 +08001358 if (!vop_data)
1359 return -ENODEV;
1360
1361 /* Allocate vop struct and its vop_win array */
1362 alloc_size = sizeof(*vop) + sizeof(*vop->win) * vop_data->win_size;
1363 vop = devm_kzalloc(dev, alloc_size, GFP_KERNEL);
1364 if (!vop)
1365 return -ENOMEM;
1366
1367 vop->dev = dev;
1368 vop->data = vop_data;
1369 vop->drm_dev = drm_dev;
1370 dev_set_drvdata(dev, vop);
1371
1372 vop_win_init(vop);
1373
1374 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1375 vop->len = resource_size(res);
1376 vop->regs = devm_ioremap_resource(dev, res);
1377 if (IS_ERR(vop->regs))
1378 return PTR_ERR(vop->regs);
1379
1380 vop->regsbak = devm_kzalloc(dev, vop->len, GFP_KERNEL);
1381 if (!vop->regsbak)
1382 return -ENOMEM;
1383
1384 ret = vop_initial(vop);
1385 if (ret < 0) {
1386 dev_err(&pdev->dev, "cannot initial vop dev - err %d\n", ret);
1387 return ret;
1388 }
1389
Heiko Stuebner3ea68922015-04-20 01:00:53 +02001390 irq = platform_get_irq(pdev, 0);
1391 if (irq < 0) {
Mark Yao2048e322014-08-22 18:36:26 +08001392 dev_err(dev, "cannot find irq for vop\n");
Heiko Stuebner3ea68922015-04-20 01:00:53 +02001393 return irq;
Mark Yao2048e322014-08-22 18:36:26 +08001394 }
Heiko Stuebner3ea68922015-04-20 01:00:53 +02001395 vop->irq = (unsigned int)irq;
Mark Yao2048e322014-08-22 18:36:26 +08001396
1397 spin_lock_init(&vop->reg_lock);
1398 spin_lock_init(&vop->irq_lock);
1399
1400 mutex_init(&vop->vsync_mutex);
1401
Mark Yao63ebb9f2015-11-30 18:22:42 +08001402 ret = devm_request_irq(dev, vop->irq, vop_isr,
1403 IRQF_SHARED, dev_name(dev), vop);
Mark Yao2048e322014-08-22 18:36:26 +08001404 if (ret)
1405 return ret;
1406
1407 /* IRQ is initially disabled; it gets enabled in power_on */
1408 disable_irq(vop->irq);
1409
1410 ret = vop_create_crtc(vop);
1411 if (ret)
1412 return ret;
1413
1414 pm_runtime_enable(&pdev->dev);
1415 return 0;
1416}
1417
1418static void vop_unbind(struct device *dev, struct device *master, void *data)
1419{
1420 struct vop *vop = dev_get_drvdata(dev);
1421
1422 pm_runtime_disable(dev);
1423 vop_destroy_crtc(vop);
1424}
1425
Mark Yaoa67719d2015-12-15 08:58:26 +08001426const struct component_ops vop_component_ops = {
Mark Yao2048e322014-08-22 18:36:26 +08001427 .bind = vop_bind,
1428 .unbind = vop_unbind,
1429};
Stephen Rothwell54255e82015-12-31 13:40:11 +11001430EXPORT_SYMBOL_GPL(vop_component_ops);