rockchip_drm_vop.c 36.3 KB
Newer Older
M
Mark Yao 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16
/*
 * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
 * Author:Mark Yao <mark.yao@rock-chips.com>
 *
 * This software is licensed under the terms of the GNU General Public
 * License version 2, as published by the Free Software Foundation, and
 * may be copied, distributed, and modified under those terms.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#include <drm/drm.h>
#include <drm/drmP.h>
17
#include <drm/drm_atomic.h>
M
Mark Yao 已提交
18 19 20 21 22
#include <drm/drm_crtc.h>
#include <drm/drm_crtc_helper.h>
#include <drm/drm_plane_helper.h>

#include <linux/kernel.h>
23
#include <linux/module.h>
M
Mark Yao 已提交
24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45
#include <linux/platform_device.h>
#include <linux/clk.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/pm_runtime.h>
#include <linux/component.h>

#include <linux/reset.h>
#include <linux/delay.h>

#include "rockchip_drm_drv.h"
#include "rockchip_drm_gem.h"
#include "rockchip_drm_fb.h"
#include "rockchip_drm_vop.h"

#define __REG_SET_RELAXED(x, off, mask, shift, v) \
		vop_mask_write_relaxed(x, off, (mask) << shift, (v) << shift)
#define __REG_SET_NORMAL(x, off, mask, shift, v) \
		vop_mask_write(x, off, (mask) << shift, (v) << shift)

#define REG_SET(x, base, reg, v, mode) \
		__REG_SET_##mode(x, base + reg.offset, reg.mask, reg.shift, v)
46 47
#define REG_SET_MASK(x, base, reg, mask, v, mode) \
		__REG_SET_##mode(x, base + reg.offset, mask, reg.shift, v)
M
Mark Yao 已提交
48 49 50

#define VOP_WIN_SET(x, win, name, v) \
		REG_SET(x, win->base, win->phy->name, v, RELAXED)
51 52
#define VOP_SCL_SET(x, win, name, v) \
		REG_SET(x, win->base, win->phy->scl->name, v, RELAXED)
M
Mark Yao 已提交
53 54
#define VOP_SCL_SET_EXT(x, win, name, v) \
		REG_SET(x, win->base, win->phy->scl->ext->name, v, RELAXED)
M
Mark Yao 已提交
55 56 57
#define VOP_CTRL_SET(x, name, v) \
		REG_SET(x, 0, (x)->data->ctrl->name, v, NORMAL)

58 59 60
#define VOP_INTR_GET(vop, name) \
		vop_read_reg(vop, 0, &vop->data->ctrl->name)

61 62
#define VOP_INTR_SET(vop, name, mask, v) \
		REG_SET_MASK(vop, 0, vop->data->intr->name, mask, v, NORMAL)
63 64
#define VOP_INTR_SET_TYPE(vop, name, type, v) \
	do { \
65
		int i, reg = 0, mask = 0; \
66
		for (i = 0; i < vop->data->intr->nintrs; i++) { \
67
			if (vop->data->intr->intrs[i] & type) { \
68
				reg |= (v) << i; \
69 70
				mask |= 1 << i; \
			} \
71
		} \
72
		VOP_INTR_SET(vop, name, mask, reg); \
73 74 75 76
	} while (0)
#define VOP_INTR_GET_TYPE(vop, name, type) \
		vop_get_intr_type(vop, &vop->data->intr->name, type)

M
Mark Yao 已提交
77 78 79 80 81 82 83 84
#define VOP_WIN_GET(x, win, name) \
		vop_read_reg(x, win->base, &win->phy->name)

#define VOP_WIN_GET_YRGBADDR(vop, win) \
		vop_readl(vop, win->base + win->phy->yrgb_mst.offset)

#define to_vop(x) container_of(x, struct vop, crtc)
#define to_vop_win(x) container_of(x, struct vop_win, base)
85
#define to_vop_plane_state(x) container_of(x, struct vop_plane_state, base)
M
Mark Yao 已提交
86

87 88 89 90 91
struct vop_plane_state {
	struct drm_plane_state base;
	int format;
	struct drm_rect src;
	struct drm_rect dest;
M
Mark Yao 已提交
92
	dma_addr_t yrgb_mst;
93
	bool enable;
M
Mark Yao 已提交
94 95 96 97 98 99 100
};

struct vop_win {
	struct drm_plane base;
	const struct vop_win_data *data;
	struct vop *vop;

101
	struct vop_plane_state state;
M
Mark Yao 已提交
102 103 104 105 106 107
};

struct vop {
	struct drm_crtc crtc;
	struct device *dev;
	struct drm_device *drm_dev;
108
	bool is_enabled;
M
Mark Yao 已提交
109 110 111 112

	/* mutex vsync_ work */
	struct mutex vsync_mutex;
	bool vsync_work_pending;
113
	struct completion dsp_hold_completion;
114 115
	struct completion wait_update_complete;
	struct drm_pending_vblank_event *event;
M
Mark Yao 已提交
116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185

	const struct vop_data *data;

	uint32_t *regsbak;
	void __iomem *regs;

	/* physical map length of vop register */
	uint32_t len;

	/* one time only one process allowed to config the register */
	spinlock_t reg_lock;
	/* lock vop irq reg */
	spinlock_t irq_lock;

	unsigned int irq;

	/* vop AHP clk */
	struct clk *hclk;
	/* vop dclk */
	struct clk *dclk;
	/* vop share memory frequency */
	struct clk *aclk;

	/* vop dclk reset */
	struct reset_control *dclk_rst;

	struct vop_win win[];
};

static inline void vop_writel(struct vop *vop, uint32_t offset, uint32_t v)
{
	writel(v, vop->regs + offset);
	vop->regsbak[offset >> 2] = v;
}

static inline uint32_t vop_readl(struct vop *vop, uint32_t offset)
{
	return readl(vop->regs + offset);
}

static inline uint32_t vop_read_reg(struct vop *vop, uint32_t base,
				    const struct vop_reg *reg)
{
	return (vop_readl(vop, base + reg->offset) >> reg->shift) & reg->mask;
}

static inline void vop_mask_write(struct vop *vop, uint32_t offset,
				  uint32_t mask, uint32_t v)
{
	if (mask) {
		uint32_t cached_val = vop->regsbak[offset >> 2];

		cached_val = (cached_val & ~mask) | v;
		writel(cached_val, vop->regs + offset);
		vop->regsbak[offset >> 2] = cached_val;
	}
}

static inline void vop_mask_write_relaxed(struct vop *vop, uint32_t offset,
					  uint32_t mask, uint32_t v)
{
	if (mask) {
		uint32_t cached_val = vop->regsbak[offset >> 2];

		cached_val = (cached_val & ~mask) | v;
		writel_relaxed(cached_val, vop->regs + offset);
		vop->regsbak[offset >> 2] = cached_val;
	}
}

186 187 188 189 190 191 192 193 194 195 196 197 198 199
static inline uint32_t vop_get_intr_type(struct vop *vop,
					 const struct vop_reg *reg, int type)
{
	uint32_t i, ret = 0;
	uint32_t regs = vop_read_reg(vop, 0, reg);

	for (i = 0; i < vop->data->intr->nintrs; i++) {
		if ((type & vop->data->intr->intrs[i]) && (regs & 1 << i))
			ret |= vop->data->intr->intrs[i];
	}

	return ret;
}

200 201 202 203 204
static inline void vop_cfg_done(struct vop *vop)
{
	VOP_CTRL_SET(vop, cfg_done, 1);
}

