1
2
3
4
5
6
7
8
9
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>
16
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_gem_cma_helper.h>
21#include <drm/drm_plane_helper.h>
22#include <drm/drm_probe_helper.h>
23
24#include "sun4i_drv.h"
25#include "sun8i_mixer.h"
26#include "sun8i_ui_layer.h"
27#include "sun8i_vi_layer.h"
28#include "sunxi_engine.h"
29
30struct de2_fmt_info {
31 u32 drm_fmt;
32 u32 de2_fmt;
33};
34
35static const struct de2_fmt_info de2_formats[] = {
36 {
37 .drm_fmt = DRM_FORMAT_ARGB8888,
38 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB8888,
39 },
40 {
41 .drm_fmt = DRM_FORMAT_ABGR8888,
42 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR8888,
43 },
44 {
45 .drm_fmt = DRM_FORMAT_RGBA8888,
46 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA8888,
47 },
48 {
49 .drm_fmt = DRM_FORMAT_BGRA8888,
50 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA8888,
51 },
52 {
53 .drm_fmt = DRM_FORMAT_XRGB8888,
54 .de2_fmt = SUN8I_MIXER_FBFMT_XRGB8888,
55 },
56 {
57 .drm_fmt = DRM_FORMAT_XBGR8888,
58 .de2_fmt = SUN8I_MIXER_FBFMT_XBGR8888,
59 },
60 {
61 .drm_fmt = DRM_FORMAT_RGBX8888,
62 .de2_fmt = SUN8I_MIXER_FBFMT_RGBX8888,
63 },
64 {
65 .drm_fmt = DRM_FORMAT_BGRX8888,
66 .de2_fmt = SUN8I_MIXER_FBFMT_BGRX8888,
67 },
68 {
69 .drm_fmt = DRM_FORMAT_RGB888,
70 .de2_fmt = SUN8I_MIXER_FBFMT_RGB888,
71 },
72 {
73 .drm_fmt = DRM_FORMAT_BGR888,
74 .de2_fmt = SUN8I_MIXER_FBFMT_BGR888,
75 },
76 {
77 .drm_fmt = DRM_FORMAT_RGB565,
78 .de2_fmt = SUN8I_MIXER_FBFMT_RGB565,
79 },
80 {
81 .drm_fmt = DRM_FORMAT_BGR565,
82 .de2_fmt = SUN8I_MIXER_FBFMT_BGR565,
83 },
84 {
85 .drm_fmt = DRM_FORMAT_ARGB4444,
86 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB4444,
87 },
88 {
89
90 .drm_fmt = DRM_FORMAT_XRGB4444,
91 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB4444,
92 },
93 {
94 .drm_fmt = DRM_FORMAT_ABGR4444,
95 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR4444,
96 },
97 {
98
99 .drm_fmt = DRM_FORMAT_XBGR4444,
100 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR4444,
101 },
102 {
103 .drm_fmt = DRM_FORMAT_RGBA4444,
104 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA4444,
105 },
106 {
107
108 .drm_fmt = DRM_FORMAT_RGBX4444,
109 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA4444,
110 },
111 {
112 .drm_fmt = DRM_FORMAT_BGRA4444,
113 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA4444,
114 },
115 {
116
117 .drm_fmt = DRM_FORMAT_BGRX4444,
118 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA4444,
119 },
120 {
121 .drm_fmt = DRM_FORMAT_ARGB1555,
122 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB1555,
123 },
124 {
125
126 .drm_fmt = DRM_FORMAT_XRGB1555,
127 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB1555,
128 },
129 {
130 .drm_fmt = DRM_FORMAT_ABGR1555,
131 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR1555,
132 },
133 {
134
135 .drm_fmt = DRM_FORMAT_XBGR1555,
136 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR1555,
137 },
138 {
139 .drm_fmt = DRM_FORMAT_RGBA5551,
140 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA5551,
141 },
142 {
143
144 .drm_fmt = DRM_FORMAT_RGBX5551,
145 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA5551,
146 },
147 {
148 .drm_fmt = DRM_FORMAT_BGRA5551,
149 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA5551,
150 },
151 {
152
153 .drm_fmt = DRM_FORMAT_BGRX5551,
154 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA5551,
155 },
156 {
157 .drm_fmt = DRM_FORMAT_ARGB2101010,
158 .de2_fmt = SUN8I_MIXER_FBFMT_ARGB2101010,
159 },
160 {
161 .drm_fmt = DRM_FORMAT_ABGR2101010,
162 .de2_fmt = SUN8I_MIXER_FBFMT_ABGR2101010,
163 },
164 {
165 .drm_fmt = DRM_FORMAT_RGBA1010102,
166 .de2_fmt = SUN8I_MIXER_FBFMT_RGBA1010102,
167 },
168 {
169 .drm_fmt = DRM_FORMAT_BGRA1010102,
170 .de2_fmt = SUN8I_MIXER_FBFMT_BGRA1010102,
171 },
172 {
173 .drm_fmt = DRM_FORMAT_UYVY,
174 .de2_fmt = SUN8I_MIXER_FBFMT_UYVY,
175 },
176 {
177 .drm_fmt = DRM_FORMAT_VYUY,
178 .de2_fmt = SUN8I_MIXER_FBFMT_VYUY,
179 },
180 {
181 .drm_fmt = DRM_FORMAT_YUYV,
182 .de2_fmt = SUN8I_MIXER_FBFMT_YUYV,
183 },
184 {
185 .drm_fmt = DRM_FORMAT_YVYU,
186 .de2_fmt = SUN8I_MIXER_FBFMT_YVYU,
187 },
188 {
189 .drm_fmt = DRM_FORMAT_NV16,
190 .de2_fmt = SUN8I_MIXER_FBFMT_NV16,
191 },
192 {
193 .drm_fmt = DRM_FORMAT_NV61,
194 .de2_fmt = SUN8I_MIXER_FBFMT_NV61,
195 },
196 {
197 .drm_fmt = DRM_FORMAT_NV12,
198 .de2_fmt = SUN8I_MIXER_FBFMT_NV12,
199 },
200 {
201 .drm_fmt = DRM_FORMAT_NV21,
202 .de2_fmt = SUN8I_MIXER_FBFMT_NV21,
203 },
204 {
205 .drm_fmt = DRM_FORMAT_YUV422,
206 .de2_fmt = SUN8I_MIXER_FBFMT_YUV422,
207 },
208 {
209 .drm_fmt = DRM_FORMAT_YUV420,
210 .de2_fmt = SUN8I_MIXER_FBFMT_YUV420,
211 },
212 {
213 .drm_fmt = DRM_FORMAT_YUV411,
214 .de2_fmt = SUN8I_MIXER_FBFMT_YUV411,
215 },
216 {
217 .drm_fmt = DRM_FORMAT_YVU422,
218 .de2_fmt = SUN8I_MIXER_FBFMT_YUV422,
219 },
220 {
221 .drm_fmt = DRM_FORMAT_YVU420,
222 .de2_fmt = SUN8I_MIXER_FBFMT_YUV420,
223 },
224 {
225 .drm_fmt = DRM_FORMAT_YVU411,
226 .de2_fmt = SUN8I_MIXER_FBFMT_YUV411,
227 },
228 {
229 .drm_fmt = DRM_FORMAT_P010,
230 .de2_fmt = SUN8I_MIXER_FBFMT_P010_YUV,
231 },
232 {
233 .drm_fmt = DRM_FORMAT_P210,
234 .de2_fmt = SUN8I_MIXER_FBFMT_P210_YUV,
235 },
236};
237
238int sun8i_mixer_drm_format_to_hw(u32 format, u32 *hw_format)
239{
240 unsigned int i;
241
242 for (i = 0; i < ARRAY_SIZE(de2_formats); ++i)
243 if (de2_formats[i].drm_fmt == format) {
244 *hw_format = de2_formats[i].de2_fmt;
245 return 0;
246 }
247
248 return -EINVAL;
249}
250
251static void sun8i_mixer_commit(struct sunxi_engine *engine)
252{
253 DRM_DEBUG_DRIVER("Committing changes\n");
254
255 regmap_write(engine->regs, SUN8I_MIXER_GLOBAL_DBUFF,
256 SUN8I_MIXER_GLOBAL_DBUFF_ENABLE);
257}
258
259static struct drm_plane **sun8i_layers_init(struct drm_device *drm,
260 struct sunxi_engine *engine)
261{
262 struct drm_plane **planes;
263 struct sun8i_mixer *mixer = engine_to_sun8i_mixer(engine);
264 int i;
265
266 planes = devm_kcalloc(drm->dev,
267 mixer->cfg->vi_num + mixer->cfg->ui_num + 1,
268 sizeof(*planes), GFP_KERNEL);
269 if (!planes)
270 return ERR_PTR(-ENOMEM);
271
272 for (i = 0; i < mixer->cfg->vi_num; i++) {
273 struct sun8i_vi_layer *layer;
274
275 layer = sun8i_vi_layer_init_one(drm, mixer, i);
276 if (IS_ERR(layer)) {
277 dev_err(drm->dev,
278 "Couldn't initialize overlay plane\n");
279 return ERR_CAST(layer);
280 }
281
282 planes[i] = &layer->plane;
283 }
284
285 for (i = 0; i < mixer->cfg->ui_num; i++) {
286 struct sun8i_ui_layer *layer;
287
288 layer = sun8i_ui_layer_init_one(drm, mixer, i);
289 if (IS_ERR(layer)) {
290 dev_err(drm->dev, "Couldn't initialize %s plane\n",
291 i ? "overlay" : "primary");
292 return ERR_CAST(layer);
293 }
294
295 planes[mixer->cfg->vi_num + i] = &layer->plane;
296 }
297
298 return planes;
299}
300
301static const struct sunxi_engine_ops sun8i_engine_ops = {
302 .commit = sun8i_mixer_commit,
303 .layers_init = sun8i_layers_init,
304};
305
306static const struct regmap_config sun8i_mixer_regmap_config = {
307 .reg_bits = 32,
308 .val_bits = 32,
309 .reg_stride = 4,
310 .max_register = 0xffffc,
311};
312
313static int sun8i_mixer_of_get_id(struct device_node *node)
314{
315 struct device_node *ep, *remote;
316 struct of_endpoint of_ep;
317
318
319 ep = of_graph_get_endpoint_by_regs(node, 1, -1);
320 if (!ep)
321 return -EINVAL;
322
323 remote = of_graph_get_remote_endpoint(ep);
324 of_node_put(ep);
325 if (!remote)
326 return -EINVAL;
327
328 of_graph_parse_endpoint(remote, &of_ep);
329 of_node_put(remote);
330 return of_ep.id;
331}
332
333static int sun8i_mixer_bind(struct device *dev, struct device *master,
334 void *data)
335{
336 struct platform_device *pdev = to_platform_device(dev);
337 struct drm_device *drm = data;
338 struct sun4i_drv *drv = drm->dev_private;
339 struct sun8i_mixer *mixer;
340 struct resource *res;
341 void __iomem *regs;
342 unsigned int base;
343 int plane_cnt;
344 int i, ret;
345
346
347
348
349
350
351
352
353 ret = dma_set_mask(dev, DMA_BIT_MASK(32));
354 if (ret) {
355 dev_err(dev, "Cannot do 32-bit DMA.\n");
356 return ret;
357 }
358
359 mixer = devm_kzalloc(dev, sizeof(*mixer), GFP_KERNEL);
360 if (!mixer)
361 return -ENOMEM;
362 dev_set_drvdata(dev, mixer);
363 mixer->engine.ops = &sun8i_engine_ops;
364 mixer->engine.node = dev->of_node;
365
366 if (of_find_property(dev->of_node, "iommus", NULL)) {
367
368
369
370
371
372
373
374 ret = of_dma_configure(drm->dev, dev->of_node, true);
375 if (ret)
376 return ret;
377 }
378
379
380
381
382
383
384
385
386
387 mixer->engine.id = sun8i_mixer_of_get_id(dev->of_node);
388
389 mixer->cfg = of_device_get_match_data(dev);
390 if (!mixer->cfg)
391 return -EINVAL;
392
393 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
394 regs = devm_ioremap_resource(dev, res);
395 if (IS_ERR(regs))
396 return PTR_ERR(regs);
397
398 mixer->engine.regs = devm_regmap_init_mmio(dev, regs,
399 &sun8i_mixer_regmap_config);
400 if (IS_ERR(mixer->engine.regs)) {
401 dev_err(dev, "Couldn't create the mixer regmap\n");
402 return PTR_ERR(mixer->engine.regs);
403 }
404
405 mixer->reset = devm_reset_control_get(dev, NULL);
406 if (IS_ERR(mixer->reset)) {
407 dev_err(dev, "Couldn't get our reset line\n");
408 return PTR_ERR(mixer->reset);
409 }
410
411 ret = reset_control_deassert(mixer->reset);
412 if (ret) {
413 dev_err(dev, "Couldn't deassert our reset line\n");
414 return ret;
415 }
416
417 mixer->bus_clk = devm_clk_get(dev, "bus");
418 if (IS_ERR(mixer->bus_clk)) {
419 dev_err(dev, "Couldn't get the mixer bus clock\n");
420 ret = PTR_ERR(mixer->bus_clk);
421 goto err_assert_reset;
422 }
423 clk_prepare_enable(mixer->bus_clk);
424
425 mixer->mod_clk = devm_clk_get(dev, "mod");
426 if (IS_ERR(mixer->mod_clk)) {
427 dev_err(dev, "Couldn't get the mixer module clock\n");
428 ret = PTR_ERR(mixer->mod_clk);
429 goto err_disable_bus_clk;
430 }
431
432
433
434
435
436
437 if (mixer->cfg->mod_rate)
438 clk_set_rate(mixer->mod_clk, mixer->cfg->mod_rate);
439
440 clk_prepare_enable(mixer->mod_clk);
441
442 list_add_tail(&mixer->engine.list, &drv->engine_list);
443
444 base = sun8i_blender_base(mixer);
445
446
447 if (mixer->cfg->is_de3) {
448 for (i = 0; i < DE3_MIXER_UNIT_SIZE; i += 4)
449 regmap_write(mixer->engine.regs, i, 0);
450
451 regmap_write(mixer->engine.regs, SUN50I_MIXER_FCE_EN, 0);
452 regmap_write(mixer->engine.regs, SUN50I_MIXER_PEAK_EN, 0);
453 regmap_write(mixer->engine.regs, SUN50I_MIXER_LCTI_EN, 0);
454 regmap_write(mixer->engine.regs, SUN50I_MIXER_BLS_EN, 0);
455 regmap_write(mixer->engine.regs, SUN50I_MIXER_FCC_EN, 0);
456 regmap_write(mixer->engine.regs, SUN50I_MIXER_DNS_EN, 0);
457 regmap_write(mixer->engine.regs, SUN50I_MIXER_DRC_EN, 0);
458 regmap_write(mixer->engine.regs, SUN50I_MIXER_FMT_EN, 0);
459 regmap_write(mixer->engine.regs, SUN50I_MIXER_CDC0_EN, 0);
460 regmap_write(mixer->engine.regs, SUN50I_MIXER_CDC1_EN, 0);
461 } else {
462 for (i = 0; i < DE2_MIXER_UNIT_SIZE; i += 4)
463 regmap_write(mixer->engine.regs, i, 0);
464
465 regmap_write(mixer->engine.regs, SUN8I_MIXER_FCE_EN, 0);
466 regmap_write(mixer->engine.regs, SUN8I_MIXER_BWS_EN, 0);
467 regmap_write(mixer->engine.regs, SUN8I_MIXER_LTI_EN, 0);
468 regmap_write(mixer->engine.regs, SUN8I_MIXER_PEAK_EN, 0);
469 regmap_write(mixer->engine.regs, SUN8I_MIXER_ASE_EN, 0);
470 regmap_write(mixer->engine.regs, SUN8I_MIXER_FCC_EN, 0);
471 regmap_write(mixer->engine.regs, SUN8I_MIXER_DCSC_EN, 0);
472 }
473
474
475 regmap_write(mixer->engine.regs, SUN8I_MIXER_GLOBAL_CTL,
476 SUN8I_MIXER_GLOBAL_CTL_RT_EN);
477
478
479 regmap_write(mixer->engine.regs, SUN8I_MIXER_BLEND_BKCOLOR(base),
480 SUN8I_MIXER_BLEND_COLOR_BLACK);
481
482
483
484
485
486 regmap_write(mixer->engine.regs, SUN8I_MIXER_BLEND_PIPE_CTL(base),
487 SUN8I_MIXER_BLEND_PIPE_CTL_FC_EN(0));
488 regmap_write(mixer->engine.regs, SUN8I_MIXER_BLEND_ATTR_FCOLOR(base, 0),
489 SUN8I_MIXER_BLEND_COLOR_BLACK);
490
491 plane_cnt = mixer->cfg->vi_num + mixer->cfg->ui_num;
492 for (i = 0; i < plane_cnt; i++)
493 regmap_write(mixer->engine.regs,
494 SUN8I_MIXER_BLEND_MODE(base, i),
495 SUN8I_MIXER_BLEND_MODE_DEF);
496
497 regmap_update_bits(mixer->engine.regs, SUN8I_MIXER_BLEND_PIPE_CTL(base),
498 SUN8I_MIXER_BLEND_PIPE_CTL_EN_MSK, 0);
499
500 return 0;
501
502err_disable_bus_clk:
503 clk_disable_unprepare(mixer->bus_clk);
504err_assert_reset:
505 reset_control_assert(mixer->reset);
506 return ret;
507}
508
509static void sun8i_mixer_unbind(struct device *dev, struct device *master,
510 void *data)
511{
512 struct sun8i_mixer *mixer = dev_get_drvdata(dev);
513
514 list_del(&mixer->engine.list);
515
516 clk_disable_unprepare(mixer->mod_clk);
517 clk_disable_unprepare(mixer->bus_clk);
518 reset_control_assert(mixer->reset);
519}
520
521static const struct component_ops sun8i_mixer_ops = {
522 .bind = sun8i_mixer_bind,
523 .unbind = sun8i_mixer_unbind,
524};
525
526static int sun8i_mixer_probe(struct platform_device *pdev)
527{
528 return component_add(&pdev->dev, &sun8i_mixer_ops);
529}
530
531static int sun8i_mixer_remove(struct platform_device *pdev)
532{
533 component_del(&pdev->dev, &sun8i_mixer_ops);
534
535 return 0;
536}
537
538static const struct sun8i_mixer_cfg sun8i_a83t_mixer0_cfg = {
539 .ccsc = 0,
540 .scaler_mask = 0xf,
541 .scanline_yuv = 2048,
542 .ui_num = 3,
543 .vi_num = 1,
544};
545
546static const struct sun8i_mixer_cfg sun8i_a83t_mixer1_cfg = {
547 .ccsc = 1,
548 .scaler_mask = 0x3,
549 .scanline_yuv = 2048,
550 .ui_num = 1,
551 .vi_num = 1,
552};
553
554static const struct sun8i_mixer_cfg sun8i_h3_mixer0_cfg = {
555 .ccsc = 0,
556 .mod_rate = 432000000,
557 .scaler_mask = 0xf,
558 .scanline_yuv = 2048,
559 .ui_num = 3,
560 .vi_num = 1,
561};
562
563static const struct sun8i_mixer_cfg sun8i_r40_mixer0_cfg = {
564 .ccsc = 0,
565 .mod_rate = 297000000,
566 .scaler_mask = 0xf,
567 .scanline_yuv = 2048,
568 .ui_num = 3,
569 .vi_num = 1,
570};
571
572static const struct sun8i_mixer_cfg sun8i_r40_mixer1_cfg = {
573 .ccsc = 1,
574 .mod_rate = 297000000,
575 .scaler_mask = 0x3,
576 .scanline_yuv = 2048,
577 .ui_num = 1,
578 .vi_num = 1,
579};
580
581static const struct sun8i_mixer_cfg sun8i_v3s_mixer_cfg = {
582 .vi_num = 2,
583 .ui_num = 1,
584 .scaler_mask = 0x3,
585 .scanline_yuv = 2048,
586 .ccsc = 0,
587 .mod_rate = 150000000,
588};
589
590static const struct sun8i_mixer_cfg sun50i_a64_mixer0_cfg = {
591 .ccsc = 0,
592 .mod_rate = 297000000,
593 .scaler_mask = 0xf,
594 .scanline_yuv = 4096,
595 .ui_num = 3,
596 .vi_num = 1,
597};
598
599static const struct sun8i_mixer_cfg sun50i_a64_mixer1_cfg = {
600 .ccsc = 1,
601 .mod_rate = 297000000,
602 .scaler_mask = 0x3,
603 .scanline_yuv = 2048,
604 .ui_num = 1,
605 .vi_num = 1,
606};
607
608static const struct sun8i_mixer_cfg sun50i_h6_mixer0_cfg = {
609 .ccsc = 0,
610 .is_de3 = true,
611 .mod_rate = 600000000,
612 .scaler_mask = 0xf,
613 .scanline_yuv = 4096,
614 .ui_num = 3,
615 .vi_num = 1,
616};
617
618static const struct of_device_id sun8i_mixer_of_table[] = {
619 {
620 .compatible = "allwinner,sun8i-a83t-de2-mixer-0",
621 .data = &sun8i_a83t_mixer0_cfg,
622 },
623 {
624 .compatible = "allwinner,sun8i-a83t-de2-mixer-1",
625 .data = &sun8i_a83t_mixer1_cfg,
626 },
627 {
628 .compatible = "allwinner,sun8i-h3-de2-mixer-0",
629 .data = &sun8i_h3_mixer0_cfg,
630 },
631 {
632 .compatible = "allwinner,sun8i-r40-de2-mixer-0",
633 .data = &sun8i_r40_mixer0_cfg,
634 },
635 {
636 .compatible = "allwinner,sun8i-r40-de2-mixer-1",
637 .data = &sun8i_r40_mixer1_cfg,
638 },
639 {
640 .compatible = "allwinner,sun8i-v3s-de2-mixer",
641 .data = &sun8i_v3s_mixer_cfg,
642 },
643 {
644 .compatible = "allwinner,sun50i-a64-de2-mixer-0",
645 .data = &sun50i_a64_mixer0_cfg,
646 },
647 {
648 .compatible = "allwinner,sun50i-a64-de2-mixer-1",
649 .data = &sun50i_a64_mixer1_cfg,
650 },
651 {
652 .compatible = "allwinner,sun50i-h6-de3-mixer-0",
653 .data = &sun50i_h6_mixer0_cfg,
654 },
655 { }
656};
657MODULE_DEVICE_TABLE(of, sun8i_mixer_of_table);
658
659static struct platform_driver sun8i_mixer_platform_driver = {
660 .probe = sun8i_mixer_probe,
661 .remove = sun8i_mixer_remove,
662 .driver = {
663 .name = "sun8i-mixer",
664 .of_match_table = sun8i_mixer_of_table,
665 },
666};
667module_platform_driver(sun8i_mixer_platform_driver);
668
669MODULE_AUTHOR("Icenowy Zheng <icenowy@aosc.io>");
670MODULE_DESCRIPTION("Allwinner DE2 Mixer driver");
671MODULE_LICENSE("GPL");
672
