forked from ~ljy/RK356X_SDK_RELEASE

hc
2023-12-11 072de836f53be56a70cecf70b43ae43b7ce17376
kernel/drivers/gpu/drm/mediatek/mtk_drm_drv.c
....@@ -1,35 +1,34 @@
1
+// SPDX-License-Identifier: GPL-2.0-only
12 /*
23 * Copyright (c) 2015 MediaTek Inc.
34 * Author: YT SHEN <yt.shen@mediatek.com>
4
- *
5
- * This program is free software; you can redistribute it and/or modify
6
- * it under the terms of the GNU General Public License version 2 as
7
- * published by the Free Software Foundation.
8
- *
9
- * This program is distributed in the hope that it will be useful,
10
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
11
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12
- * GNU General Public License for more details.
135 */
146
15
-#include <drm/drmP.h>
16
-#include <drm/drm_atomic.h>
17
-#include <drm/drm_atomic_helper.h>
18
-#include <drm/drm_crtc_helper.h>
19
-#include <drm/drm_gem.h>
20
-#include <drm/drm_gem_cma_helper.h>
21
-#include <drm/drm_of.h>
227 #include <linux/component.h>
238 #include <linux/iommu.h>
9
+#include <linux/module.h>
2410 #include <linux/of_address.h>
2511 #include <linux/of_platform.h>
2612 #include <linux/pm_runtime.h>
13
+#include <linux/soc/mediatek/mtk-mmsys.h>
14
+#include <linux/dma-mapping.h>
15
+
16
+#include <drm/drm_atomic.h>
17
+#include <drm/drm_atomic_helper.h>
18
+#include <drm/drm_drv.h>
19
+#include <drm/drm_fb_helper.h>
20
+#include <drm/drm_fourcc.h>
21
+#include <drm/drm_gem.h>
22
+#include <drm/drm_gem_cma_helper.h>
23
+#include <drm/drm_gem_framebuffer_helper.h>
24
+#include <drm/drm_of.h>
25
+#include <drm/drm_probe_helper.h>
26
+#include <drm/drm_vblank.h>
2727
2828 #include "mtk_drm_crtc.h"
2929 #include "mtk_drm_ddp.h"
3030 #include "mtk_drm_ddp_comp.h"
3131 #include "mtk_drm_drv.h"
32
-#include "mtk_drm_fb.h"
3332 #include "mtk_drm_gem.h"
3433
3534 #define DRIVER_NAME "mediatek"
....@@ -38,99 +37,27 @@
3837 #define DRIVER_MAJOR 1
3938 #define DRIVER_MINOR 0
4039
41
-static void mtk_atomic_schedule(struct mtk_drm_private *private,
42
- struct drm_atomic_state *state)
40
+static const struct drm_mode_config_helper_funcs mtk_drm_mode_config_helpers = {
41
+ .atomic_commit_tail = drm_atomic_helper_commit_tail_rpm,
42
+};
43
+
44
+static struct drm_framebuffer *
45
+mtk_drm_mode_fb_create(struct drm_device *dev,
46
+ struct drm_file *file,
47
+ const struct drm_mode_fb_cmd2 *cmd)
4348 {
44
- private->commit.state = state;
45
- schedule_work(&private->commit.work);
46
-}
49
+ const struct drm_format_info *info = drm_get_format_info(dev, cmd);
4750
48
-static void mtk_atomic_wait_for_fences(struct drm_atomic_state *state)
49
-{
50
- struct drm_plane *plane;
51
- struct drm_plane_state *new_plane_state;
52
- int i;
51
+ if (info->num_planes != 1)
52
+ return ERR_PTR(-EINVAL);
5353
54
- for_each_new_plane_in_state(state, plane, new_plane_state, i)
55
- mtk_fb_wait(new_plane_state->fb);
56
-}
57
-
58
-static void mtk_atomic_complete(struct mtk_drm_private *private,
59
- struct drm_atomic_state *state)
60
-{
61
- struct drm_device *drm = private->drm;
62
-
63
- mtk_atomic_wait_for_fences(state);
64
-
65
- /*
66
- * Mediatek drm supports runtime PM, so plane registers cannot be
67
- * written when their crtc is disabled.
68
- *
69
- * The comment for drm_atomic_helper_commit states:
70
- * For drivers supporting runtime PM the recommended sequence is
71
- *
72
- * drm_atomic_helper_commit_modeset_disables(dev, state);
73
- * drm_atomic_helper_commit_modeset_enables(dev, state);
74
- * drm_atomic_helper_commit_planes(dev, state,
75
- * DRM_PLANE_COMMIT_ACTIVE_ONLY);
76
- *
77
- * See the kerneldoc entries for these three functions for more details.
78
- */
79
- drm_atomic_helper_commit_modeset_disables(drm, state);
80
- drm_atomic_helper_commit_modeset_enables(drm, state);
81
- drm_atomic_helper_commit_planes(drm, state,
82
- DRM_PLANE_COMMIT_ACTIVE_ONLY);
83
-
84
- drm_atomic_helper_wait_for_vblanks(drm, state);
85
-
86
- drm_atomic_helper_cleanup_planes(drm, state);
87
- drm_atomic_state_put(state);
88
-}
89
-
90
-static void mtk_atomic_work(struct work_struct *work)
91
-{
92
- struct mtk_drm_private *private = container_of(work,
93
- struct mtk_drm_private, commit.work);
94
-
95
- mtk_atomic_complete(private, private->commit.state);
96
-}
97
-
98
-static int mtk_atomic_commit(struct drm_device *drm,
99
- struct drm_atomic_state *state,
100
- bool async)
101
-{
102
- struct mtk_drm_private *private = drm->dev_private;
103
- int ret;
104
-
105
- ret = drm_atomic_helper_prepare_planes(drm, state);
106
- if (ret)
107
- return ret;
108
-
109
- mutex_lock(&private->commit.lock);
110
- flush_work(&private->commit.work);
111
-
112
- ret = drm_atomic_helper_swap_state(state, true);
113
- if (ret) {
114
- mutex_unlock(&private->commit.lock);
115
- drm_atomic_helper_cleanup_planes(drm, state);
116
- return ret;
117
- }
118
-
119
- drm_atomic_state_get(state);
120
- if (async)
121
- mtk_atomic_schedule(private, state);
122
- else
123
- mtk_atomic_complete(private, state);
124
-
125
- mutex_unlock(&private->commit.lock);
126
-
127
- return 0;
54
+ return drm_gem_fb_create(dev, file, cmd);
12855 }
12956
13057 static const struct drm_mode_config_funcs mtk_drm_mode_config_funcs = {
13158 .fb_create = mtk_drm_mode_fb_create,
13259 .atomic_check = drm_atomic_helper_check,
133
- .atomic_commit = mtk_atomic_commit,
60
+ .atomic_commit = drm_atomic_helper_commit,
13461 };
13562
13663 static const enum mtk_ddp_comp_id mt2701_mtk_ddp_main[] = {
....@@ -144,6 +71,19 @@
14471 static const enum mtk_ddp_comp_id mt2701_mtk_ddp_ext[] = {
14572 DDP_COMPONENT_RDMA1,
14673 DDP_COMPONENT_DPI0,
74
+};
75
+
76
+static const enum mtk_ddp_comp_id mt7623_mtk_ddp_main[] = {
77
+ DDP_COMPONENT_OVL0,
78
+ DDP_COMPONENT_RDMA0,
79
+ DDP_COMPONENT_COLOR0,
80
+ DDP_COMPONENT_BLS,
81
+ DDP_COMPONENT_DPI0,
82
+};
83
+
84
+static const enum mtk_ddp_comp_id mt7623_mtk_ddp_ext[] = {
85
+ DDP_COMPONENT_RDMA1,
86
+ DDP_COMPONENT_DSI0,
14787 };
14888
14989 static const enum mtk_ddp_comp_id mt2712_mtk_ddp_main[] = {
....@@ -199,6 +139,14 @@
199139 .shadow_register = true,
200140 };
201141
142
+static const struct mtk_mmsys_driver_data mt7623_mmsys_driver_data = {
143
+ .main_path = mt7623_mtk_ddp_main,
144
+ .main_len = ARRAY_SIZE(mt7623_mtk_ddp_main),
145
+ .ext_path = mt7623_mtk_ddp_ext,
146
+ .ext_len = ARRAY_SIZE(mt7623_mtk_ddp_ext),
147
+ .shadow_register = true,
148
+};
149
+
202150 static const struct mtk_mmsys_driver_data mt2712_mmsys_driver_data = {
203151 .main_path = mt2712_mtk_ddp_main,
204152 .main_len = ARRAY_SIZE(mt2712_mtk_ddp_main),
....@@ -235,7 +183,9 @@
235183 }
236184 private->mutex_dev = &pdev->dev;
237185
238
- drm_mode_config_init(drm);
186
+ ret = drmm_mode_config_init(drm);
187
+ if (ret)
188
+ goto put_mutex_dev;
239189
240190 drm->mode_config.min_width = 64;
241191 drm->mode_config.min_height = 64;
....@@ -248,10 +198,11 @@
248198 drm->mode_config.max_width = 4096;
249199 drm->mode_config.max_height = 4096;
250200 drm->mode_config.funcs = &mtk_drm_mode_config_funcs;
201
+ drm->mode_config.helper_private = &mtk_drm_mode_config_helpers;
251202
252203 ret = component_bind_all(drm->dev, drm);
253204 if (ret)
254
- goto err_config_cleanup;
205
+ goto put_mutex_dev;
255206
256207 /*
257208 * We currently support two fixed data streams, each optional,
....@@ -298,7 +249,7 @@
298249 }
299250 if (!dma_dev->dma_parms) {
300251 ret = -ENOMEM;
301
- goto err_component_unbind;
252
+ goto put_dma_dev;
302253 }
303254
304255 ret = dma_set_max_seg_size(dma_dev, (unsigned int)DMA_BIT_MASK(32));
....@@ -325,11 +276,12 @@
325276 err_unset_dma_parms:
326277 if (private->dma_parms_allocated)
327278 dma_dev->dma_parms = NULL;
279
+put_dma_dev:
280
+ put_device(private->dma_dev);
328281 err_component_unbind:
329282 component_unbind_all(drm->dev, drm);
330
-err_config_cleanup:
331
- drm_mode_config_cleanup(drm);
332
-
283
+put_mutex_dev:
284
+ put_device(private->mutex_dev);
333285 return ret;
334286 }
335287
....@@ -344,7 +296,6 @@
344296 private->dma_dev->dma_parms = NULL;
345297
346298 component_unbind_all(drm->dev, drm);
347
- drm_mode_config_cleanup(drm);
348299 }
349300
350301 static const struct file_operations mtk_drm_fops = {
....@@ -371,8 +322,7 @@
371322 }
372323
373324 static struct drm_driver mtk_drm_driver = {
374
- .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME |
375
- DRIVER_ATOMIC,
325
+ .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC,
376326
377327 .gem_free_object_unlocked = mtk_drm_gem_free_object,
378328 .gem_vm_ops = &drm_gem_cma_vm_ops,
....@@ -380,11 +330,12 @@
380330
381331 .prime_handle_to_fd = drm_gem_prime_handle_to_fd,
382332 .prime_fd_to_handle = drm_gem_prime_fd_to_handle,
383
- .gem_prime_export = drm_gem_prime_export,
384333 .gem_prime_import = mtk_drm_gem_prime_import,
385334 .gem_prime_get_sg_table = mtk_gem_prime_get_sg_table,
386335 .gem_prime_import_sg_table = mtk_gem_prime_import_sg_table,
387336 .gem_prime_mmap = mtk_drm_gem_mmap_buf,
337
+ .gem_prime_vmap = mtk_drm_gem_prime_vmap,
338
+ .gem_prime_vunmap = mtk_drm_gem_prime_vunmap,
388339 .fops = &mtk_drm_fops,
389340
390341 .name = DRIVER_NAME,
....@@ -419,6 +370,8 @@
419370 ret = drm_dev_register(drm, 0);
420371 if (ret < 0)
421372 goto err_deinit;
373
+
374
+ drm_fbdev_generic_setup(drm, 32);
422375
423376 return 0;
424377
....@@ -470,6 +423,8 @@
470423 .data = (void *)MTK_DSI },
471424 { .compatible = "mediatek,mt8173-dsi",
472425 .data = (void *)MTK_DSI },
426
+ { .compatible = "mediatek,mt2701-dpi",
427
+ .data = (void *)MTK_DPI },
473428 { .compatible = "mediatek,mt8173-dpi",
474429 .data = (void *)MTK_DPI },
475430 { .compatible = "mediatek,mt2701-disp-mutex",
....@@ -487,11 +442,24 @@
487442 { }
488443 };
489444
445
+static const struct of_device_id mtk_drm_of_ids[] = {
446
+ { .compatible = "mediatek,mt2701-mmsys",
447
+ .data = &mt2701_mmsys_driver_data},
448
+ { .compatible = "mediatek,mt7623-mmsys",
449
+ .data = &mt7623_mmsys_driver_data},
450
+ { .compatible = "mediatek,mt2712-mmsys",
451
+ .data = &mt2712_mmsys_driver_data},
452
+ { .compatible = "mediatek,mt8173-mmsys",
453
+ .data = &mt8173_mmsys_driver_data},
454
+ { }
455
+};
456
+
490457 static int mtk_drm_probe(struct platform_device *pdev)
491458 {
492459 struct device *dev = &pdev->dev;
460
+ struct device_node *phandle = dev->parent->of_node;
461
+ const struct of_device_id *of_id;
493462 struct mtk_drm_private *private;
494
- struct resource *mem;
495463 struct device_node *node;
496464 struct component_match *match = NULL;
497465 int ret;
....@@ -501,21 +469,20 @@
501469 if (!private)
502470 return -ENOMEM;
503471
504
- mutex_init(&private->commit.lock);
505
- INIT_WORK(&private->commit.work, mtk_atomic_work);
506
- private->data = of_device_get_match_data(dev);
507
-
508
- mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
509
- private->config_regs = devm_ioremap_resource(dev, mem);
510
- if (IS_ERR(private->config_regs)) {
511
- ret = PTR_ERR(private->config_regs);
512
- dev_err(dev, "Failed to ioremap mmsys-config resource: %d\n",
513
- ret);
514
- return ret;
472
+ private->mmsys_dev = dev->parent;
473
+ if (!private->mmsys_dev) {
474
+ dev_err(dev, "Failed to get MMSYS device\n");
475
+ return -ENODEV;
515476 }
516477
478
+ of_id = of_match_node(mtk_drm_of_ids, phandle);
479
+ if (!of_id)
480
+ return -ENODEV;
481
+
482
+ private->data = of_id->data;
483
+
517484 /* Iterate over sibling DISP function blocks */
518
- for_each_child_of_node(dev->of_node->parent, node) {
485
+ for_each_child_of_node(phandle->parent, node) {
519486 const struct of_device_id *of_id;
520487 enum mtk_ddp_comp_type comp_type;
521488 int comp_id;
....@@ -553,6 +520,7 @@
553520 */
554521 if (comp_type == MTK_DISP_COLOR ||
555522 comp_type == MTK_DISP_OVL ||
523
+ comp_type == MTK_DISP_OVL_2L ||
556524 comp_type == MTK_DISP_RDMA ||
557525 comp_type == MTK_DSI ||
558526 comp_type == MTK_DPI) {
....@@ -570,7 +538,8 @@
570538 goto err_node;
571539 }
572540
573
- ret = mtk_ddp_comp_init(dev, node, comp, comp_id, NULL);
541
+ ret = mtk_ddp_comp_init(dev->parent, node, comp,
542
+ comp_id, NULL);
574543 if (ret) {
575544 of_node_put(node);
576545 goto err_node;
....@@ -632,7 +601,6 @@
632601 int ret;
633602
634603 ret = drm_mode_config_helper_suspend(drm);
635
- DRM_DEBUG_DRIVER("mtk_drm_sys_suspend\n");
636604
637605 return ret;
638606 }
....@@ -644,7 +612,6 @@
644612 int ret;
645613
646614 ret = drm_mode_config_helper_resume(drm);
647
- DRM_DEBUG_DRIVER("mtk_drm_sys_resume\n");
648615
649616 return ret;
650617 }
....@@ -653,22 +620,11 @@
653620 static SIMPLE_DEV_PM_OPS(mtk_drm_pm_ops, mtk_drm_sys_suspend,
654621 mtk_drm_sys_resume);
655622
656
-static const struct of_device_id mtk_drm_of_ids[] = {
657
- { .compatible = "mediatek,mt2701-mmsys",
658
- .data = &mt2701_mmsys_driver_data},
659
- { .compatible = "mediatek,mt2712-mmsys",
660
- .data = &mt2712_mmsys_driver_data},
661
- { .compatible = "mediatek,mt8173-mmsys",
662
- .data = &mt8173_mmsys_driver_data},
663
- { }
664
-};
665
-
666623 static struct platform_driver mtk_drm_platform_driver = {
667624 .probe = mtk_drm_probe,
668625 .remove = mtk_drm_remove,
669626 .driver = {
670627 .name = "mediatek-drm",
671
- .of_match_table = mtk_drm_of_ids,
672628 .pm = &mtk_drm_pm_ops,
673629 },
674630 };
....@@ -680,8 +636,8 @@
680636 &mtk_disp_rdma_driver,
681637 &mtk_dpi_driver,
682638 &mtk_drm_platform_driver,
683
- &mtk_dsi_driver,
684639 &mtk_mipi_tx_driver,
640
+ &mtk_dsi_driver,
685641 };
686642
687643 static int __init mtk_drm_init(void)