205 206 207 208 209 210 211 212 213 214 215 216 217
static bool has_rb_swapped(uint32_t format)
{
	switch (format) {
	case DRM_FORMAT_XBGR8888:
	case DRM_FORMAT_ABGR8888:
	case DRM_FORMAT_BGR888:
	case DRM_FORMAT_BGR565:
		return true;
	default:
		return false;
	}
}

M
Mark Yao 已提交
218 219 220 221 222
static enum vop_data_format vop_convert_format(uint32_t format)
{
	switch (format) {
	case DRM_FORMAT_XRGB8888:
	case DRM_FORMAT_ARGB8888:
223 224
	case DRM_FORMAT_XBGR8888:
	case DRM_FORMAT_ABGR8888:
M
Mark Yao 已提交
225 226
		return VOP_FMT_ARGB8888;
	case DRM_FORMAT_RGB888:
227
	case DRM_FORMAT_BGR888:
M
Mark Yao 已提交
228 229
		return VOP_FMT_RGB888;
	case DRM_FORMAT_RGB565:
230
	case DRM_FORMAT_BGR565:
M
Mark Yao 已提交
231 232 233 234 235 236 237 238 239 240 241 242 243
		return VOP_FMT_RGB565;
	case DRM_FORMAT_NV12:
		return VOP_FMT_YUV420SP;
	case DRM_FORMAT_NV16:
		return VOP_FMT_YUV422SP;
	case DRM_FORMAT_NV24:
		return VOP_FMT_YUV444SP;
	default:
		DRM_ERROR("unsupport format[%08x]\n", format);
		return -EINVAL;
	}
}

244 245 246 247 248 249 250 251 252 253 254 255
static bool is_yuv_support(uint32_t format)
{
	switch (format) {
	case DRM_FORMAT_NV12:
	case DRM_FORMAT_NV16:
	case DRM_FORMAT_NV24:
		return true;
	default:
		return false;
	}
}

M
Mark Yao 已提交
256 257 258 259
static bool is_alpha_support(uint32_t format)
{
	switch (format) {
	case DRM_FORMAT_ARGB8888:
260
	case DRM_FORMAT_ABGR8888:
M
Mark Yao 已提交
261 262 263 264 265 266
		return true;
	default:
		return false;
	}
}

267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319
static uint16_t scl_vop_cal_scale(enum scale_mode mode, uint32_t src,
				  uint32_t dst, bool is_horizontal,
				  int vsu_mode, int *vskiplines)
{
	uint16_t val = 1 << SCL_FT_DEFAULT_FIXPOINT_SHIFT;

	if (is_horizontal) {
		if (mode == SCALE_UP)
			val = GET_SCL_FT_BIC(src, dst);
		else if (mode == SCALE_DOWN)
			val = GET_SCL_FT_BILI_DN(src, dst);
	} else {
		if (mode == SCALE_UP) {
			if (vsu_mode == SCALE_UP_BIL)
				val = GET_SCL_FT_BILI_UP(src, dst);
			else
				val = GET_SCL_FT_BIC(src, dst);
		} else if (mode == SCALE_DOWN) {
			if (vskiplines) {
				*vskiplines = scl_get_vskiplines(src, dst);
				val = scl_get_bili_dn_vskip(src, dst,
							    *vskiplines);
			} else {
				val = GET_SCL_FT_BILI_DN(src, dst);
			}
		}
	}

	return val;
}

static void scl_vop_cal_scl_fac(struct vop *vop, const struct vop_win_data *win,
			     uint32_t src_w, uint32_t src_h, uint32_t dst_w,
			     uint32_t dst_h, uint32_t pixel_format)
{
	uint16_t yrgb_hor_scl_mode, yrgb_ver_scl_mode;
	uint16_t cbcr_hor_scl_mode = SCALE_NONE;
	uint16_t cbcr_ver_scl_mode = SCALE_NONE;
	int hsub = drm_format_horz_chroma_subsampling(pixel_format);
	int vsub = drm_format_vert_chroma_subsampling(pixel_format);
	bool is_yuv = is_yuv_support(pixel_format);
	uint16_t cbcr_src_w = src_w / hsub;
	uint16_t cbcr_src_h = src_h / vsub;
	uint16_t vsu_mode;
	uint16_t lb_mode;
	uint32_t val;
	int vskiplines;

	if (dst_w > 3840) {
		DRM_ERROR("Maximum destination width (3840) exceeded\n");
		return;
	}

M
Mark Yao 已提交
320 321 322 323 324 325 326 327 328 329 330 331 332 333
	if (!win->phy->scl->ext) {
		VOP_SCL_SET(vop, win, scale_yrgb_x,
			    scl_cal_scale2(src_w, dst_w));
		VOP_SCL_SET(vop, win, scale_yrgb_y,
			    scl_cal_scale2(src_h, dst_h));
		if (is_yuv) {
			VOP_SCL_SET(vop, win, scale_cbcr_x,
				    scl_cal_scale2(src_w, dst_w));
			VOP_SCL_SET(vop, win, scale_cbcr_y,
				    scl_cal_scale2(src_h, dst_h));
		}
		return;
	}

334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350
	yrgb_hor_scl_mode = scl_get_scl_mode(src_w, dst_w);
	yrgb_ver_scl_mode = scl_get_scl_mode(src_h, dst_h);

	if (is_yuv) {
		cbcr_hor_scl_mode = scl_get_scl_mode(cbcr_src_w, dst_w);
		cbcr_ver_scl_mode = scl_get_scl_mode(cbcr_src_h, dst_h);
		if (cbcr_hor_scl_mode == SCALE_DOWN)
			lb_mode = scl_vop_cal_lb_mode(dst_w, true);
		else
			lb_mode = scl_vop_cal_lb_mode(cbcr_src_w, true);
	} else {
		if (yrgb_hor_scl_mode == SCALE_DOWN)
			lb_mode = scl_vop_cal_lb_mode(dst_w, false);
		else
			lb_mode = scl_vop_cal_lb_mode(src_w, false);
	}

M
Mark Yao 已提交
351
	VOP_SCL_SET_EXT(vop, win, lb_mode, lb_mode);
352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374
	if (lb_mode == LB_RGB_3840X2) {
		if (yrgb_ver_scl_mode != SCALE_NONE) {
			DRM_ERROR("ERROR : not allow yrgb ver scale\n");
			return;
		}
		if (cbcr_ver_scl_mode != SCALE_NONE) {
			DRM_ERROR("ERROR : not allow cbcr ver scale\n");
			return;
		}
		vsu_mode = SCALE_UP_BIL;
	} else if (lb_mode == LB_RGB_2560X4) {
		vsu_mode = SCALE_UP_BIL;
	} else {
		vsu_mode = SCALE_UP_BIC;
	}

	val = scl_vop_cal_scale(yrgb_hor_scl_mode, src_w, dst_w,
				true, 0, NULL);
	VOP_SCL_SET(vop, win, scale_yrgb_x, val);
	val = scl_vop_cal_scale(yrgb_ver_scl_mode, src_h, dst_h,
				false, vsu_mode, &vskiplines);
	VOP_SCL_SET(vop, win, scale_yrgb_y, val);

M
Mark Yao 已提交
375 376
	VOP_SCL_SET_EXT(vop, win, vsd_yrgb_gt4, vskiplines == 4);
	VOP_SCL_SET_EXT(vop, win, vsd_yrgb_gt2, vskiplines == 2);
377

M
Mark Yao 已提交
378 379 380 381 382
	VOP_SCL_SET_EXT(vop, win, yrgb_hor_scl_mode, yrgb_hor_scl_mode);
	VOP_SCL_SET_EXT(vop, win, yrgb_ver_scl_mode, yrgb_ver_scl_mode);
	VOP_SCL_SET_EXT(vop, win, yrgb_hsd_mode, SCALE_DOWN_BIL);
	VOP_SCL_SET_EXT(vop, win, yrgb_vsd_mode, SCALE_DOWN_BIL);
	VOP_SCL_SET_EXT(vop, win, yrgb_vsu_mode, vsu_mode);
383 384 385 386 387 388 389 390
	if (is_yuv) {
		val = scl_vop_cal_scale(cbcr_hor_scl_mode, cbcr_src_w,
					dst_w, true, 0, NULL);
		VOP_SCL_SET(vop, win, scale_cbcr_x, val);
		val = scl_vop_cal_scale(cbcr_ver_scl_mode, cbcr_src_h,
					dst_h, false, vsu_mode, &vskiplines);
		VOP_SCL_SET(vop, win, scale_cbcr_y, val);

M
Mark Yao 已提交
391 392 393 394 395 396 397
		VOP_SCL_SET_EXT(vop, win, vsd_cbcr_gt4, vskiplines == 4);
		VOP_SCL_SET_EXT(vop, win, vsd_cbcr_gt2, vskiplines == 2);
		VOP_SCL_SET_EXT(vop, win, cbcr_hor_scl_mode, cbcr_hor_scl_mode);
		VOP_SCL_SET_EXT(vop, win, cbcr_ver_scl_mode, cbcr_ver_scl_mode);
		VOP_SCL_SET_EXT(vop, win, cbcr_hsd_mode, SCALE_DOWN_BIL);
		VOP_SCL_SET_EXT(vop, win, cbcr_vsd_mode, SCALE_DOWN_BIL);
		VOP_SCL_SET_EXT(vop, win, cbcr_vsu_mode, vsu_mode);
398 399 400
	}
}

