1 // SPDX-License-Identifier: GPL-2.0-or-later
5 * Based on sun4i_backend.c, which is:
6 * Copyright (C) 2015 Free Electrons
7 * Copyright (C) 2015 NextThing Co
10 #include <linux/component.h>
11 #include <linux/dma-mapping.h>
12 #include <linux/module.h>
13 #include <linux/of_device.h>
14 #include <linux/of_graph.h>
15 #include <linux/reset.h>
17 #include <drm/drm_atomic_helper.h>
18 #include <drm/drm_crtc.h>
19 #include <drm/drm_fb_cma_helper.h>
20 #include <drm/drm_framebuffer.h>
21 #include <drm/drm_gem_cma_helper.h>
22 #include <drm/drm_plane_helper.h>
23 #include <drm/drm_probe_helper.h>
25 #include "sun4i_drv.h"
26 #include "sun8i_mixer.h"
27 #include "sun8i_ui_layer.h"
28 #include "sun8i_vi_layer.h"
29 #include "sunxi_engine.h"
36 static const struct de2_fmt_info de2_formats[] = {
38 .drm_fmt = DRM_FORMAT_ARGB8888,
39 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB8888,
42 .drm_fmt = DRM_FORMAT_ABGR8888,
43 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR8888,
46 .drm_fmt = DRM_FORMAT_RGBA8888,
47 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA8888,
50 .drm_fmt = DRM_FORMAT_BGRA8888,
51 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA8888,
54 .drm_fmt = DRM_FORMAT_XRGB8888,
55 .de2_fmt = SUN8I_MIXER_FBFMT_XRGB8888,
58 .drm_fmt = DRM_FORMAT_XBGR8888,
59 .de2_fmt = SUN8I_MIXER_FBFMT_XBGR8888,
62 .drm_fmt = DRM_FORMAT_RGBX8888,
63 .de2_fmt = SUN8I_MIXER_FBFMT_RGBX8888,
66 .drm_fmt = DRM_FORMAT_BGRX8888,
67 .de2_fmt = SUN8I_MIXER_FBFMT_BGRX8888,
70 .drm_fmt = DRM_FORMAT_RGB888,
71 .de2_fmt = SUN8I_MIXER_FBFMT_RGB888,
74 .drm_fmt = DRM_FORMAT_BGR888,
75 .de2_fmt = SUN8I_MIXER_FBFMT_BGR888,
78 .drm_fmt = DRM_FORMAT_RGB565,
79 .de2_fmt = SUN8I_MIXER_FBFMT_RGB565,
82 .drm_fmt = DRM_FORMAT_BGR565,
83 .de2_fmt = SUN8I_MIXER_FBFMT_BGR565,
86 .drm_fmt = DRM_FORMAT_ARGB4444,
87 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB4444,
90 /* for DE2 VI layer which ignores alpha */
91 .drm_fmt = DRM_FORMAT_XRGB4444,
92 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB4444,
95 .drm_fmt = DRM_FORMAT_ABGR4444,
96 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR4444,
99 /* for DE2 VI layer which ignores alpha */
100 .drm_fmt = DRM_FORMAT_XBGR4444,
101 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR4444,
104 .drm_fmt = DRM_FORMAT_RGBA4444,
105 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA4444,
108 /* for DE2 VI layer which ignores alpha */
109 .drm_fmt = DRM_FORMAT_RGBX4444,
110 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA4444,
113 .drm_fmt = DRM_FORMAT_BGRA4444,
114 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA4444,
117 /* for DE2 VI layer which ignores alpha */
118 .drm_fmt = DRM_FORMAT_BGRX4444,
119 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA4444,
122 .drm_fmt = DRM_FORMAT_ARGB1555,
123 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB1555,
126 /* for DE2 VI layer which ignores alpha */
127 .drm_fmt = DRM_FORMAT_XRGB1555,
128 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB1555,
131 .drm_fmt = DRM_FORMAT_ABGR1555,
132 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR1555,
135 /* for DE2 VI layer which ignores alpha */
136 .drm_fmt = DRM_FORMAT_XBGR1555,
137 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR1555,
140 .drm_fmt = DRM_FORMAT_RGBA5551,
141 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA5551,
144 /* for DE2 VI layer which ignores alpha */
145 .drm_fmt = DRM_FORMAT_RGBX5551,
146 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA5551,
149 .drm_fmt = DRM_FORMAT_BGRA5551,
150 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA5551,
153 /* for DE2 VI layer which ignores alpha */
154 .drm_fmt = DRM_FORMAT_BGRX5551,
155 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA5551,
158 .drm_fmt = DRM_FORMAT_ARGB2101010,
159 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB2101010,
162 .drm_fmt = DRM_FORMAT_ABGR2101010,
163 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR2101010,
166 .drm_fmt = DRM_FORMAT_RGBA1010102,
167 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA1010102,
170 .drm_fmt = DRM_FORMAT_BGRA1010102,
171 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA1010102,
174 .drm_fmt = DRM_FORMAT_UYVY,
175 .de2_fmt = SUN8I_MIXER_FBFMT_UYVY,
178 .drm_fmt = DRM_FORMAT_VYUY,
179 .de2_fmt = SUN8I_MIXER_FBFMT_VYUY,
182 .drm_fmt = DRM_FORMAT_YUYV,
183 .de2_fmt = SUN8I_MIXER_FBFMT_YUYV,
186 .drm_fmt = DRM_FORMAT_YVYU,
187 .de2_fmt = SUN8I_MIXER_FBFMT_YVYU,
190 .drm_fmt = DRM_FORMAT_NV16,
191 .de2_fmt = SUN8I_MIXER_FBFMT_NV16,
194 .drm_fmt = DRM_FORMAT_NV61,
195 .de2_fmt = SUN8I_MIXER_FBFMT_NV61,
198 .drm_fmt = DRM_FORMAT_NV12,
199 .de2_fmt = SUN8I_MIXER_FBFMT_NV12,
202 .drm_fmt = DRM_FORMAT_NV21,
203 .de2_fmt = SUN8I_MIXER_FBFMT_NV21,
206 .drm_fmt = DRM_FORMAT_YUV422,
207 .de2_fmt = SUN8I_MIXER_FBFMT_YUV422,
210 .drm_fmt = DRM_FORMAT_YUV420,
211 .de2_fmt = SUN8I_MIXER_FBFMT_YUV420,
214 .drm_fmt = DRM_FORMAT_YUV411,
215 .de2_fmt = SUN8I_MIXER_FBFMT_YUV411,
218 .drm_fmt = DRM_FORMAT_YVU422,
219 .de2_fmt = SUN8I_MIXER_FBFMT_YUV422,
222 .drm_fmt = DRM_FORMAT_YVU420,
223 .de2_fmt = SUN8I_MIXER_FBFMT_YUV420,
226 .drm_fmt = DRM_FORMAT_YVU411,
227 .de2_fmt = SUN8I_MIXER_FBFMT_YUV411,
230 .drm_fmt = DRM_FORMAT_P010,
231 .de2_fmt = SUN8I_MIXER_FBFMT_P010_YUV,
234 .drm_fmt = DRM_FORMAT_P210,
235 .de2_fmt = SUN8I_MIXER_FBFMT_P210_YUV,
239 int sun8i_mixer_drm_format_to_hw(u32 format, u32 *hw_format)
243 for (i = 0; i < ARRAY_SIZE(de2_formats); ++i)
244 if (de2_formats[i].drm_fmt == format) {
245 *hw_format = de2_formats[i].de2_fmt;
252 static void sun8i_mixer_commit(struct sunxi_engine *engine)
254 DRM_DEBUG_DRIVER("Committing changes\n");
256 regmap_write(engine->regs, SUN8I_MIXER_GLOBAL_DBUFF,
257 SUN8I_MIXER_GLOBAL_DBUFF_ENABLE);
260 static struct drm_plane **sun8i_layers_init(struct drm_device *drm,
261 struct sunxi_engine *engine)
263 struct drm_plane **planes;
264 struct sun8i_mixer *mixer = engine_to_sun8i_mixer(engine);
267 planes = devm_kcalloc(drm->dev,
268 mixer->cfg->vi_num + mixer->cfg->ui_num + 1,
269 sizeof(*planes), GFP_KERNEL);
271 return ERR_PTR(-ENOMEM);
273 for (i = 0; i < mixer->cfg->vi_num; i++) {
274 struct sun8i_vi_layer *layer;
276 layer = sun8i_vi_layer_init_one(drm, mixer, i);
279 "Couldn't initialize overlay plane\n");
280 return ERR_CAST(layer);
283 planes[i] = &layer->plane;
286 for (i = 0; i < mixer->cfg->ui_num; i++) {
287 struct sun8i_ui_layer *layer;
289 layer = sun8i_ui_layer_init_one(drm, mixer, i);
291 dev_err(drm->dev, "Couldn't initialize %s plane\n",
292 i ? "overlay" : "primary");
293 return ERR_CAST(layer);
296 planes[mixer->cfg->vi_num + i] = &layer->plane;
302 static void sun8i_mixer_mode_set(struct sunxi_engine *engine,
303 const struct drm_display_mode *mode)
305 struct sun8i_mixer *mixer = engine_to_sun8i_mixer(engine);
306 u32 bld_base, size, val;
309 bld_base = sun8i_blender_base(mixer);
310 interlaced = !!(mode->flags & DRM_MODE_FLAG_INTERLACE);
311 size = SUN8I_MIXER_SIZE(mode->hdisplay, mode->vdisplay);
313 DRM_DEBUG_DRIVER("Updating global size W: %u H: %u\n",
314 mode->hdisplay, mode->vdisplay);
316 regmap_write(engine->regs, SUN8I_MIXER_GLOBAL_SIZE, size);
317 regmap_write(engine->regs, SUN8I_MIXER_BLEND_OUTSIZE(bld_base), size);
320 val = SUN8I_MIXER_BLEND_OUTCTL_INTERLACED;
324 regmap_update_bits(engine->regs, SUN8I_MIXER_BLEND_OUTCTL(bld_base),
325 SUN8I_MIXER_BLEND_OUTCTL_INTERLACED, val);
327 DRM_DEBUG_DRIVER("Switching display mixer interlaced mode %s\n",
328 interlaced ? "on" : "off");
331 static const struct sunxi_engine_ops sun8i_engine_ops = {
332 .commit = sun8i_mixer_commit,
333 .layers_init = sun8i_layers_init,
334 .mode_set = sun8i_mixer_mode_set,
337 static const struct regmap_config sun8i_mixer_regmap_config = {
341 .max_register = 0xffffc, /* guessed */
344 static int sun8i_mixer_of_get_id(struct device_node *node)
346 struct device_node *ep, *remote;
347 struct of_endpoint of_ep;
349 /* Output port is 1, and we want the first endpoint. */
350 ep = of_graph_get_endpoint_by_regs(node, 1, -1);
354 remote = of_graph_get_remote_endpoint(ep);
359 of_graph_parse_endpoint(remote, &of_ep);
364 static int sun8i_mixer_bind(struct device *dev, struct device *master,
367 struct platform_device *pdev = to_platform_device(dev);
368 struct drm_device *drm = data;
369 struct sun4i_drv *drv = drm->dev_private;
370 struct sun8i_mixer *mixer;
377 * The mixer uses single 32-bit register to store memory
378 * addresses, so that it cannot deal with 64-bit memory
380 * Restrict the DMA mask so that the mixer won't be
381 * allocated some memory that is too high.
383 ret = dma_set_mask(dev, DMA_BIT_MASK(32));
385 dev_err(dev, "Cannot do 32-bit DMA.\n");
389 mixer = devm_kzalloc(dev, sizeof(*mixer), GFP_KERNEL);
392 dev_set_drvdata(dev, mixer);
393 mixer->engine.ops = &sun8i_engine_ops;
394 mixer->engine.node = dev->of_node;
396 if (of_find_property(dev->of_node, "iommus", NULL)) {
398 * This assume we have the same DMA constraints for
399 * all our the mixers in our pipeline. This sounds
400 * bad, but it has always been the case for us, and
401 * DRM doesn't do per-device allocation either, so we
402 * would need to fix DRM first...
404 ret = of_dma_configure(drm->dev, dev->of_node, true);
410 * While this function can fail, we shouldn't do anything
411 * if this happens. Some early DE2 DT entries don't provide
412 * mixer id but work nevertheless because matching between
413 * TCON and mixer is done by comparing node pointers (old
414 * way) instead comparing ids. If this function fails and
415 * id is needed, it will fail during id matching anyway.
417 mixer->engine.id = sun8i_mixer_of_get_id(dev->of_node);
419 mixer->cfg = of_device_get_match_data(dev);
423 regs = devm_platform_ioremap_resource(pdev, 0);
425 return PTR_ERR(regs);
427 mixer->engine.regs = devm_regmap_init_mmio(dev, regs,
428 &sun8i_mixer_regmap_config);
429 if (IS_ERR(mixer->engine.regs)) {
430 dev_err(dev, "Couldn't create the mixer regmap\n");
431 return PTR_ERR(mixer->engine.regs);
434 mixer->reset = devm_reset_control_get(dev, NULL);
435 if (IS_ERR(mixer->reset)) {
436 dev_err(dev, "Couldn't get our reset line\n");
437 return PTR_ERR(mixer->reset);
440 ret = reset_control_deassert(mixer->reset);
442 dev_err(dev, "Couldn't deassert our reset line\n");
446 mixer->bus_clk = devm_clk_get(dev, "bus");
447 if (IS_ERR(mixer->bus_clk)) {
448 dev_err(dev, "Couldn't get the mixer bus clock\n");
449 ret = PTR_ERR(mixer->bus_clk);
450 goto err_assert_reset;
452 clk_prepare_enable(mixer->bus_clk);
454 mixer->mod_clk = devm_clk_get(dev, "mod");
455 if (IS_ERR(mixer->mod_clk)) {
456 dev_err(dev, "Couldn't get the mixer module clock\n");
457 ret = PTR_ERR(mixer->mod_clk);
458 goto err_disable_bus_clk;
462 * It seems that we need to enforce that rate for whatever
463 * reason for the mixer to be functional. Make sure it's the
466 if (mixer->cfg->mod_rate)
467 clk_set_rate(mixer->mod_clk, mixer->cfg->mod_rate);
469 clk_prepare_enable(mixer->mod_clk);
471 list_add_tail(&mixer->engine.list, &drv->engine_list);
473 base = sun8i_blender_base(mixer);
475 /* Reset registers and disable unused sub-engines */
476 if (mixer->cfg->is_de3) {
477 for (i = 0; i < DE3_MIXER_UNIT_SIZE; i += 4)
478 regmap_write(mixer->engine.regs, i, 0);
480 regmap_write(mixer->engine.regs, SUN50I_MIXER_FCE_EN, 0);
481 regmap_write(mixer->engine.regs, SUN50I_MIXER_PEAK_EN, 0);
482 regmap_write(mixer->engine.regs, SUN50I_MIXER_LCTI_EN, 0);
483 regmap_write(mixer->engine.regs, SUN50I_MIXER_BLS_EN, 0);
484 regmap_write(mixer->engine.regs, SUN50I_MIXER_FCC_EN, 0);
485 regmap_write(mixer->engine.regs, SUN50I_MIXER_DNS_EN, 0);
486 regmap_write(mixer->engine.regs, SUN50I_MIXER_DRC_EN, 0);
487 regmap_write(mixer->engine.regs, SUN50I_MIXER_FMT_EN, 0);
488 regmap_write(mixer->engine.regs, SUN50I_MIXER_CDC0_EN, 0);
489 regmap_write(mixer->engine.regs, SUN50I_MIXER_CDC1_EN, 0);
491 for (i = 0; i < DE2_MIXER_UNIT_SIZE; i += 4)
492 regmap_write(mixer->engine.regs, i, 0);
494 regmap_write(mixer->engine.regs, SUN8I_MIXER_FCE_EN, 0);
495 regmap_write(mixer->engine.regs, SUN8I_MIXER_BWS_EN, 0);
496 regmap_write(mixer->engine.regs, SUN8I_MIXER_LTI_EN, 0);
497 regmap_write(mixer->engine.regs, SUN8I_MIXER_PEAK_EN, 0);
498 regmap_write(mixer->engine.regs, SUN8I_MIXER_ASE_EN, 0);
499 regmap_write(mixer->engine.regs, SUN8I_MIXER_FCC_EN, 0);
500 regmap_write(mixer->engine.regs, SUN8I_MIXER_DCSC_EN, 0);
503 /* Enable the mixer */
504 regmap_write(mixer->engine.regs, SUN8I_MIXER_GLOBAL_CTL,
505 SUN8I_MIXER_GLOBAL_CTL_RT_EN);
507 /* Set background color to black */
508 regmap_write(mixer->engine.regs, SUN8I_MIXER_BLEND_BKCOLOR(base),
509 SUN8I_MIXER_BLEND_COLOR_BLACK);
512 * Set fill color of bottom plane to black. Generally not needed
513 * except when VI plane is at bottom (zpos = 0) and enabled.
515 regmap_write(mixer->engine.regs, SUN8I_MIXER_BLEND_PIPE_CTL(base),
516 SUN8I_MIXER_BLEND_PIPE_CTL_FC_EN(0));
517 regmap_write(mixer->engine.regs, SUN8I_MIXER_BLEND_ATTR_FCOLOR(base, 0),
518 SUN8I_MIXER_BLEND_COLOR_BLACK);
520 plane_cnt = mixer->cfg->vi_num + mixer->cfg->ui_num;
521 for (i = 0; i < plane_cnt; i++)
522 regmap_write(mixer->engine.regs,
523 SUN8I_MIXER_BLEND_MODE(base, i),
524 SUN8I_MIXER_BLEND_MODE_DEF);
526 regmap_update_bits(mixer->engine.regs, SUN8I_MIXER_BLEND_PIPE_CTL(base),
527 SUN8I_MIXER_BLEND_PIPE_CTL_EN_MSK, 0);
532 clk_disable_unprepare(mixer->bus_clk);
534 reset_control_assert(mixer->reset);
538 static void sun8i_mixer_unbind(struct device *dev, struct device *master,
541 struct sun8i_mixer *mixer = dev_get_drvdata(dev);
543 list_del(&mixer->engine.list);
545 clk_disable_unprepare(mixer->mod_clk);
546 clk_disable_unprepare(mixer->bus_clk);
547 reset_control_assert(mixer->reset);
550 static const struct component_ops sun8i_mixer_ops = {
551 .bind = sun8i_mixer_bind,
552 .unbind = sun8i_mixer_unbind,
555 static int sun8i_mixer_probe(struct platform_device *pdev)
557 return component_add(&pdev->dev, &sun8i_mixer_ops);
560 static int sun8i_mixer_remove(struct platform_device *pdev)
562 component_del(&pdev->dev, &sun8i_mixer_ops);
567 static const struct sun8i_mixer_cfg sun8i_a83t_mixer0_cfg = {
568 .ccsc = CCSC_MIXER0_LAYOUT,
570 .scanline_yuv = 2048,
575 static const struct sun8i_mixer_cfg sun8i_a83t_mixer1_cfg = {
576 .ccsc = CCSC_MIXER1_LAYOUT,
578 .scanline_yuv = 2048,
583 static const struct sun8i_mixer_cfg sun8i_h3_mixer0_cfg = {
584 .ccsc = CCSC_MIXER0_LAYOUT,
585 .mod_rate = 432000000,
587 .scanline_yuv = 2048,
592 static const struct sun8i_mixer_cfg sun8i_r40_mixer0_cfg = {
593 .ccsc = CCSC_MIXER0_LAYOUT,
594 .mod_rate = 297000000,
596 .scanline_yuv = 2048,
601 static const struct sun8i_mixer_cfg sun8i_r40_mixer1_cfg = {
602 .ccsc = CCSC_MIXER1_LAYOUT,
603 .mod_rate = 297000000,
605 .scanline_yuv = 2048,
610 static const struct sun8i_mixer_cfg sun8i_v3s_mixer_cfg = {
614 .scanline_yuv = 2048,
615 .ccsc = CCSC_MIXER0_LAYOUT,
616 .mod_rate = 150000000,
619 static const struct sun8i_mixer_cfg sun20i_d1_mixer0_cfg = {
620 .ccsc = CCSC_D1_MIXER0_LAYOUT,
621 .mod_rate = 297000000,
623 .scanline_yuv = 2048,
628 static const struct sun8i_mixer_cfg sun20i_d1_mixer1_cfg = {
629 .ccsc = CCSC_MIXER1_LAYOUT,
630 .mod_rate = 297000000,
632 .scanline_yuv = 1024,
637 static const struct sun8i_mixer_cfg sun50i_a64_mixer0_cfg = {
638 .ccsc = CCSC_MIXER0_LAYOUT,
639 .mod_rate = 297000000,
641 .scanline_yuv = 4096,
646 static const struct sun8i_mixer_cfg sun50i_a64_mixer1_cfg = {
647 .ccsc = CCSC_MIXER1_LAYOUT,
648 .mod_rate = 297000000,
650 .scanline_yuv = 2048,
655 static const struct sun8i_mixer_cfg sun50i_h6_mixer0_cfg = {
656 .ccsc = CCSC_MIXER0_LAYOUT,
658 .mod_rate = 600000000,
660 .scanline_yuv = 4096,
665 static const struct of_device_id sun8i_mixer_of_table[] = {
667 .compatible = "allwinner,sun8i-a83t-de2-mixer-0",
668 .data = &sun8i_a83t_mixer0_cfg,
671 .compatible = "allwinner,sun8i-a83t-de2-mixer-1",
672 .data = &sun8i_a83t_mixer1_cfg,
675 .compatible = "allwinner,sun8i-h3-de2-mixer-0",
676 .data = &sun8i_h3_mixer0_cfg,
679 .compatible = "allwinner,sun8i-r40-de2-mixer-0",
680 .data = &sun8i_r40_mixer0_cfg,
683 .compatible = "allwinner,sun8i-r40-de2-mixer-1",
684 .data = &sun8i_r40_mixer1_cfg,
687 .compatible = "allwinner,sun8i-v3s-de2-mixer",
688 .data = &sun8i_v3s_mixer_cfg,
691 .compatible = "allwinner,sun20i-d1-de2-mixer-0",
692 .data = &sun20i_d1_mixer0_cfg,
695 .compatible = "allwinner,sun20i-d1-de2-mixer-1",
696 .data = &sun20i_d1_mixer1_cfg,
699 .compatible = "allwinner,sun50i-a64-de2-mixer-0",
700 .data = &sun50i_a64_mixer0_cfg,
703 .compatible = "allwinner,sun50i-a64-de2-mixer-1",
704 .data = &sun50i_a64_mixer1_cfg,
707 .compatible = "allwinner,sun50i-h6-de3-mixer-0",
708 .data = &sun50i_h6_mixer0_cfg,
712 MODULE_DEVICE_TABLE(of, sun8i_mixer_of_table);
714 static struct platform_driver sun8i_mixer_platform_driver = {
715 .probe = sun8i_mixer_probe,
716 .remove = sun8i_mixer_remove,
718 .name = "sun8i-mixer",
719 .of_match_table = sun8i_mixer_of_table,
722 module_platform_driver(sun8i_mixer_platform_driver);
725 MODULE_DESCRIPTION("Allwinner DE2 Mixer driver");
726 MODULE_LICENSE("GPL");