rk_vop.c revision 1.12 1 1.12 riastrad /* $NetBSD: rk_vop.c,v 1.12 2021/12/19 11:01:10 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.12 riastrad __KERNEL_RCSID(0, "$NetBSD: rk_vop.c,v 1.12 2021/12/19 11:01:10 riastradh Exp $");
31 1.1 jmcneill
32 1.1 jmcneill #include <sys/param.h>
33 1.1 jmcneill #include <sys/bus.h>
34 1.12 riastrad #include <sys/conf.h>
35 1.1 jmcneill #include <sys/device.h>
36 1.1 jmcneill #include <sys/intr.h>
37 1.1 jmcneill #include <sys/kernel.h>
38 1.1 jmcneill #include <sys/sysctl.h>
39 1.12 riastrad #include <sys/systm.h>
40 1.12 riastrad
41 1.12 riastrad #include <dev/fdt/fdt_port.h>
42 1.12 riastrad #include <dev/fdt/fdtvar.h>
43 1.12 riastrad
44 1.12 riastrad #include <arm/rockchip/rk_drm.h>
45 1.1 jmcneill
46 1.1 jmcneill #include <drm/drm_crtc.h>
47 1.1 jmcneill #include <drm/drm_crtc_helper.h>
48 1.12 riastrad #include <drm/drm_drv.h>
49 1.11 riastrad #include <drm/drm_fourcc.h>
50 1.1 jmcneill #include <drm/drm_plane_helper.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