401 402 403 404 405 406 407 408 409
static void vop_dsp_hold_valid_irq_enable(struct vop *vop)
{
	unsigned long flags;

	if (WARN_ON(!vop->is_enabled))
		return;

	spin_lock_irqsave(&vop->irq_lock, flags);

410
	VOP_INTR_SET_TYPE(vop, enable, DSP_HOLD_VALID_INTR, 1);
411 412 413 414 415 416 417 418 419 420 421 422 423

	spin_unlock_irqrestore(&vop->irq_lock, flags);
}

static void vop_dsp_hold_valid_irq_disable(struct vop *vop)
{
	unsigned long flags;

	if (WARN_ON(!vop->is_enabled))
		return;

	spin_lock_irqsave(&vop->irq_lock, flags);

424
	VOP_INTR_SET_TYPE(vop, enable, DSP_HOLD_VALID_INTR, 0);
425 426 427 428

	spin_unlock_irqrestore(&vop->irq_lock, flags);
}

429
static void vop_enable(struct drm_crtc *crtc)
M
Mark Yao 已提交
430 431 432 433
{
	struct vop *vop = to_vop(crtc);
	int ret;

434 435 436
	if (vop->is_enabled)
		return;

437 438 439 440 441 442
	ret = pm_runtime_get_sync(vop->dev);
	if (ret < 0) {
		dev_err(vop->dev, "failed to get pm runtime: %d\n", ret);
		return;
	}

M
Mark Yao 已提交
443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472
	ret = clk_enable(vop->hclk);
	if (ret < 0) {
		dev_err(vop->dev, "failed to enable hclk - %d\n", ret);
		return;
	}

	ret = clk_enable(vop->dclk);
	if (ret < 0) {
		dev_err(vop->dev, "failed to enable dclk - %d\n", ret);
		goto err_disable_hclk;
	}

	ret = clk_enable(vop->aclk);
	if (ret < 0) {
		dev_err(vop->dev, "failed to enable aclk - %d\n", ret);
		goto err_disable_dclk;
	}

	/*
	 * Slave iommu shares power, irq and clock with vop.  It was associated
	 * automatically with this master device via common driver code.
	 * Now that we have enabled the clock we attach it to the shared drm
	 * mapping.
	 */
	ret = rockchip_drm_dma_attach_device(vop->drm_dev, vop->dev);
	if (ret) {
		dev_err(vop->dev, "failed to attach dma mapping, %d\n", ret);
		goto err_disable_aclk;
	}

473
	memcpy(vop->regs, vop->regsbak, vop->len);
474 475 476 477 478
	/*
	 * At here, vop clock & iommu is enable, R/W vop regs would be safe.
	 */
	vop->is_enabled = true;

M
Mark Yao 已提交
479 480 481 482 483 484 485 486
	spin_lock(&vop->reg_lock);

	VOP_CTRL_SET(vop, standby, 0);

	spin_unlock(&vop->reg_lock);

	enable_irq(vop->irq);

487
	drm_crtc_vblank_on(crtc);
M
Mark Yao 已提交
488 489 490 491 492 493 494 495 496 497 498

	return;

err_disable_aclk:
	clk_disable(vop->aclk);
err_disable_dclk:
	clk_disable(vop->dclk);
err_disable_hclk:
	clk_disable(vop->hclk);
}

499
static void vop_crtc_disable(struct drm_crtc *crtc)
M
Mark Yao 已提交
500 501 502
{
	struct vop *vop = to_vop(crtc);

503 504 505
	if (!vop->is_enabled)
		return;

506
	drm_crtc_vblank_off(crtc);
M
Mark Yao 已提交
507 508

	/*
509 510 511 512 513
	 * Vop standby will take effect at end of current frame,
	 * if dsp hold valid irq happen, it means standby complete.
	 *
	 * we must wait standby complete when we want to disable aclk,
	 * if not, memory bus maybe dead.
M
Mark Yao 已提交
514
	 */
515 516 517
	reinit_completion(&vop->dsp_hold_completion);
	vop_dsp_hold_valid_irq_enable(vop);

M
Mark Yao 已提交
518 519 520 521 522
	spin_lock(&vop->reg_lock);

	VOP_CTRL_SET(vop, standby, 1);

	spin_unlock(&vop->reg_lock);
523

524 525 526 527 528 529
	wait_for_completion(&vop->dsp_hold_completion);

	vop_dsp_hold_valid_irq_disable(vop);

	disable_irq(vop->irq);

530
	vop->is_enabled = false;
531

M
Mark Yao 已提交
532
	/*
533
	 * vop standby complete, so iommu detach is safe.
M
Mark Yao 已提交
534 535 536
	 */
	rockchip_drm_dma_detach_device(vop->drm_dev, vop->dev);

537
	clk_disable(vop->dclk);
M
Mark Yao 已提交
538 539
	clk_disable(vop->aclk);
	clk_disable(vop->hclk);
540
	pm_runtime_put(vop->dev);
M
Mark Yao 已提交
541 542
}

543
static void vop_plane_destroy(struct drm_plane *plane)
M
Mark Yao 已提交
544
{
545
	drm_plane_cleanup(plane);
M
Mark Yao 已提交
546 547
}

548 549
static int vop_plane_atomic_check(struct drm_plane *plane,
			   struct drm_plane_state *state)
