Home | History | Annotate | Line # | Download | only in rockchip
rk_vop.c revision 1.11
      1  1.11  riastrad /* $NetBSD: rk_vop.c,v 1.11 2021/12/19 11:00:46 riastradh Exp $ */
      2   1.1  jmcneill 
      3   1.1  jmcneill /*-
      4   1.1  jmcneill  * Copyright (c) 2019 Jared D. McNeill <jmcneill (at) invisible.ca>
      5   1.1  jmcneill  * All rights reserved.
      6   1.1  jmcneill  *
      7   1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      8   1.1  jmcneill  * modification, are permitted provided that the following conditions
      9   1.1  jmcneill  * are met:
     10   1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     11   1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     12   1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     13   1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     14   1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     15   1.1  jmcneill  *
     16   1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17   1.1  jmcneill  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18   1.1  jmcneill  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19   1.1  jmcneill  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20   1.1  jmcneill  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     21   1.1  jmcneill  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     22   1.1  jmcneill  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     23   1.1  jmcneill  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     24   1.1  jmcneill  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25   1.1  jmcneill  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26   1.1  jmcneill  * SUCH DAMAGE.
     27   1.1  jmcneill  */
     28   1.1  jmcneill 
     29   1.1  jmcneill #include <sys/cdefs.h>
     30  1.11  riastrad __KERNEL_RCSID(0, "$NetBSD: rk_vop.c,v 1.11 2021/12/19 11:00:46 riastradh Exp $");
     31   1.1  jmcneill 
     32   1.1  jmcneill #include <sys/param.h>
     33   1.1  jmcneill #include <sys/bus.h>
     34   1.1  jmcneill #include <sys/device.h>
     35   1.1  jmcneill #include <sys/intr.h>
     36   1.1  jmcneill #include <sys/systm.h>
     37   1.1  jmcneill #include <sys/kernel.h>
     38   1.1  jmcneill #include <sys/conf.h>
     39   1.1  jmcneill #include <sys/sysctl.h>
     40   1.1  jmcneill 
     41  1.11  riastrad #include <drm/drm_drv.h>
     42   1.1  jmcneill #include <drm/drm_crtc.h>
     43   1.1  jmcneill #include <drm/drm_crtc_helper.h>
     44  1.11  riastrad #include <drm/drm_fourcc.h>
     45   1.1  jmcneill #include <drm/drm_plane_helper.h>
     46   1.1  jmcneill 
     47   1.1  jmcneill #include <dev/fdt/fdtvar.h>
     48   1.1  jmcneill #include <dev/fdt/fdt_port.h>
     49   1.1  jmcneill 
     50   1.1  jmcneill #include <arm/rockchip/rk_drm.h>
     51   1.1  jmcneill 
     52   1.1  jmcneill #define	VOP_REG_CFG_DONE		0x0000
     53   1.1  jmcneill #define	 REG_LOAD_EN			__BIT(0)
     54   1.1  jmcneill #define	VOP_SYS_CTRL			0x0008
     55   1.1  jmcneill #define	 VOP_STANDBY_EN			__BIT(22)
     56   1.1  jmcneill #define	 MIPI_OUT_EN			__BIT(15)
     57   1.1  jmcneill #define	 EDP_OUT_EN			__BIT(14)
     58   1.1  jmcneill #define	 HDMI_OUT_EN			__BIT(13)
     59   1.1  jmcneill #define	 RGB_OUT_EN			__BIT(12)
     60   1.1  jmcneill #define	VOP_DSP_CTRL0			0x0010
     61   1.1  jmcneill #define	 DSP_OUT_MODE			__BITS(3,0)
     62   1.1  jmcneill #define	  DSP_OUT_MODE_RGB888		0
     63   1.1  jmcneill #define	  DSP_OUT_MODE_RGBaaa		15
     64   1.1  jmcneill #define	VOP_DSP_CTRL1			0x0014
     65   1.1  jmcneill #define	VOP_WIN0_CTRL			0x0030
     66   1.1  jmcneill #define	 WIN0_LB_MODE			__BITS(7,5)
     67   1.1  jmcneill #define	  WIN0_LB_MODE_RGB_3840X2	2
     68   1.1  jmcneill #define	  WIN0_LB_MODE_RGB_2560X4	3
     69   1.1  jmcneill #define	  WIN0_LB_MODE_RGB_1920X5	4
     70   1.1  jmcneill #define	  WIN0_LB_MODE_RGB_1280X8	5
     71   1.1  jmcneill #define	 WIN0_DATA_FMT			__BITS(3,1)
     72   1.1  jmcneill #define	  WIN0_DATA_FMT_ARGB888		0
     73   1.1  jmcneill #define	 WIN0_EN			__BIT(0)
     74   1.1  jmcneill #define	VOP_WIN0_COLOR_KEY		0x0038
     75   1.1  jmcneill #define	VOP_WIN0_VIR			0x003c
     76   1.1  jmcneill #define	 WIN0_VIR_STRIDE		__BITS(13,0)
     77   1.1  jmcneill #define	VOP_WIN0_YRGB_MST		0x0040
     78   1.1  jmcneill #define	VOP_WIN0_ACT_INFO		0x0048
     79   1.1  jmcneill #define	 WIN0_ACT_HEIGHT		__BITS(28,16)
     80   1.1  jmcneill #define	 WIN0_ACT_WIDTH			__BITS(12,0)
     81   1.1  jmcneill #define	VOP_WIN0_DSP_INFO		0x004c
     82   1.1  jmcneill #define	 WIN0_DSP_HEIGHT		__BITS(27,16)
     83   1.1  jmcneill #define	 WIN0_DSP_WIDTH			__BITS(11,0)
     84   1.1  jmcneill #define	VOP_WIN0_DSP_ST			0x0050
     85   1.1  jmcneill #define	 WIN0_DSP_YST			__BITS(28,16)
     86   1.1  jmcneill #define	 WIN0_DSP_XST			__BITS(12,0)
     87   1.1  jmcneill #define	VOP_POST_DSP_HACT_INFO		0x0170
     88   1.1  jmcneill #define	 DSP_HACT_ST_POST		__BITS(28,16)
     89   1.1  jmcneill #define	 DSP_HACT_END_POST		__BITS(12,0)
     90   1.1  jmcneill #define	VOP_POST_DSP_VACT_INFO		0x0174
     91   1.1  jmcneill #define	 DSP_VACT_ST_POST		__BITS(28,16)
     92   1.1  jmcneill #define	 DSP_VACT_END_POST		__BITS(12,0)
     93   1.1  jmcneill #define	VOP_DSP_HTOTAL_HS_END		0x0188
     94   1.2  jmcneill #define	 DSP_HS_END			__BITS(28,16)
     95   1.2  jmcneill #define	 DSP_HTOTAL			__BITS(12,0)
     96   1.1  jmcneill #define	VOP_DSP_HACT_ST_END		0x018c
     97   1.1  jmcneill #define	 DSP_HACT_ST			__BITS(28,16)
     98   1.1  jmcneill #define	 DSP_HACT_END			__BITS(12,0)
     99   1.1  jmcneill #define	VOP_DSP_VTOTAL_VS_END		0x0190
    100   1.2  jmcneill #define	 DSP_VS_END			__BITS(28,16)
    101   1.2  jmcneill #define	 DSP_VTOTAL			__BITS(12,0)
    102   1.1  jmcneill #define	VOP_DSP_VACT_ST_END		0x0194
    103   1.1  jmcneill #define	 DSP_VACT_ST			__BITS(28,16)
    104   1.1  jmcneill #define	 DSP_VACT_END			__BITS(12,0)
    105   1.1  jmcneill 
    106   1.1  jmcneill /*
    107   1.1  jmcneill  * Polarity fields are in different locations depending on SoC and output type,
    108   1.1  jmcneill  * but always in the same order.
    109   1.1  jmcneill  */
    110   1.1  jmcneill #define	DSP_DCLK_POL			__BIT(3)
    111   1.1  jmcneill #define	DSP_DEN_POL			__BIT(2)
    112   1.1  jmcneill #define	DSP_VSYNC_POL			__BIT(1)
    113   1.1  jmcneill #define	DSP_HSYNC_POL			__BIT(0)
    114   1.1  jmcneill 
    115   1.1  jmcneill enum vop_ep_type {
    116   1.1  jmcneill 	VOP_EP_MIPI,
    117   1.1  jmcneill 	VOP_EP_EDP,
    118   1.1  jmcneill 	VOP_EP_HDMI,
    119   1.1  jmcneill 	VOP_EP_MIPI1,
    120   1.1  jmcneill 	VOP_EP_DP,
    121   1.1  jmcneill 	VOP_NEP
    122   1.1  jmcneill };
    123   1.1  jmcneill 
    124   1.1  jmcneill struct rk_vop_softc;
    125   1.1  jmcneill struct rk_vop_config;
    126   1.1  jmcneill 
    127   1.1  jmcneill struct rk_vop_crtc {
    128   1.1  jmcneill 	struct drm_crtc		base;
    129   1.1  jmcneill 	struct rk_vop_softc	*sc;
    130   1.1  jmcneill };
    131   1.1  jmcneill 
    132   1.1  jmcneill struct rk_vop_softc {
    133   1.1  jmcneill 	device_t		sc_dev;
    134   1.1  jmcneill 	bus_space_tag_t		sc_bst;
    135   1.1  jmcneill 	bus_space_handle_t	sc_bsh;
    136   1.1  jmcneill 	int			sc_phandle;
    137   1.1  jmcneill 
    138   1.1  jmcneill 	struct clk		*sc_dclk;
    139   1.1  jmcneill 
    140   1.1  jmcneill 	struct rk_vop_crtc	sc_crtc;
    141   1.1  jmcneill 
    142   1.1  jmcneill 	struct fdt_device_ports	sc_ports;
    143   1.1  jmcneill 
    144   1.7   thorpej 	const struct rk_vop_config *sc_conf;
    145   1.1  jmcneill };
    146   1.1  jmcneill 
    147   1.1  jmcneill #define	to_rk_vop_crtc(x)	container_of(x, struct rk_vop_crtc, base)
    148   1.1  jmcneill 
    149   1.1  jmcneill #define	RD4(sc, reg)				\
    150   1.1  jmcneill 	bus_space_read_4((sc)->sc_bst, (sc)->sc_bsh, (reg))
    151   1.1  jmcneill #define	WR4(sc, reg, val)			\
    152   1.1  jmcneill 	bus_space_write_4((sc)->sc_bst, (sc)->sc_bsh, (reg), (val))
    153   1.1  jmcneill 
    154   1.1  jmcneill struct rk_vop_config {
    155   1.1  jmcneill 	const char		*descr;
    156   1.1  jmcneill 	u_int			out_mode;
    157   1.1  jmcneill 	void			(*init)(struct rk_vop_softc *);
    158   1.1  jmcneill 	void			(*set_polarity)(struct rk_vop_softc *,
    159   1.1  jmcneill 						enum vop_ep_type, uint32_t);
    160   1.1  jmcneill };
    161   1.1  jmcneill 
    162   1.1  jmcneill #define	RK3399_VOP_MIPI_POL	__BITS(31,28)
    163   1.1  jmcneill #define	RK3399_VOP_EDP_POL	__BITS(27,24)
    164   1.1  jmcneill #define	RK3399_VOP_HDMI_POL	__BITS(23,20)
    165   1.1  jmcneill #define	RK3399_VOP_DP_POL	__BITS(19,16)
    166   1.1  jmcneill 
    167   1.1  jmcneill #define	RK3399_VOP_SYS_CTRL_ENABLE	__BIT(11)
    168   1.1  jmcneill 
    169   1.1  jmcneill static void
    170   1.1  jmcneill rk3399_vop_set_polarity(struct rk_vop_softc *sc, enum vop_ep_type ep_type, uint32_t pol)
    171   1.1  jmcneill {
    172   1.1  jmcneill 	uint32_t mask, val;
    173   1.1  jmcneill 
    174   1.1  jmcneill 	switch (ep_type) {
    175   1.1  jmcneill 	case VOP_EP_MIPI:
    176   1.1  jmcneill 	case VOP_EP_MIPI1:
    177   1.1  jmcneill 		mask = RK3399_VOP_MIPI_POL;
    178   1.1  jmcneill 		break;
    179   1.1  jmcneill 	case VOP_EP_EDP:
    180   1.1  jmcneill 		mask = RK3399_VOP_EDP_POL;
    181   1.1  jmcneill 		break;
    182   1.1  jmcneill 	case VOP_EP_HDMI:
    183   1.1  jmcneill 		mask = RK3399_VOP_HDMI_POL;
    184   1.1  jmcneill 		break;
    185   1.1  jmcneill 	case VOP_EP_DP:
    186   1.1  jmcneill 		mask = RK3399_VOP_DP_POL;
    187   1.1  jmcneill 		break;
    188   1.1  jmcneill 	default:
    189   1.1  jmcneill 		return;
    190   1.1  jmcneill 	}
    191   1.1  jmcneill 
    192   1.1  jmcneill 	val = RD4(sc, VOP_DSP_CTRL1);
    193   1.1  jmcneill 	val &= ~mask;
    194   1.1  jmcneill 	val |= __SHIFTIN(pol, mask);
    195   1.1  jmcneill 	WR4(sc, VOP_DSP_CTRL1, val);
    196   1.1  jmcneill }
    197   1.1  jmcneill 
    198   1.1  jmcneill static void
    199   1.1  jmcneill rk3399_vop_init(struct rk_vop_softc *sc)
    200   1.1  jmcneill {
    201   1.1  jmcneill 	uint32_t val;
    202   1.1  jmcneill 
    203   1.1  jmcneill 	val = RD4(sc, VOP_SYS_CTRL);
    204   1.1  jmcneill 	val |= RK3399_VOP_SYS_CTRL_ENABLE;
    205   1.1  jmcneill 	WR4(sc, VOP_SYS_CTRL, val);
    206   1.1  jmcneill }
    207   1.1  jmcneill 
    208   1.1  jmcneill static const struct rk_vop_config rk3399_vop_lit_config = {
    209   1.1  jmcneill 	.descr = "RK3399 VOPL",
    210   1.1  jmcneill 	.out_mode = DSP_OUT_MODE_RGB888,
    211   1.1  jmcneill 	.init = rk3399_vop_init,
    212   1.1  jmcneill 	.set_polarity = rk3399_vop_set_polarity,
    213   1.1  jmcneill };
    214   1.1  jmcneill 
    215   1.1  jmcneill static const struct rk_vop_config rk3399_vop_big_config = {
    216   1.1  jmcneill 	.descr = "RK3399 VOPB",
    217   1.1  jmcneill 	.out_mode = DSP_OUT_MODE_RGBaaa,
    218   1.1  jmcneill 	.init = rk3399_vop_init,
    219   1.1  jmcneill 	.set_polarity = rk3399_vop_set_polarity,
    220   1.1  jmcneill };
    221   1.1  jmcneill 
    222   1.7   thorpej static const struct device_compatible_entry compat_data[] = {
    223   1.7   thorpej 	{ .compat = "rockchip,rk3399-vop-big",
    224   1.7   thorpej 	  .data = &rk3399_vop_big_config },
    225   1.7   thorpej 	{ .compat = "rockchip,rk3399-vop-lit",
    226   1.7   thorpej 	  .data = &rk3399_vop_lit_config },
    227   1.7   thorpej 
    228   1.9   thorpej 	DEVICE_COMPAT_EOL
    229   1.1  jmcneill };
    230   1.1  jmcneill 
    231   1.1  jmcneill static int
    232   1.1  jmcneill rk_vop_mode_do_set_base(struct drm_crtc *crtc, struct drm_framebuffer *fb,
    233   1.1  jmcneill     int x, int y, int atomic)
    234   1.1  jmcneill {
    235   1.1  jmcneill 	struct rk_vop_crtc *mixer_crtc = to_rk_vop_crtc(crtc);
    236   1.1  jmcneill 	struct rk_vop_softc * const sc = mixer_crtc->sc;
    237   1.1  jmcneill 	struct rk_drm_framebuffer *sfb = atomic?
    238   1.1  jmcneill 	    to_rk_drm_framebuffer(fb) :
    239   1.1  jmcneill 	    to_rk_drm_framebuffer(crtc->primary->fb);
    240   1.1  jmcneill 
    241   1.1  jmcneill 	uint64_t paddr = (uint64_t)sfb->obj->dmamap->dm_segs[0].ds_addr;
    242   1.1  jmcneill 
    243   1.7   thorpej 
    244   1.5  jakllsch 	paddr += y * sfb->base.pitches[0];
    245  1.11  riastrad 	paddr += x * sfb->base.format->cpp[0];
    246   1.5  jakllsch 
    247   1.1  jmcneill 	KASSERT((paddr & ~0xffffffff) == 0);
    248   1.1  jmcneill 
    249   1.5  jakllsch 	const uint32_t vir = __SHIFTIN(sfb->base.pitches[0] / 4,
    250   1.5  jakllsch 	    WIN0_VIR_STRIDE);
    251   1.5  jakllsch 	WR4(sc, VOP_WIN0_VIR, vir);
    252   1.5  jakllsch 
    253   1.1  jmcneill 	/* Framebuffer start address */
    254   1.1  jmcneill 	WR4(sc, VOP_WIN0_YRGB_MST, (uint32_t)paddr);
    255   1.1  jmcneill 
    256   1.1  jmcneill 	return 0;
    257   1.1  jmcneill }
    258   1.1  jmcneill 
    259   1.1  jmcneill static void
    260   1.1  jmcneill rk_vop_destroy(struct drm_crtc *crtc)
    261   1.1  jmcneill {
    262   1.1  jmcneill 	drm_crtc_cleanup(crtc);
    263   1.1  jmcneill }
    264   1.1  jmcneill 
    265   1.1  jmcneill static const struct drm_crtc_funcs rk_vop_crtc_funcs = {
    266   1.1  jmcneill 	.set_config = drm_crtc_helper_set_config,
    267   1.1  jmcneill 	.destroy = rk_vop_destroy,
    268   1.1  jmcneill };
    269   1.1  jmcneill 
    270   1.1  jmcneill static void
    271   1.1  jmcneill rk_vop_dpms(struct drm_crtc *crtc, int mode)
    272   1.1  jmcneill {
    273   1.6       mrg 	struct rk_vop_crtc *mixer_crtc = to_rk_vop_crtc(crtc);
    274   1.6       mrg 	struct rk_vop_softc * const sc = mixer_crtc->sc;
    275   1.6       mrg 	uint32_t val;
    276   1.6       mrg 
    277   1.6       mrg 	val = RD4(sc, VOP_SYS_CTRL);
    278   1.6       mrg 
    279   1.6       mrg 	switch (mode) {
    280   1.6       mrg 	case DRM_MODE_DPMS_ON:
    281   1.6       mrg 		val &= ~VOP_STANDBY_EN;
    282   1.6       mrg 		break;
    283   1.6       mrg 	case DRM_MODE_DPMS_STANDBY:
    284   1.6       mrg 	case DRM_MODE_DPMS_SUSPEND:
    285   1.6       mrg 	case DRM_MODE_DPMS_OFF:
    286   1.6       mrg 		val |= VOP_STANDBY_EN;
    287   1.6       mrg 		break;
    288   1.6       mrg 	}
    289   1.6       mrg 
    290   1.6       mrg 	WR4(sc, VOP_SYS_CTRL, val);
    291   1.6       mrg 
    292   1.6       mrg 	/* Commit settings */
    293   1.6       mrg 	WR4(sc, VOP_REG_CFG_DONE, REG_LOAD_EN);
    294   1.1  jmcneill }
    295   1.1  jmcneill 
    296   1.1  jmcneill static bool
    297   1.1  jmcneill rk_vop_mode_fixup(struct drm_crtc *crtc,
    298   1.1  jmcneill     const struct drm_display_mode *mode, struct drm_display_mode *adjusted_mode)
    299   1.1  jmcneill {
    300   1.1  jmcneill 	return true;
    301   1.1  jmcneill }
    302   1.1  jmcneill 
    303   1.1  jmcneill static int
    304   1.1  jmcneill rk_vop_mode_set(struct drm_crtc *crtc, struct drm_display_mode *mode,
    305   1.1  jmcneill     struct drm_display_mode *adjusted_mode, int x, int y,
    306   1.1  jmcneill     struct drm_framebuffer *old_fb)
    307   1.1  jmcneill {
    308   1.1  jmcneill 	struct rk_vop_crtc *mixer_crtc = to_rk_vop_crtc(crtc);
    309   1.1  jmcneill 	struct rk_vop_softc * const sc = mixer_crtc->sc;
    310   1.1  jmcneill 	uint32_t val;
    311   1.1  jmcneill 	u_int lb_mode;
    312   1.1  jmcneill 	int error;
    313   1.4  jakllsch 	u_int pol;
    314   1.4  jakllsch 	int connector_type = 0;
    315  1.11  riastrad 	struct drm_connector *connector;
    316  1.11  riastrad 	struct drm_connector_list_iter conn_iter;
    317   1.1  jmcneill 
    318   1.1  jmcneill 	const u_int hactive = adjusted_mode->hdisplay;
    319   1.1  jmcneill 	const u_int hsync_len = adjusted_mode->hsync_end - adjusted_mode->hsync_start;
    320   1.1  jmcneill 	const u_int hback_porch = adjusted_mode->htotal - adjusted_mode->hsync_end;
    321   1.4  jakllsch 	const u_int hfront_porch = adjusted_mode->hsync_start - adjusted_mode->hdisplay;
    322   1.1  jmcneill 
    323   1.1  jmcneill 	const u_int vactive = adjusted_mode->vdisplay;
    324   1.1  jmcneill 	const u_int vsync_len = adjusted_mode->vsync_end - adjusted_mode->vsync_start;
    325   1.1  jmcneill 	const u_int vback_porch = adjusted_mode->vtotal - adjusted_mode->vsync_end;
    326   1.4  jakllsch 	const u_int vfront_porch = adjusted_mode->vsync_start - adjusted_mode->vdisplay;
    327   1.1  jmcneill 
    328   1.1  jmcneill 	error = clk_set_rate(sc->sc_dclk, adjusted_mode->clock * 1000);
    329   1.1  jmcneill 	if (error != 0)
    330   1.1  jmcneill 		DRM_ERROR("couldn't set pixel clock: %d\n", error);
    331   1.1  jmcneill 
    332   1.1  jmcneill 	val = __SHIFTIN(hactive - 1, WIN0_ACT_WIDTH) |
    333   1.1  jmcneill 	      __SHIFTIN(vactive - 1, WIN0_ACT_HEIGHT);
    334   1.1  jmcneill 	WR4(sc, VOP_WIN0_ACT_INFO, val);
    335   1.1  jmcneill 
    336   1.1  jmcneill 	val = __SHIFTIN(hactive - 1, WIN0_DSP_WIDTH) |
    337   1.1  jmcneill 	      __SHIFTIN(vactive - 1, WIN0_DSP_HEIGHT);
    338   1.1  jmcneill 	WR4(sc, VOP_WIN0_DSP_INFO, val);
    339   1.1  jmcneill 
    340   1.2  jmcneill 	val = __SHIFTIN(hsync_len + hback_porch, WIN0_DSP_XST) |
    341   1.2  jmcneill 	      __SHIFTIN(vsync_len + vback_porch, WIN0_DSP_YST);
    342   1.1  jmcneill 	WR4(sc, VOP_WIN0_DSP_ST, val);
    343   1.1  jmcneill 
    344   1.1  jmcneill 	WR4(sc, VOP_WIN0_COLOR_KEY, 0);
    345   1.1  jmcneill 
    346   1.1  jmcneill 	if (adjusted_mode->hdisplay > 2560)
    347   1.1  jmcneill 		lb_mode = WIN0_LB_MODE_RGB_3840X2;
    348   1.1  jmcneill 	else if (adjusted_mode->hdisplay > 1920)
    349   1.1  jmcneill 		lb_mode = WIN0_LB_MODE_RGB_2560X4;
    350   1.1  jmcneill 	else if (adjusted_mode->hdisplay > 1280)
    351   1.1  jmcneill 		lb_mode = WIN0_LB_MODE_RGB_1920X5;
    352   1.1  jmcneill 	else
    353   1.1  jmcneill 		lb_mode = WIN0_LB_MODE_RGB_1280X8;
    354   1.1  jmcneill 
    355   1.1  jmcneill 	val = __SHIFTIN(lb_mode, WIN0_LB_MODE) |
    356   1.1  jmcneill 	      __SHIFTIN(WIN0_DATA_FMT_ARGB888, WIN0_DATA_FMT) |
    357   1.1  jmcneill 	      WIN0_EN;
    358   1.1  jmcneill 	WR4(sc, VOP_WIN0_CTRL, val);
    359   1.1  jmcneill 
    360   1.1  jmcneill 	rk_vop_mode_do_set_base(crtc, old_fb, x, y, 0);
    361   1.1  jmcneill 
    362   1.4  jakllsch 	pol = DSP_DCLK_POL;
    363   1.4  jakllsch 	if ((adjusted_mode->flags & DRM_MODE_FLAG_PHSYNC) != 0)
    364   1.4  jakllsch 		pol |= DSP_HSYNC_POL;
    365   1.4  jakllsch 	if ((adjusted_mode->flags & DRM_MODE_FLAG_PVSYNC) != 0)
    366   1.4  jakllsch 		pol |= DSP_VSYNC_POL;
    367   1.4  jakllsch 
    368  1.11  riastrad 	drm_connector_list_iter_begin(crtc->dev, &conn_iter);
    369  1.11  riastrad 	drm_for_each_connector_iter(connector, &conn_iter) {
    370  1.11  riastrad 		if (connector->encoder == NULL)
    371   1.4  jakllsch 			continue;
    372   1.4  jakllsch 		if (connector->encoder->crtc == crtc) {
    373   1.4  jakllsch 			connector_type = connector->connector_type;
    374   1.4  jakllsch 			break;
    375   1.4  jakllsch 		}
    376   1.4  jakllsch 	}
    377  1.11  riastrad 	drm_connector_list_iter_end(&conn_iter);
    378   1.4  jakllsch 
    379   1.4  jakllsch 	switch (connector_type) {
    380   1.4  jakllsch 	case DRM_MODE_CONNECTOR_HDMIA:
    381   1.4  jakllsch 		sc->sc_conf->set_polarity(sc, VOP_EP_HDMI, pol);
    382   1.4  jakllsch 		break;
    383   1.4  jakllsch 	case DRM_MODE_CONNECTOR_eDP:
    384   1.4  jakllsch 		sc->sc_conf->set_polarity(sc, VOP_EP_EDP, pol);
    385   1.4  jakllsch 		break;
    386   1.4  jakllsch 	}
    387   1.4  jakllsch 
    388   1.4  jakllsch 	val = RD4(sc, VOP_SYS_CTRL);
    389   1.4  jakllsch 	val &= ~VOP_STANDBY_EN;
    390   1.4  jakllsch 	val &= ~(MIPI_OUT_EN|EDP_OUT_EN|HDMI_OUT_EN|RGB_OUT_EN);
    391   1.4  jakllsch 
    392   1.4  jakllsch 	switch (connector_type) {
    393   1.4  jakllsch 	case DRM_MODE_CONNECTOR_HDMIA:
    394   1.4  jakllsch 		val |= HDMI_OUT_EN;
    395   1.4  jakllsch 		break;
    396   1.4  jakllsch 	case DRM_MODE_CONNECTOR_eDP:
    397   1.4  jakllsch 		val |= EDP_OUT_EN;
    398   1.4  jakllsch 		break;
    399   1.4  jakllsch 	}
    400   1.4  jakllsch 	WR4(sc, VOP_SYS_CTRL, val);
    401   1.4  jakllsch 
    402   1.4  jakllsch 	val = RD4(sc, VOP_DSP_CTRL0);
    403   1.4  jakllsch 	val &= ~DSP_OUT_MODE;
    404   1.4  jakllsch 	val |= __SHIFTIN(sc->sc_conf->out_mode, DSP_OUT_MODE);
    405   1.4  jakllsch 	WR4(sc, VOP_DSP_CTRL0, val);
    406   1.4  jakllsch 
    407   1.4  jakllsch 	val = __SHIFTIN(hsync_len + hback_porch, DSP_HACT_ST_POST) |
    408   1.4  jakllsch 	      __SHIFTIN(hsync_len + hback_porch + hactive, DSP_HACT_END_POST);
    409   1.4  jakllsch 	WR4(sc, VOP_POST_DSP_HACT_INFO, val);
    410   1.4  jakllsch 
    411   1.4  jakllsch 	val = __SHIFTIN(hsync_len + hback_porch, DSP_HACT_ST) |
    412   1.4  jakllsch 	      __SHIFTIN(hsync_len + hback_porch + hactive, DSP_HACT_END);
    413   1.4  jakllsch 	WR4(sc, VOP_DSP_HACT_ST_END, val);
    414   1.4  jakllsch 
    415   1.4  jakllsch 	val = __SHIFTIN(hsync_len, DSP_HTOTAL) |
    416   1.4  jakllsch 	      __SHIFTIN(hsync_len + hback_porch + hactive + hfront_porch, DSP_HS_END);
    417   1.4  jakllsch 	WR4(sc, VOP_DSP_HTOTAL_HS_END, val);
    418   1.4  jakllsch 
    419   1.4  jakllsch 	val = __SHIFTIN(vsync_len + vback_porch, DSP_VACT_ST_POST) |
    420   1.4  jakllsch 	      __SHIFTIN(vsync_len + vback_porch + vactive, DSP_VACT_END_POST);
    421   1.4  jakllsch 	WR4(sc, VOP_POST_DSP_VACT_INFO, val);
    422   1.4  jakllsch 
    423   1.4  jakllsch 	val = __SHIFTIN(vsync_len + vback_porch, DSP_VACT_ST) |
    424   1.4  jakllsch 	      __SHIFTIN(vsync_len + vback_porch + vactive, DSP_VACT_END);
    425   1.4  jakllsch 	WR4(sc, VOP_DSP_VACT_ST_END, val);
    426   1.4  jakllsch 
    427   1.4  jakllsch 	val = __SHIFTIN(vsync_len, DSP_VTOTAL) |
    428   1.4  jakllsch 	      __SHIFTIN(vsync_len + vback_porch + vactive + vfront_porch, DSP_VS_END);
    429   1.4  jakllsch 	WR4(sc, VOP_DSP_VTOTAL_VS_END, val);
    430   1.4  jakllsch 
    431   1.1  jmcneill 	return 0;
    432   1.1  jmcneill }
    433   1.1  jmcneill 
    434   1.1  jmcneill static int
    435   1.1  jmcneill rk_vop_mode_set_base(struct drm_crtc *crtc, int x, int y,
    436   1.1  jmcneill     struct drm_framebuffer *old_fb)
    437   1.1  jmcneill {
    438   1.1  jmcneill 	struct rk_vop_crtc *mixer_crtc = to_rk_vop_crtc(crtc);
    439   1.1  jmcneill 	struct rk_vop_softc * const sc = mixer_crtc->sc;
    440   1.1  jmcneill 
    441   1.1  jmcneill 	rk_vop_mode_do_set_base(crtc, old_fb, x, y, 0);
    442   1.1  jmcneill 
    443   1.1  jmcneill 	/* Commit settings */
    444   1.1  jmcneill 	WR4(sc, VOP_REG_CFG_DONE, REG_LOAD_EN);
    445   1.1  jmcneill 
    446   1.1  jmcneill 	return 0;
    447   1.1  jmcneill }
    448   1.1  jmcneill 
    449   1.1  jmcneill static int
    450   1.1  jmcneill rk_vop_mode_set_base_atomic(struct drm_crtc *crtc, struct drm_framebuffer *fb,
    451   1.1  jmcneill     int x, int y, enum mode_set_atomic state)
    452   1.1  jmcneill {
    453   1.1  jmcneill 	struct rk_vop_crtc *mixer_crtc = to_rk_vop_crtc(crtc);
    454   1.1  jmcneill 	struct rk_vop_softc * const sc = mixer_crtc->sc;
    455   1.1  jmcneill 
    456   1.1  jmcneill 	rk_vop_mode_do_set_base(crtc, fb, x, y, 1);
    457   1.1  jmcneill 
    458   1.1  jmcneill 	/* Commit settings */
    459   1.1  jmcneill 	WR4(sc, VOP_REG_CFG_DONE, REG_LOAD_EN);
    460   1.1  jmcneill 
    461   1.1  jmcneill 	return 0;
    462   1.1  jmcneill }
    463   1.1  jmcneill 
    464   1.1  jmcneill static void
    465   1.1  jmcneill rk_vop_disable(struct drm_crtc *crtc)
    466   1.1  jmcneill {
    467   1.1  jmcneill }
    468   1.1  jmcneill 
    469   1.1  jmcneill static void
    470   1.1  jmcneill rk_vop_prepare(struct drm_crtc *crtc)
    471   1.1  jmcneill {
    472   1.1  jmcneill }
    473   1.1  jmcneill 
    474   1.1  jmcneill static void
    475   1.1  jmcneill rk_vop_commit(struct drm_crtc *crtc)
    476   1.1  jmcneill {
    477   1.1  jmcneill 	struct rk_vop_crtc *mixer_crtc = to_rk_vop_crtc(crtc);
    478   1.1  jmcneill 	struct rk_vop_softc * const sc = mixer_crtc->sc;
    479   1.1  jmcneill 
    480   1.1  jmcneill 	/* Commit settings */
    481   1.1  jmcneill 	WR4(sc, VOP_REG_CFG_DONE, REG_LOAD_EN);
    482   1.1  jmcneill }
    483   1.1  jmcneill 
    484   1.1  jmcneill static const struct drm_crtc_helper_funcs rk_vop_crtc_helper_funcs = {
    485   1.1  jmcneill 	.dpms = rk_vop_dpms,
    486   1.1  jmcneill 	.mode_fixup = rk_vop_mode_fixup,
    487   1.1  jmcneill 	.mode_set = rk_vop_mode_set,
    488   1.1  jmcneill 	.mode_set_base = rk_vop_mode_set_base,
    489   1.1  jmcneill 	.mode_set_base_atomic = rk_vop_mode_set_base_atomic,
    490   1.1  jmcneill 	.disable = rk_vop_disable,
    491   1.1  jmcneill 	.prepare = rk_vop_prepare,
    492   1.1  jmcneill 	.commit = rk_vop_commit,
    493   1.1  jmcneill };
    494   1.1  jmcneill 
    495   1.1  jmcneill static int
    496   1.1  jmcneill rk_vop_ep_activate(device_t dev, struct fdt_endpoint *ep, bool activate)
    497   1.1  jmcneill {
    498   1.1  jmcneill 	struct rk_vop_softc * const sc = device_private(dev);
    499   1.1  jmcneill 	struct drm_device *ddev;
    500   1.1  jmcneill 
    501   1.1  jmcneill 	if (!activate)
    502   1.1  jmcneill 		return EINVAL;
    503   1.1  jmcneill 
    504   1.1  jmcneill 	ddev = rk_drm_port_device(&sc->sc_ports);
    505   1.1  jmcneill 	if (ddev == NULL) {
    506   1.1  jmcneill 		DRM_ERROR("couldn't find DRM device\n");
    507   1.1  jmcneill 		return ENXIO;
    508   1.1  jmcneill 	}
    509   1.1  jmcneill 
    510   1.1  jmcneill 	if (sc->sc_crtc.sc == NULL) {
    511   1.1  jmcneill 		sc->sc_crtc.sc = sc;
    512   1.1  jmcneill 
    513   1.1  jmcneill 		drm_crtc_init(ddev, &sc->sc_crtc.base, &rk_vop_crtc_funcs);
    514   1.1  jmcneill 		drm_crtc_helper_add(&sc->sc_crtc.base, &rk_vop_crtc_helper_funcs);
    515   1.1  jmcneill 
    516   1.1  jmcneill 		aprint_debug_dev(dev, "using CRTC %d for %s\n",
    517   1.1  jmcneill 		    drm_crtc_index(&sc->sc_crtc.base), sc->sc_conf->descr);
    518   1.1  jmcneill 	}
    519   1.1  jmcneill 
    520   1.1  jmcneill 	const u_int ep_index = fdt_endpoint_index(ep);
    521   1.4  jakllsch 	if (ep_index >= VOP_NEP) {
    522   1.3       mrg 		DRM_ERROR("endpoint index %d out of range\n", ep_index);
    523   1.3       mrg 		return ENXIO;
    524   1.1  jmcneill 	}
    525   1.1  jmcneill 
    526   1.1  jmcneill 	return fdt_endpoint_activate(ep, activate);
    527   1.1  jmcneill }
    528   1.1  jmcneill 
    529   1.1  jmcneill static void *
    530   1.1  jmcneill rk_vop_ep_get_data(device_t dev, struct fdt_endpoint *ep)
    531   1.1  jmcneill {
    532   1.1  jmcneill 	struct rk_vop_softc * const sc = device_private(dev);
    533   1.1  jmcneill 
    534   1.4  jakllsch 	return &sc->sc_crtc.base;
    535   1.1  jmcneill }
    536   1.1  jmcneill 
    537   1.1  jmcneill static int
    538   1.1  jmcneill rk_vop_match(device_t parent, cfdata_t cf, void *aux)
    539   1.1  jmcneill {
    540   1.1  jmcneill 	struct fdt_attach_args * const faa = aux;
    541   1.1  jmcneill 
    542  1.10   thorpej 	return of_compatible_match(faa->faa_phandle, compat_data);
    543   1.1  jmcneill }
    544   1.1  jmcneill 
    545   1.1  jmcneill static void
    546   1.1  jmcneill rk_vop_attach(device_t parent, device_t self, void *aux)
    547   1.1  jmcneill {
    548   1.1  jmcneill 	struct rk_vop_softc * const sc = device_private(self);
    549   1.1  jmcneill 	struct fdt_attach_args * const faa = aux;
    550   1.1  jmcneill 	const int phandle = faa->faa_phandle;
    551   1.1  jmcneill 	const char * const reset_names[] = { "axi", "ahb", "dclk" };
    552   1.1  jmcneill 	const char * const clock_names[] = { "aclk_vop", "hclk_vop" };
    553   1.1  jmcneill 	struct fdtbus_reset *rst;
    554   1.1  jmcneill 	bus_addr_t addr;
    555   1.1  jmcneill 	bus_size_t size;
    556   1.1  jmcneill 	u_int n;
    557   1.1  jmcneill 
    558   1.1  jmcneill 	if (fdtbus_get_reg(phandle, 0, &addr, &size) != 0) {
    559   1.1  jmcneill 		aprint_error(": couldn't get registers\n");
    560   1.1  jmcneill 		return;
    561   1.1  jmcneill 	}
    562   1.1  jmcneill 
    563   1.1  jmcneill 	fdtbus_clock_assign(phandle);
    564   1.1  jmcneill 
    565   1.1  jmcneill 	for (n = 0; n < __arraycount(reset_names); n++) {
    566   1.1  jmcneill 		rst = fdtbus_reset_get(phandle, reset_names[n]);
    567   1.1  jmcneill 		if (rst == NULL || fdtbus_reset_deassert(rst) != 0) {
    568   1.1  jmcneill 			aprint_error(": couldn't de-assert reset %s\n", reset_names[n]);
    569   1.1  jmcneill 			return;
    570   1.1  jmcneill 		}
    571   1.1  jmcneill 	}
    572   1.1  jmcneill 	for (n = 0; n < __arraycount(clock_names); n++) {
    573   1.1  jmcneill 		if (fdtbus_clock_enable(phandle, clock_names[n], true) != 0) {
    574   1.1  jmcneill 			aprint_error(": couldn't enable clock %s\n", clock_names[n]);
    575   1.1  jmcneill 			return;
    576   1.1  jmcneill 		}
    577   1.1  jmcneill 	}
    578   1.1  jmcneill 	sc->sc_dclk = fdtbus_clock_get(phandle, "dclk_vop");
    579   1.1  jmcneill 	if (sc->sc_dclk == NULL || clk_enable(sc->sc_dclk) != 0) {
    580   1.1  jmcneill 		aprint_error(": couldn't enable clock %s\n", "dclk_vop");
    581   1.1  jmcneill 		return;
    582   1.1  jmcneill 	}
    583   1.1  jmcneill 
    584   1.1  jmcneill 	sc->sc_dev = self;
    585   1.1  jmcneill 	sc->sc_bst = faa->faa_bst;
    586   1.1  jmcneill 	if (bus_space_map(sc->sc_bst, addr, size, 0, &sc->sc_bsh) != 0) {
    587   1.1  jmcneill 		aprint_error(": couldn't map registers\n");
    588   1.1  jmcneill 		return;
    589   1.1  jmcneill 	}
    590   1.1  jmcneill 	sc->sc_phandle = faa->faa_phandle;
    591  1.10   thorpej 	sc->sc_conf = of_compatible_lookup(phandle, compat_data)->data;
    592   1.1  jmcneill 
    593   1.1  jmcneill 	aprint_naive("\n");
    594   1.1  jmcneill 	aprint_normal(": %s\n", sc->sc_conf->descr);
    595   1.1  jmcneill 
    596   1.1  jmcneill 	if (sc->sc_conf->init != NULL)
    597   1.1  jmcneill 		sc->sc_conf->init(sc);
    598   1.1  jmcneill 
    599   1.1  jmcneill 	sc->sc_ports.dp_ep_activate = rk_vop_ep_activate;
    600   1.1  jmcneill 	sc->sc_ports.dp_ep_get_data = rk_vop_ep_get_data;
    601   1.4  jakllsch 	fdt_ports_register(&sc->sc_ports, self, phandle, EP_DRM_CRTC);
    602   1.1  jmcneill 
    603   1.1  jmcneill 	const int port_phandle = of_find_firstchild_byname(phandle, "port");
    604   1.1  jmcneill 	if (port_phandle > 0)
    605   1.1  jmcneill 		rk_drm_register_port(port_phandle, &sc->sc_ports);
    606   1.1  jmcneill }
    607   1.1  jmcneill 
    608   1.1  jmcneill CFATTACH_DECL_NEW(rk_vop, sizeof(struct rk_vop_softc),
    609   1.1  jmcneill 	rk_vop_match, rk_vop_attach, NULL, NULL);
    610