forked from ~ljy/RK356X_SDK_RELEASE
blame | history | patch | commit | commitdiff
hc
2024-05-10 10ebd8556b7990499c896a550e3d416b444211e6 
 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,
....@@ -420,11 +371,14 @@
420371 	if (ret < 0)
421372 		goto err_deinit;
422373 
374
+	drm_fbdev_generic_setup(drm, 32);
375
+
423376 	return 0;
424377 
425378 err_deinit:
426379 	mtk_drm_kms_deinit(drm);
427380 err_free:
381
+	private->drm = NULL;
428382 	drm_dev_put(drm);
429383 	return ret;
430384 }
....@@ -470,6 +424,8 @@
470424 	  .data = (void *)MTK_DSI },
471425 	{ .compatible = "mediatek,mt8173-dsi",
472426 	  .data = (void *)MTK_DSI },
427
+	{ .compatible = "mediatek,mt2701-dpi",
428
+	  .data = (void *)MTK_DPI },
473429 	{ .compatible = "mediatek,mt8173-dpi",
474430 	  .data = (void *)MTK_DPI },
475431 	{ .compatible = "mediatek,mt2701-disp-mutex",
....@@ -487,11 +443,24 @@
487443 	{ }
488444 };
489445 
446
+static const struct of_device_id mtk_drm_of_ids[] = {
447
+	{ .compatible = "mediatek,mt2701-mmsys",
448
+	  .data = &mt2701_mmsys_driver_data},
449
+	{ .compatible = "mediatek,mt7623-mmsys",
450
+	  .data = &mt7623_mmsys_driver_data},
451
+	{ .compatible = "mediatek,mt2712-mmsys",
452
+	  .data = &mt2712_mmsys_driver_data},
453
+	{ .compatible = "mediatek,mt8173-mmsys",
454
+	  .data = &mt8173_mmsys_driver_data},
455
+	{ }
456
+};
457
+
490458 static int mtk_drm_probe(struct platform_device *pdev)
491459 {
492460 	struct device *dev = &pdev->dev;
461
+	struct device_node *phandle = dev->parent->of_node;
462
+	const struct of_device_id *of_id;
493463 	struct mtk_drm_private *private;
494
-	struct resource *mem;
495464 	struct device_node *node;
496465 	struct component_match *match = NULL;
497466 	int ret;
....@@ -501,21 +470,20 @@
501470 	if (!private)
502471 		return -ENOMEM;
503472 
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;
473
+	private->mmsys_dev = dev->parent;
474
+	if (!private->mmsys_dev) {
475
+		dev_err(dev, "Failed to get MMSYS device\n");
476
+		return -ENODEV;
515477 	}
516478 
479
+	of_id = of_match_node(mtk_drm_of_ids, phandle);
480
+	if (!of_id)
481
+		return -ENODEV;
482
+
483
+	private->data = of_id->data;
484
+
517485 	/* Iterate over sibling DISP function blocks */
518
-	for_each_child_of_node(dev->of_node->parent, node) {
486
+	for_each_child_of_node(phandle->parent, node) {
519487 		const struct of_device_id *of_id;
520488 		enum mtk_ddp_comp_type comp_type;
521489 		int comp_id;
....@@ -553,6 +521,7 @@
553521 		 */
554522 		if (comp_type == MTK_DISP_COLOR ||
555523 		    comp_type == MTK_DISP_OVL ||
524
+		    comp_type == MTK_DISP_OVL_2L ||
556525 		    comp_type == MTK_DISP_RDMA ||
557526 		    comp_type == MTK_DSI ||
558527 		    comp_type == MTK_DPI) {
....@@ -570,7 +539,8 @@
570539 				goto err_node;
571540 			}
572541 
573
-			ret = mtk_ddp_comp_init(dev, node, comp, comp_id, NULL);
542
+			ret = mtk_ddp_comp_init(dev->parent, node, comp,
543
+						comp_id, NULL);
574544 			if (ret) {
575545 				of_node_put(node);
576546 				goto err_node;
....@@ -632,7 +602,6 @@
632602 	int ret;
633603 
634604 	ret = drm_mode_config_helper_suspend(drm);
635
-	DRM_DEBUG_DRIVER("mtk_drm_sys_suspend\n");
636605 
637606 	return ret;
638607 }
....@@ -644,7 +613,6 @@
644613 	int ret;
645614 
646615 	ret = drm_mode_config_helper_resume(drm);
647
-	DRM_DEBUG_DRIVER("mtk_drm_sys_resume\n");
648616 
649617 	return ret;
650618 }
....@@ -653,22 +621,11 @@
653621 static SIMPLE_DEV_PM_OPS(mtk_drm_pm_ops, mtk_drm_sys_suspend,
654622 			 mtk_drm_sys_resume);
655623 
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
-
666624 static struct platform_driver mtk_drm_platform_driver = {
667625 	.probe	= mtk_drm_probe,
668626 	.remove	= mtk_drm_remove,
669627 	.driver	= {
670628 		.name	= "mediatek-drm",
671
-		.of_match_table = mtk_drm_of_ids,
672629 		.pm     = &mtk_drm_pm_ops,
673630 	},
674631 };
....@@ -680,8 +637,8 @@
680637 	&mtk_disp_rdma_driver,
681638 	&mtk_dpi_driver,
682639 	&mtk_drm_platform_driver,
683
-	&mtk_dsi_driver,
684640 	&mtk_mipi_tx_driver,
641
+	&mtk_dsi_driver,
685642 };
686643 
687644 static int __init mtk_drm_init(void)