M
Mark Yao 已提交
550
{
551
	struct drm_crtc *crtc = state->crtc;
552
	struct drm_crtc_state *crtc_state;
553
	struct drm_framebuffer *fb = state->fb;
M
Mark Yao 已提交
554
	struct vop_win *vop_win = to_vop_win(plane);
555
	struct vop_plane_state *vop_plane_state = to_vop_plane_state(state);
M
Mark Yao 已提交
556 557 558
	const struct vop_win_data *win = vop_win->data;
	bool visible;
	int ret;
559 560 561
	struct drm_rect *dest = &vop_plane_state->dest;
	struct drm_rect *src = &vop_plane_state->src;
	struct drm_rect clip;
562 563 564 565
	int min_scale = win->phy->scl ? FRAC_16_16(1, 8) :
					DRM_PLANE_HELPER_NO_SCALING;
	int max_scale = win->phy->scl ? FRAC_16_16(8, 1) :
					DRM_PLANE_HELPER_NO_SCALING;
M
Mark Yao 已提交
566

567 568
	if (!crtc || !fb)
		goto out_disable;
569 570 571 572 573

	crtc_state = drm_atomic_get_existing_crtc_state(state->state, crtc);
	if (WARN_ON(!crtc_state))
		return -EINVAL;

574 575 576 577 578 579 580 581 582 583 584
	src->x1 = state->src_x;
	src->y1 = state->src_y;
	src->x2 = state->src_x + state->src_w;
	src->y2 = state->src_y + state->src_h;
	dest->x1 = state->crtc_x;
	dest->y1 = state->crtc_y;
	dest->x2 = state->crtc_x + state->crtc_w;
	dest->y2 = state->crtc_y + state->crtc_h;

	clip.x1 = 0;
	clip.y1 = 0;
585 586
	clip.x2 = crtc_state->adjusted_mode.hdisplay;
	clip.y2 = crtc_state->adjusted_mode.vdisplay;
587 588 589

	ret = drm_plane_helper_check_update(plane, crtc, state->fb,
					    src, dest, &clip,
590 591
					    min_scale,
					    max_scale,
592
					    true, true, &visible);
M
Mark Yao 已提交
593 594 595 596
	if (ret)
		return ret;

	if (!visible)
597
		goto out_disable;
M
Mark Yao 已提交
598

599 600 601
	vop_plane_state->format = vop_convert_format(fb->pixel_format);
	if (vop_plane_state->format < 0)
		return vop_plane_state->format;
602

603 604 605 606 607
	/*
	 * Src.x1 can be odd when do clip, but yuv plane start point
	 * need align with 2 pixel.
	 */
	if (is_yuv_support(fb->pixel_format) && ((src->x1 >> 16) % 2))
M
Mark Yao 已提交
608 609
		return -EINVAL;

610
	vop_plane_state->enable = true;
M
Mark Yao 已提交
611

612
	return 0;
613

614 615 616 617
out_disable:
	vop_plane_state->enable = false;
	return 0;
}
M
Mark Yao 已提交
618

619 620 621 622 623 624 625
static void vop_plane_atomic_disable(struct drm_plane *plane,
				     struct drm_plane_state *old_state)
{
	struct vop_plane_state *vop_plane_state = to_vop_plane_state(old_state);
	struct vop_win *vop_win = to_vop_win(plane);
	const struct vop_win_data *win = vop_win->data;
	struct vop *vop = to_vop(old_state->crtc);
M
Mark Yao 已提交
626

627 628
	if (!old_state->crtc)
		return;
M
Mark Yao 已提交
629

630
	spin_lock(&vop->reg_lock);
M
Mark Yao 已提交
631

632
	VOP_WIN_SET(vop, win, enable, 0);
633

634
	spin_unlock(&vop->reg_lock);
635

636 637
	vop_plane_state->enable = false;
}
638

639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659
static void vop_plane_atomic_update(struct drm_plane *plane,
		struct drm_plane_state *old_state)
{
	struct drm_plane_state *state = plane->state;
	struct drm_crtc *crtc = state->crtc;
	struct vop_win *vop_win = to_vop_win(plane);
	struct vop_plane_state *vop_plane_state = to_vop_plane_state(state);
	const struct vop_win_data *win = vop_win->data;
	struct vop *vop = to_vop(state->crtc);
	struct drm_framebuffer *fb = state->fb;
	unsigned int actual_w, actual_h;
	unsigned int dsp_stx, dsp_sty;
	uint32_t act_info, dsp_info, dsp_st;
	struct drm_rect *src = &vop_plane_state->src;
	struct drm_rect *dest = &vop_plane_state->dest;
	struct drm_gem_object *obj, *uv_obj;
	struct rockchip_gem_object *rk_obj, *rk_uv_obj;
	unsigned long offset;
	dma_addr_t dma_addr;
	uint32_t val;
	bool rb_swap;
660

M
Mark Yao 已提交
661
	/*
662
	 * can't update plane when vop is disabled.
M
Mark Yao 已提交
663
	 */
664 665
	if (!crtc)
		return;
M
Mark Yao 已提交
666

667 668
	if (WARN_ON(!vop->is_enabled))
		return;
M
Mark Yao 已提交
669

670 671 672
	if (!vop_plane_state->enable) {
		vop_plane_atomic_disable(plane, old_state);
		return;
M
Mark Yao 已提交
673
	}
674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691

	obj = rockchip_fb_get_gem_obj(fb, 0);
	rk_obj = to_rockchip_obj(obj);

	actual_w = drm_rect_width(src) >> 16;
	actual_h = drm_rect_height(src) >> 16;
	act_info = (actual_h - 1) << 16 | ((actual_w - 1) & 0xffff);

	dsp_info = (drm_rect_height(dest) - 1) << 16;
	dsp_info |= (drm_rect_width(dest) - 1) & 0xffff;

	dsp_stx = dest->x1 + crtc->mode.htotal - crtc->mode.hsync_start;
	dsp_sty = dest->y1 + crtc->mode.vtotal - crtc->mode.vsync_start;
	dsp_st = dsp_sty << 16 | (dsp_stx & 0xffff);

	offset = (src->x1 >> 16) * drm_format_plane_cpp(fb->pixel_format, 0);
	offset += (src->y1 >> 16) * fb->pitches[0];
	vop_plane_state->yrgb_mst = rk_obj->dma_addr + offset + fb->offsets[0];
M
Mark Yao 已提交
692 693 694

	spin_lock(&vop->reg_lock);

695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711
	VOP_WIN_SET(vop, win, format, vop_plane_state->format);
	VOP_WIN_SET(vop, win, yrgb_vir, fb->pitches[0] >> 2);
	VOP_WIN_SET(vop, win, yrgb_mst, vop_plane_state->yrgb_mst);
	if (is_yuv_support(fb->pixel_format)) {
		int hsub = drm_format_horz_chroma_subsampling(fb->pixel_format);
		int vsub = drm_format_vert_chroma_subsampling(fb->pixel_format);
		int bpp = drm_format_plane_cpp(fb->pixel_format, 1);

		uv_obj = rockchip_fb_get_gem_obj(fb, 1);
		rk_uv_obj = to_rockchip_obj(uv_obj);

		offset = (src->x1 >> 16) * bpp / hsub;
		offset += (src->y1 >> 16) * fb->pitches[1] / vsub;

		dma_addr = rk_uv_obj->dma_addr + offset + fb->offsets[1];
		VOP_WIN_SET(vop, win, uv_vir, fb->pitches[1] >> 2);
		VOP_WIN_SET(vop, win, uv_mst, dma_addr);
712
	}
713 714 715

	if (win->phy->scl)
		scl_vop_cal_scl_fac(vop, win, actual_w, actual_h,
716
				    drm_rect_width(dest), drm_rect_height(dest),
717 718
				    fb->pixel_format);

719 720 721
	VOP_WIN_SET(vop, win, act_info, act_info);
	VOP_WIN_SET(vop, win, dsp_info, dsp_info);
	VOP_WIN_SET(vop, win, dsp_st, dsp_st);
722

723
	rb_swap = has_rb_swapped(fb->pixel_format);
724
	VOP_WIN_SET(vop, win, rb_swap, rb_swap);
M
Mark Yao 已提交
725

726
	if (is_alpha_support(fb->pixel_format)) {
M
Mark Yao 已提交
727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742
		VOP_WIN_SET(vop, win, dst_alpha_ctl,
			    DST_FACTOR_M0(ALPHA_SRC_INVERSE));
		val = SRC_ALPHA_EN(1) | SRC_COLOR_M0(ALPHA_SRC_PRE_MUL) |
			SRC_ALPHA_M0(ALPHA_STRAIGHT) |
			SRC_BLEND_M0(ALPHA_PER_PIX) |
			SRC_ALPHA_CAL_M0(ALPHA_NO_SATURATION) |
			SRC_FACTOR_M0(ALPHA_ONE);
		VOP_WIN_SET(vop, win, src_alpha_ctl, val);
	} else {
		VOP_WIN_SET(vop, win, src_alpha_ctl, SRC_ALPHA_EN(0));
	}

	VOP_WIN_SET(vop, win, enable, 1);
	spin_unlock(&vop->reg_lock);
}

743 744 745 746 747
static const struct drm_plane_helper_funcs plane_helper_funcs = {
	.atomic_check = vop_plane_atomic_check,
	.atomic_update = vop_plane_atomic_update,
	.atomic_disable = vop_plane_atomic_disable,
};
M
Mark Yao 已提交
748

749
void vop_atomic_plane_reset(struct drm_plane *plane)
M
Mark Yao 已提交
750
{
751 752
	struct vop_plane_state *vop_plane_state =
					to_vop_plane_state(plane->state);
M
Mark Yao 已提交
753

754 755 756 757 758 759 760
	if (plane->state && plane->state->fb)
		drm_framebuffer_unreference(plane->state->fb);

	kfree(vop_plane_state);
	vop_plane_state = kzalloc(sizeof(*vop_plane_state), GFP_KERNEL);
	if (!vop_plane_state)
		return;
M
Mark Yao 已提交
761

762 763
	plane->state = &vop_plane_state->base;
	plane->state->plane = plane;
M
Mark Yao 已提交
764 765
}

766 767
struct drm_plane_state *
vop_atomic_plane_duplicate_state(struct drm_plane *plane)
M
Mark Yao 已提交
768
{
769 770
	struct vop_plane_state *old_vop_plane_state;
	struct vop_plane_state *vop_plane_state;
M
Mark Yao 已提交
771

772 773
	if (WARN_ON(!plane->state))
		return NULL;
M
Mark Yao 已提交
774

775 776 777 778 779
	old_vop_plane_state = to_vop_plane_state(plane->state);
	vop_plane_state = kmemdup(old_vop_plane_state,
				  sizeof(*vop_plane_state), GFP_KERNEL);
	if (!vop_plane_state)
		return NULL;
M
Mark Yao 已提交
780

781 782
	__drm_atomic_helper_plane_duplicate_state(plane,
						  &vop_plane_state->base);
M
Mark Yao 已提交
783

784
	return &vop_plane_state->base;
M
Mark Yao 已提交
785 786
}

787 788
static void vop_atomic_plane_destroy_state(struct drm_plane *plane,
					   struct drm_plane_state *state)
M
Mark Yao 已提交
789
{
790 791 792 793 794
	struct vop_plane_state *vop_state = to_vop_plane_state(state);

	__drm_atomic_helper_plane_destroy_state(plane, state);

	kfree(vop_state);
M
Mark Yao 已提交
795 796 797
}

static const struct drm_plane_funcs vop_plane_funcs = {
798 799
	.update_plane	= drm_atomic_helper_update_plane,
	.disable_plane	= drm_atomic_helper_disable_plane,
M
Mark Yao 已提交
800
	.destroy = vop_plane_destroy,
801 802 803
	.reset = vop_atomic_plane_reset,
	.atomic_duplicate_state = vop_atomic_plane_duplicate_state,
	.atomic_destroy_state = vop_atomic_plane_destroy_state,
M
Mark Yao 已提交
804 805 806 807 808 809 810 811
};

int rockchip_drm_crtc_mode_config(struct drm_crtc *crtc,
				  int connector_type,
				  int out_mode)
{
	struct vop *vop = to_vop(crtc);

812 813 814 815 816 817 818 819 820 821 822 823 824
	if (WARN_ON(!vop->is_enabled))
		return -EINVAL;

	switch (connector_type) {
	case DRM_MODE_CONNECTOR_LVDS:
		VOP_CTRL_SET(vop, rgb_en, 1);
		break;
	case DRM_MODE_CONNECTOR_eDP:
		VOP_CTRL_SET(vop, edp_en, 1);
		break;
	case DRM_MODE_CONNECTOR_HDMIA:
		VOP_CTRL_SET(vop, hdmi_en, 1);
		break;
825 826 827
	case DRM_MODE_CONNECTOR_DSI:
		VOP_CTRL_SET(vop, mipi_en, 1);
		break;
828 829 830 831 832
	default:
		DRM_ERROR("unsupport connector_type[%d]\n", connector_type);
		return -EINVAL;
	};
	VOP_CTRL_SET(vop, out_mode, out_mode);
M
Mark Yao 已提交
833 834 835

	return 0;
}
836
EXPORT_SYMBOL_GPL(rockchip_drm_crtc_mode_config);
M
Mark Yao 已提交
837 838 839 840 841 842

static int vop_crtc_enable_vblank(struct drm_crtc *crtc)
{
	struct vop *vop = to_vop(crtc);
	unsigned long flags;

843
	if (WARN_ON(!vop->is_enabled))
M
Mark Yao 已提交
844 845 846 847
		return -EPERM;

	spin_lock_irqsave(&vop->irq_lock, flags);

848
	VOP_INTR_SET_TYPE(vop, enable, FS_INTR, 1);
M
Mark Yao 已提交
849 850 851 852 853 854 855 856 857 858 859

	spin_unlock_irqrestore(&vop->irq_lock, flags);

	return 0;
}

static void vop_crtc_disable_vblank(struct drm_crtc *crtc)
{
	struct vop *vop = to_vop(crtc);
	unsigned long flags;

860
	if (WARN_ON(!vop->is_enabled))
M
Mark Yao 已提交
861
		return;
862

M
Mark Yao 已提交
863
	spin_lock_irqsave(&vop->irq_lock, flags);
864 865 866

	VOP_INTR_SET_TYPE(vop, enable, FS_INTR, 0);

M
Mark Yao 已提交
867 868 869
	spin_unlock_irqrestore(&vop->irq_lock, flags);
}

870 871 872 873 874 875 876 877
static void vop_crtc_wait_for_update(struct drm_crtc *crtc)
{
	struct vop *vop = to_vop(crtc);

	reinit_completion(&vop->wait_update_complete);
	WARN_ON(!wait_for_completion_timeout(&vop->wait_update_complete, 100));
}

878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896
static void vop_crtc_cancel_pending_vblank(struct drm_crtc *crtc,
					   struct drm_file *file_priv)
{
	struct drm_device *drm = crtc->dev;
	struct vop *vop = to_vop(crtc);
	struct drm_pending_vblank_event *e;
	unsigned long flags;

	spin_lock_irqsave(&drm->event_lock, flags);
	e = vop->event;
	if (e && e->base.file_priv == file_priv) {
		vop->event = NULL;

		e->base.destroy(&e->base);
		file_priv->event_space += sizeof(e->event);
	}
	spin_unlock_irqrestore(&drm->event_lock, flags);
}

M
Mark Yao 已提交
897 898 899
static const struct rockchip_crtc_funcs private_crtc_funcs = {
	.enable_vblank = vop_crtc_enable_vblank,
	.disable_vblank = vop_crtc_disable_vblank,
900
	.wait_for_update = vop_crtc_wait_for_update,
901
	.cancel_pending_vblank = vop_crtc_cancel_pending_vblank,
M
Mark Yao 已提交
902 903 904 905 906 907
};

static bool vop_crtc_mode_fixup(struct drm_crtc *crtc,
				const struct drm_display_mode *mode,
				struct drm_display_mode *adjusted_mode)
{
908 909 910 911 912
	struct vop *vop = to_vop(crtc);

	adjusted_mode->clock =
		clk_round_rate(vop->dclk, mode->clock * 1000) / 1000;

M
Mark Yao 已提交
913 914 915
	return true;
}

916
static void vop_crtc_enable(struct drm_crtc *crtc)
M
Mark Yao 已提交
917 918
{
	struct vop *vop = to_vop(crtc);
919
	struct drm_display_mode *adjusted_mode = &crtc->state->adjusted_mode;
M
Mark Yao 已提交
920 921 922 923 924 925 926 927 928 929 930 931
	u16 hsync_len = adjusted_mode->hsync_end - adjusted_mode->hsync_start;
	u16 hdisplay = adjusted_mode->hdisplay;
	u16 htotal = adjusted_mode->htotal;
	u16 hact_st = adjusted_mode->htotal - adjusted_mode->hsync_start;
	u16 hact_end = hact_st + hdisplay;
	u16 vdisplay = adjusted_mode->vdisplay;
	u16 vtotal = adjusted_mode->vtotal;
	u16 vsync_len = adjusted_mode->vsync_end - adjusted_mode->vsync_start;
	u16 vact_st = adjusted_mode->vtotal - adjusted_mode->vsync_start;
	u16 vact_end = vact_st + vdisplay;
	uint32_t val;

932
	vop_enable(crtc);
M
Mark Yao 已提交
933
	/*
M
Mark Yao 已提交
934 935
	 * If dclk rate is zero, mean that scanout is stop,
	 * we don't need wait any more.
M
Mark Yao 已提交
936
	 */
M
Mark Yao 已提交
937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967
	if (clk_get_rate(vop->dclk)) {
		/*
		 * Rk3288 vop timing register is immediately, when configure
		 * display timing on display time, may cause tearing.
		 *
		 * Vop standby will take effect at end of current frame,
		 * if dsp hold valid irq happen, it means standby complete.
		 *
		 * mode set:
		 *    standby and wait complete --> |----
		 *                                  | display time
		 *                                  |----
		 *                                  |---> dsp hold irq
		 *     configure display timing --> |
		 *         standby exit             |
		 *                                  | new frame start.
		 */

		reinit_completion(&vop->dsp_hold_completion);
		vop_dsp_hold_valid_irq_enable(vop);

		spin_lock(&vop->reg_lock);

		VOP_CTRL_SET(vop, standby, 1);

		spin_unlock(&vop->reg_lock);

		wait_for_completion(&vop->dsp_hold_completion);

		vop_dsp_hold_valid_irq_disable(vop);
	}
M
Mark Yao 已提交
968 969

	val = 0x8;
970 971
	val |= (adjusted_mode->flags & DRM_MODE_FLAG_NHSYNC) ? 0 : 1;
	val |= (adjusted_mode->flags & DRM_MODE_FLAG_NVSYNC) ? 0 : (1 << 1);
M
Mark Yao 已提交
972 973 974 975 976 977 978 979 980 981 982 983 984 985 986
	VOP_CTRL_SET(vop, pin_pol, val);

	VOP_CTRL_SET(vop, htotal_pw, (htotal << 16) | hsync_len);
	val = hact_st << 16;
	val |= hact_end;
	VOP_CTRL_SET(vop, hact_st_end, val);
	VOP_CTRL_SET(vop, hpost_st_end, val);

	VOP_CTRL_SET(vop, vtotal_pw, (vtotal << 16) | vsync_len);
	val = vact_st << 16;
	val |= vact_end;
	VOP_CTRL_SET(vop, vact_st_end, val);
	VOP_CTRL_SET(vop, vpost_st_end, val);

	clk_set_rate(vop->dclk, adjusted_mode->clock * 1000);
M
Mark Yao 已提交
987 988

	VOP_CTRL_SET(vop, standby, 0);
M
Mark Yao 已提交
989 990
}

991 992
static void vop_crtc_atomic_flush(struct drm_crtc *crtc,
				  struct drm_crtc_state *old_crtc_state)
M
Mark Yao 已提交
993 994 995
{
	struct vop *vop = to_vop(crtc);

996 997
	if (WARN_ON(!vop->is_enabled))
		return;
M
Mark Yao 已提交
998

999
	spin_lock(&vop->reg_lock);
M
Mark Yao 已提交
1000

1001
	vop_cfg_done(vop);
M
Mark Yao 已提交
1002

1003
	spin_unlock(&vop->reg_lock);
M
Mark Yao 已提交
1004 1005
}

1006 1007
static void vop_crtc_atomic_begin(struct drm_crtc *crtc,
				  struct drm_crtc_state *old_crtc_state)
M
Mark Yao 已提交
1008
{
1009
	struct vop *vop = to_vop(crtc);
M
Mark Yao 已提交
1010

1011 1012
	if (crtc->state->event) {
		WARN_ON(drm_crtc_vblank_get(crtc) != 0);
M
Mark Yao 已提交
1013

1014 1015 1016
		vop->event = crtc->state->event;
		crtc->state->event = NULL;
	}
M
Mark Yao 已提交
1017 1018
}

1019 1020 1021 1022 1023 1024 1025 1026
static const struct drm_crtc_helper_funcs vop_crtc_helper_funcs = {
	.enable = vop_crtc_enable,
	.disable = vop_crtc_disable,
	.mode_fixup = vop_crtc_mode_fixup,
	.atomic_flush = vop_crtc_atomic_flush,
	.atomic_begin = vop_crtc_atomic_begin,
};

M
Mark Yao 已提交
1027 1028 1029 1030 1031 1032
static void vop_crtc_destroy(struct drm_crtc *crtc)
{
	drm_crtc_cleanup(crtc);
}

static const struct drm_crtc_funcs vop_crtc_funcs = {
1033 1034
	.set_config = drm_atomic_helper_set_config,
	.page_flip = drm_atomic_helper_page_flip,
M
Mark Yao 已提交
1035
	.destroy = vop_crtc_destroy,
1036 1037 1038
	.reset = drm_atomic_helper_crtc_reset,
	.atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
	.atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
M
Mark Yao 已提交
1039 1040
};

1041
static bool vop_win_pending_is_complete(struct vop_win *vop_win)
M
Mark Yao 已提交
1042
{
1043 1044 1045
	struct drm_plane *plane = &vop_win->base;
	struct vop_plane_state *state = to_vop_plane_state(plane->state);
	dma_addr_t yrgb_mst;
M
Mark Yao 已提交
1046

1047 1048
	if (!state->enable)
		return VOP_WIN_GET(vop_win->vop, vop_win->data, enable) == 0;
M
Mark Yao 已提交
1049

1050
	yrgb_mst = VOP_WIN_GET_YRGBADDR(vop_win->vop, vop_win->data);
M
Mark Yao 已提交
1051

1052
	return yrgb_mst == state->yrgb_mst;
M
Mark Yao 已提交
1053 1054
}

1055
static void vop_handle_vblank(struct vop *vop)
M
Mark Yao 已提交
1056
{
1057 1058 1059 1060
	struct drm_device *drm = vop->drm_dev;
	struct drm_crtc *crtc = &vop->crtc;
	unsigned long flags;
	int i;
M
Mark Yao 已提交
1061

1062 1063 1064
	for (i = 0; i < vop->data->win_size; i++) {
		if (!vop_win_pending_is_complete(&vop->win[i]))
			return;
M
Mark Yao 已提交
1065 1066
	}

1067 1068
	if (vop->event) {
		spin_lock_irqsave(&drm->event_lock, flags);
M
Mark Yao 已提交
1069

1070 1071 1072
		drm_crtc_send_vblank_event(crtc, vop->event);
		drm_crtc_vblank_put(crtc);
		vop->event = NULL;
M
Mark Yao 已提交
1073

1074
		spin_unlock_irqrestore(&drm->event_lock, flags);
M
Mark Yao 已提交
1075
	}
1076 1077
	if (!completion_done(&vop->wait_update_complete))
		complete(&vop->wait_update_complete);
M
Mark Yao 已提交
1078 1079 1080 1081 1082
}

static irqreturn_t vop_isr(int irq, void *data)
{
	struct vop *vop = data;
1083
	struct drm_crtc *crtc = &vop->crtc;
1084
	uint32_t active_irqs;
M
Mark Yao 已提交
1085
	unsigned long flags;
1086
	int ret = IRQ_NONE;
M
Mark Yao 已提交
1087 1088

	/*
1089
	 * interrupt register has interrupt status, enable and clear bits, we
M
Mark Yao 已提交
1090 1091 1092
	 * must hold irq_lock to avoid a race with enable/disable_vblank().
	*/
	spin_lock_irqsave(&vop->irq_lock, flags);
1093 1094

	active_irqs = VOP_INTR_GET_TYPE(vop, status, INTR_MASK);
M
Mark Yao 已提交
1095 1096
	/* Clear all active interrupt sources */
	if (active_irqs)
1097 1098
		VOP_INTR_SET_TYPE(vop, clear, active_irqs, 1);

M
Mark Yao 已提交
1099 1100 1101 1102 1103 1104
	spin_unlock_irqrestore(&vop->irq_lock, flags);

	/* This is expected for vop iommu irqs, since the irq is shared */
	if (!active_irqs)
		return IRQ_NONE;

1105 1106 1107 1108
	if (active_irqs & DSP_HOLD_VALID_INTR) {
		complete(&vop->dsp_hold_completion);
		active_irqs &= ~DSP_HOLD_VALID_INTR;
		ret = IRQ_HANDLED;
M
Mark Yao 已提交
1109 1110
	}

1111
	if (active_irqs & FS_INTR) {
1112
		drm_crtc_handle_vblank(crtc);
1113
		vop_handle_vblank(vop);
1114
		active_irqs &= ~FS_INTR;
1115
		ret = IRQ_HANDLED;
1116
	}
M
Mark Yao 已提交
1117

1118 1119 1120 1121 1122
	/* Unhandled irqs are spurious. */
	if (active_irqs)
		DRM_ERROR("Unknown VOP IRQs: %#02x\n", active_irqs);

	return ret;
M
Mark Yao 已提交
1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152
}

static int vop_create_crtc(struct vop *vop)
{
	const struct vop_data *vop_data = vop->data;
	struct device *dev = vop->dev;
	struct drm_device *drm_dev = vop->drm_dev;
	struct drm_plane *primary = NULL, *cursor = NULL, *plane;
	struct drm_crtc *crtc = &vop->crtc;
	struct device_node *port;
	int ret;
	int i;

	/*
	 * Create drm_plane for primary and cursor planes first, since we need
	 * to pass them to drm_crtc_init_with_planes, which sets the
	 * "possible_crtcs" to the newly initialized crtc.
	 */
	for (i = 0; i < vop_data->win_size; i++) {
		struct vop_win *vop_win = &vop->win[i];
		const struct vop_win_data *win_data = vop_win->data;

		if (win_data->type != DRM_PLANE_TYPE_PRIMARY &&
		    win_data->type != DRM_PLANE_TYPE_CURSOR)
			continue;

		ret = drm_universal_plane_init(vop->drm_dev, &vop_win->base,
					       0, &vop_plane_funcs,
					       win_data->phy->data_formats,
					       win_data->phy->nformats,
1153
					       win_data->type, NULL);
M
Mark Yao 已提交
1154 1155 1156 1157 1158 1159
		if (ret) {
			DRM_ERROR("failed to initialize plane\n");
			goto err_cleanup_planes;
		}

		plane = &vop_win->base;
1160
		drm_plane_helper_add(plane, &plane_helper_funcs);
M
Mark Yao 已提交
1161 1162 1163 1164 1165 1166 1167
		if (plane->type == DRM_PLANE_TYPE_PRIMARY)
			primary = plane;
		else if (plane->type == DRM_PLANE_TYPE_CURSOR)
			cursor = plane;
	}

	ret = drm_crtc_init_with_planes(drm_dev, crtc, primary, cursor,
1168
					&vop_crtc_funcs, NULL);
M
Mark Yao 已提交
1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190
	if (ret)
		return ret;

	drm_crtc_helper_add(crtc, &vop_crtc_helper_funcs);

	/*
	 * Create drm_planes for overlay windows with possible_crtcs restricted
	 * to the newly created crtc.
	 */
	for (i = 0; i < vop_data->win_size; i++) {
		struct vop_win *vop_win = &vop->win[i];
		const struct vop_win_data *win_data = vop_win->data;
		unsigned long possible_crtcs = 1 << drm_crtc_index(crtc);

		if (win_data->type != DRM_PLANE_TYPE_OVERLAY)
			continue;

		ret = drm_universal_plane_init(vop->drm_dev, &vop_win->base,
					       possible_crtcs,
					       &vop_plane_funcs,
					       win_data->phy->data_formats,
					       win_data->phy->nformats,
1191
					       win_data->type, NULL);
M
Mark Yao 已提交
1192 1193 1194 1195
		if (ret) {
			DRM_ERROR("failed to initialize overlay plane\n");
			goto err_cleanup_crtc;
		}
1196
		drm_plane_helper_add(&vop_win->base, &plane_helper_funcs);
M
Mark Yao 已提交
1197 1198 1199 1200 1201 1202 1203 1204 1205
	}

	port = of_get_child_by_name(dev->of_node, "port");
	if (!port) {
		DRM_ERROR("no port node found in %s\n",
			  dev->of_node->full_name);
		goto err_cleanup_crtc;
	}

1206
	init_completion(&vop->dsp_hold_completion);
1207
	init_completion(&vop->wait_update_complete);
M
Mark Yao 已提交
1208
	crtc->port = port;
1209
	rockchip_register_crtc_funcs(crtc, &private_crtc_funcs);
M
Mark Yao 已提交
1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224

	return 0;

err_cleanup_crtc:
	drm_crtc_cleanup(crtc);
err_cleanup_planes:
	list_for_each_entry(plane, &drm_dev->mode_config.plane_list, head)
		drm_plane_cleanup(plane);
	return ret;
}

static void vop_destroy_crtc(struct vop *vop)
{
	struct drm_crtc *crtc = &vop->crtc;

1225
	rockchip_unregister_crtc_funcs(crtc);
M
Mark Yao 已提交
1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255
	of_node_put(crtc->port);
	drm_crtc_cleanup(crtc);
}

static int vop_initial(struct vop *vop)
{
	const struct vop_data *vop_data = vop->data;
	const struct vop_reg_data *init_table = vop_data->init_table;
	struct reset_control *ahb_rst;
	int i, ret;

	vop->hclk = devm_clk_get(vop->dev, "hclk_vop");
	if (IS_ERR(vop->hclk)) {
		dev_err(vop->dev, "failed to get hclk source\n");
		return PTR_ERR(vop->hclk);
	}
	vop->aclk = devm_clk_get(vop->dev, "aclk_vop");
	if (IS_ERR(vop->aclk)) {
		dev_err(vop->dev, "failed to get aclk source\n");
		return PTR_ERR(vop->aclk);
	}
	vop->dclk = devm_clk_get(vop->dev, "dclk_vop");
	if (IS_ERR(vop->dclk)) {
		dev_err(vop->dev, "failed to get dclk source\n");
		return PTR_ERR(vop->dclk);
	}

	ret = clk_prepare(vop->dclk);
	if (ret < 0) {
		dev_err(vop->dev, "failed to prepare dclk\n");
1256
		return ret;
M
Mark Yao 已提交
1257 1258
	}

1259 1260
	/* Enable both the hclk and aclk to setup the vop */
	ret = clk_prepare_enable(vop->hclk);
M
Mark Yao 已提交
1261
	if (ret < 0) {
1262
		dev_err(vop->dev, "failed to prepare/enable hclk\n");
M
Mark Yao 已提交
1263 1264 1265
		goto err_unprepare_dclk;
	}

1266
	ret = clk_prepare_enable(vop->aclk);
M
Mark Yao 已提交
1267
	if (ret < 0) {
1268 1269
		dev_err(vop->dev, "failed to prepare/enable aclk\n");
		goto err_disable_hclk;
M
Mark Yao 已提交
1270
	}
1271

M
Mark Yao 已提交
1272 1273 1274 1275 1276 1277 1278
	/*
	 * do hclk_reset, reset all vop registers.
	 */
	ahb_rst = devm_reset_control_get(vop->dev, "ahb");
	if (IS_ERR(ahb_rst)) {
		dev_err(vop->dev, "failed to get ahb reset\n");
		ret = PTR_ERR(ahb_rst);
1279
		goto err_disable_aclk;
M
Mark Yao 已提交
1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304
	}
	reset_control_assert(ahb_rst);
	usleep_range(10, 20);
	reset_control_deassert(ahb_rst);

	memcpy(vop->regsbak, vop->regs, vop->len);

	for (i = 0; i < vop_data->table_size; i++)
		vop_writel(vop, init_table[i].offset, init_table[i].value);

	for (i = 0; i < vop_data->win_size; i++) {
		const struct vop_win_data *win = &vop_data->win[i];

		VOP_WIN_SET(vop, win, enable, 0);
	}

	vop_cfg_done(vop);

	/*
	 * do dclk_reset, let all config take affect.
	 */
	vop->dclk_rst = devm_reset_control_get(vop->dev, "dclk");
	if (IS_ERR(vop->dclk_rst)) {
		dev_err(vop->dev, "failed to get dclk reset\n");
		ret = PTR_ERR(vop->dclk_rst);
1305
		goto err_disable_aclk;
M
Mark Yao 已提交
1306 1307 1308 1309 1310 1311
	}
	reset_control_assert(vop->dclk_rst);
	usleep_range(10, 20);
	reset_control_deassert(vop->dclk_rst);

	clk_disable(vop->hclk);
1312
	clk_disable(vop->aclk);
M
Mark Yao 已提交
1313

1314
	vop->is_enabled = false;
M
Mark Yao 已提交
1315 1316 1317

	return 0;

1318 1319
err_disable_aclk:
	clk_disable_unprepare(vop->aclk);
M
Mark Yao 已提交
1320
err_disable_hclk:
1321
	clk_disable_unprepare(vop->hclk);
M
Mark Yao 已提交
1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351
err_unprepare_dclk:
	clk_unprepare(vop->dclk);
	return ret;
}

/*
 * Initialize the vop->win array elements.
 */
static void vop_win_init(struct vop *vop)
{
	const struct vop_data *vop_data = vop->data;
	unsigned int i;

	for (i = 0; i < vop_data->win_size; i++) {
		struct vop_win *vop_win = &vop->win[i];
		const struct vop_win_data *win_data = &vop_data->win[i];

		vop_win->data = win_data;
		vop_win->vop = vop;
	}
}

static int vop_bind(struct device *dev, struct device *master, void *data)
{
	struct platform_device *pdev = to_platform_device(dev);
	const struct vop_data *vop_data;
	struct drm_device *drm_dev = data;
	struct vop *vop;
	struct resource *res;
	size_t alloc_size;
1352
	int ret, irq;
M
Mark Yao 已提交
1353

1354
	vop_data = of_device_get_match_data(dev);
M
Mark Yao 已提交
1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386
	if (!vop_data)
		return -ENODEV;

	/* Allocate vop struct and its vop_win array */
	alloc_size = sizeof(*vop) + sizeof(*vop->win) * vop_data->win_size;
	vop = devm_kzalloc(dev, alloc_size, GFP_KERNEL);
	if (!vop)
		return -ENOMEM;

	vop->dev = dev;
	vop->data = vop_data;
	vop->drm_dev = drm_dev;
	dev_set_drvdata(dev, vop);

	vop_win_init(vop);

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	vop->len = resource_size(res);
	vop->regs = devm_ioremap_resource(dev, res);
	if (IS_ERR(vop->regs))
		return PTR_ERR(vop->regs);

	vop->regsbak = devm_kzalloc(dev, vop->len, GFP_KERNEL);
	if (!vop->regsbak)
		return -ENOMEM;

	ret = vop_initial(vop);
	if (ret < 0) {
		dev_err(&pdev->dev, "cannot initial vop dev - err %d\n", ret);
		return ret;
	}

1387 1388
	irq = platform_get_irq(pdev, 0);
	if (irq < 0) {
M
Mark Yao 已提交
1389
		dev_err(dev, "cannot find irq for vop\n");
1390
		return irq;
M
Mark Yao 已提交
1391
	}
1392
	vop->irq = (unsigned int)irq;
M
Mark Yao 已提交
1393 1394 1395 1396 1397 1398

	spin_lock_init(&vop->reg_lock);
	spin_lock_init(&vop->irq_lock);

	mutex_init(&vop->vsync_mutex);

1399 1400
	ret = devm_request_irq(dev, vop->irq, vop_isr,
			       IRQF_SHARED, dev_name(dev), vop);
M
Mark Yao 已提交
1401 1402 1403 1404 1405 1406 1407 1408 1409 1410 1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422
	if (ret)
		return ret;

	/* IRQ is initially disabled; it gets enabled in power_on */
	disable_irq(vop->irq);

	ret = vop_create_crtc(vop);
	if (ret)
		return ret;

	pm_runtime_enable(&pdev->dev);
	return 0;
}

static void vop_unbind(struct device *dev, struct device *master, void *data)
{
	struct vop *vop = dev_get_drvdata(dev);

	pm_runtime_disable(dev);
	vop_destroy_crtc(vop);
}

1423
const struct component_ops vop_component_ops = {
M
Mark Yao 已提交
1424 1425 1426
	.bind = vop_bind,
	.unbind = vop_unbind,
};
1427
EXPORT_SYMBOL_GPL(vop_component_ops);