xref: /openbmc/linux/drivers/video/fbdev/mmp/core.c (revision 4f2c0a4acffbec01079c28f839422e64ddeff004)
11ccea77eSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later
2f7018c21STomi Valkeinen /*
3f7018c21STomi Valkeinen  * linux/drivers/video/mmp/common.c
4f7018c21STomi Valkeinen  * This driver is a common framework for Marvell Display Controller
5f7018c21STomi Valkeinen  *
6f7018c21STomi Valkeinen  * Copyright (C) 2012 Marvell Technology Group Ltd.
7f7018c21STomi Valkeinen  * Authors: Zhou Zhu <zzhu3@marvell.com>
8f7018c21STomi Valkeinen  */
9f7018c21STomi Valkeinen 
10f7018c21STomi Valkeinen #include <linux/slab.h>
11f7018c21STomi Valkeinen #include <linux/dma-mapping.h>
12f7018c21STomi Valkeinen #include <linux/export.h>
13c1530ac5SArnd Bergmann #include <linux/module.h>
14f7018c21STomi Valkeinen #include <video/mmp_disp.h>
15f7018c21STomi Valkeinen 
path_get_overlay(struct mmp_path * path,int overlay_id)16f7018c21STomi Valkeinen static struct mmp_overlay *path_get_overlay(struct mmp_path *path,
17f7018c21STomi Valkeinen 		int overlay_id)
18f7018c21STomi Valkeinen {
19f7018c21STomi Valkeinen 	if (path && overlay_id < path->overlay_num)
20f7018c21STomi Valkeinen 		return &path->overlays[overlay_id];
21f7018c21STomi Valkeinen 	return NULL;
22f7018c21STomi Valkeinen }
23f7018c21STomi Valkeinen 
path_check_status(struct mmp_path * path)24f7018c21STomi Valkeinen static int path_check_status(struct mmp_path *path)
25f7018c21STomi Valkeinen {
26f7018c21STomi Valkeinen 	int i;
27f7018c21STomi Valkeinen 	for (i = 0; i < path->overlay_num; i++)
28f7018c21STomi Valkeinen 		if (path->overlays[i].status)
29f7018c21STomi Valkeinen 			return 1;
30f7018c21STomi Valkeinen 
31f7018c21STomi Valkeinen 	return 0;
32f7018c21STomi Valkeinen }
33f7018c21STomi Valkeinen 
34f7018c21STomi Valkeinen /*
35f7018c21STomi Valkeinen  * Get modelist write pointer of modelist.
36f7018c21STomi Valkeinen  * It also returns modelist number
37f7018c21STomi Valkeinen  * this function fetches modelist from phy/panel:
38f7018c21STomi Valkeinen  *   for HDMI/parallel or dsi to hdmi cases, get from phy
39f7018c21STomi Valkeinen  *   or get from panel
40f7018c21STomi Valkeinen  */
path_get_modelist(struct mmp_path * path,struct mmp_mode ** modelist)41f7018c21STomi Valkeinen static int path_get_modelist(struct mmp_path *path,
42f7018c21STomi Valkeinen 		struct mmp_mode **modelist)
43f7018c21STomi Valkeinen {
44f7018c21STomi Valkeinen 	BUG_ON(!path || !modelist);
45f7018c21STomi Valkeinen 
46f7018c21STomi Valkeinen 	if (path->panel && path->panel->get_modelist)
47f7018c21STomi Valkeinen 		return path->panel->get_modelist(path->panel, modelist);
48f7018c21STomi Valkeinen 
49f7018c21STomi Valkeinen 	return 0;
50f7018c21STomi Valkeinen }
51f7018c21STomi Valkeinen 
52f7018c21STomi Valkeinen /*
53f7018c21STomi Valkeinen  * panel list is used to pair panel/path when path/panel registered
54f7018c21STomi Valkeinen  * path list is used for both buffer driver and platdriver
55f7018c21STomi Valkeinen  * plat driver do path register/unregister
56f7018c21STomi Valkeinen  * panel driver do panel register/unregister
57f7018c21STomi Valkeinen  * buffer driver get registered path
58f7018c21STomi Valkeinen  */
59f7018c21STomi Valkeinen static LIST_HEAD(panel_list);
60f7018c21STomi Valkeinen static LIST_HEAD(path_list);
61f7018c21STomi Valkeinen static DEFINE_MUTEX(disp_lock);
62f7018c21STomi Valkeinen 
63f7018c21STomi Valkeinen /*
64f7018c21STomi Valkeinen  * mmp_register_panel - register panel to panel_list and connect to path
65f7018c21STomi Valkeinen  * @p: panel to be registered
66f7018c21STomi Valkeinen  *
67f7018c21STomi Valkeinen  * this function provides interface for panel drivers to register panel
68f7018c21STomi Valkeinen  * to panel_list and connect to path which matchs panel->plat_path_name.
69f7018c21STomi Valkeinen  * no error returns when no matching path is found as path register after
70f7018c21STomi Valkeinen  * panel register is permitted.
71f7018c21STomi Valkeinen  */
mmp_register_panel(struct mmp_panel * panel)72f7018c21STomi Valkeinen void mmp_register_panel(struct mmp_panel *panel)
73f7018c21STomi Valkeinen {
74f7018c21STomi Valkeinen 	struct mmp_path *path;
75f7018c21STomi Valkeinen 
76f7018c21STomi Valkeinen 	mutex_lock(&disp_lock);
77f7018c21STomi Valkeinen 
78f7018c21STomi Valkeinen 	/* add */
79f7018c21STomi Valkeinen 	list_add_tail(&panel->node, &panel_list);
80f7018c21STomi Valkeinen 
81f7018c21STomi Valkeinen 	/* try to register to path */
82f7018c21STomi Valkeinen 	list_for_each_entry(path, &path_list, node) {
83f7018c21STomi Valkeinen 		if (!strcmp(panel->plat_path_name, path->name)) {
84f7018c21STomi Valkeinen 			dev_info(panel->dev, "connect to path %s\n",
85f7018c21STomi Valkeinen 				path->name);
86f7018c21STomi Valkeinen 			path->panel = panel;
87f7018c21STomi Valkeinen 			break;
88f7018c21STomi Valkeinen 		}
89f7018c21STomi Valkeinen 	}
90f7018c21STomi Valkeinen 
91f7018c21STomi Valkeinen 	mutex_unlock(&disp_lock);
92f7018c21STomi Valkeinen }
93f7018c21STomi Valkeinen EXPORT_SYMBOL_GPL(mmp_register_panel);
94f7018c21STomi Valkeinen 
95f7018c21STomi Valkeinen /*
96f7018c21STomi Valkeinen  * mmp_unregister_panel - unregister panel from panel_list and disconnect
97f7018c21STomi Valkeinen  * @p: panel to be unregistered
98f7018c21STomi Valkeinen  *
99f7018c21STomi Valkeinen  * this function provides interface for panel drivers to unregister panel
100f7018c21STomi Valkeinen  * from panel_list and disconnect from path.
101f7018c21STomi Valkeinen  */
mmp_unregister_panel(struct mmp_panel * panel)102f7018c21STomi Valkeinen void mmp_unregister_panel(struct mmp_panel *panel)
103f7018c21STomi Valkeinen {
104f7018c21STomi Valkeinen 	struct mmp_path *path;
105f7018c21STomi Valkeinen 
106f7018c21STomi Valkeinen 	mutex_lock(&disp_lock);
107f7018c21STomi Valkeinen 	list_del(&panel->node);
108f7018c21STomi Valkeinen 
109f7018c21STomi Valkeinen 	list_for_each_entry(path, &path_list, node) {
110f7018c21STomi Valkeinen 		if (path->panel && path->panel == panel) {
111f7018c21STomi Valkeinen 			dev_info(panel->dev, "disconnect from path %s\n",
112f7018c21STomi Valkeinen 				path->name);
113f7018c21STomi Valkeinen 			path->panel = NULL;
114f7018c21STomi Valkeinen 			break;
115f7018c21STomi Valkeinen 		}
116f7018c21STomi Valkeinen 	}
117f7018c21STomi Valkeinen 	mutex_unlock(&disp_lock);
118f7018c21STomi Valkeinen }
119f7018c21STomi Valkeinen EXPORT_SYMBOL_GPL(mmp_unregister_panel);
120f7018c21STomi Valkeinen 
121f7018c21STomi Valkeinen /*
122f7018c21STomi Valkeinen  * mmp_get_path - get path by name
123f7018c21STomi Valkeinen  * @p: path name
124f7018c21STomi Valkeinen  *
125f7018c21STomi Valkeinen  * this function checks path name in path_list and return matching path
126f7018c21STomi Valkeinen  * return NULL if no matching path
127f7018c21STomi Valkeinen  */
mmp_get_path(const char * name)128f7018c21STomi Valkeinen struct mmp_path *mmp_get_path(const char *name)
129f7018c21STomi Valkeinen {
130*610323d8SJakob Koschel 	struct mmp_path *path = NULL, *iter;
131f7018c21STomi Valkeinen 
132f7018c21STomi Valkeinen 	mutex_lock(&disp_lock);
133*610323d8SJakob Koschel 	list_for_each_entry(iter, &path_list, node) {
134*610323d8SJakob Koschel 		if (!strcmp(name, iter->name)) {
135*610323d8SJakob Koschel 			path = iter;
136f7018c21STomi Valkeinen 			break;
137f7018c21STomi Valkeinen 		}
138f7018c21STomi Valkeinen 	}
139f7018c21STomi Valkeinen 	mutex_unlock(&disp_lock);
140f7018c21STomi Valkeinen 
141*610323d8SJakob Koschel 	return path;
142f7018c21STomi Valkeinen }
143f7018c21STomi Valkeinen EXPORT_SYMBOL_GPL(mmp_get_path);
144f7018c21STomi Valkeinen 
145f7018c21STomi Valkeinen /*
146f7018c21STomi Valkeinen  * mmp_register_path - init and register path by path_info
147f7018c21STomi Valkeinen  * @p: path info provided by display controller
148f7018c21STomi Valkeinen  *
149f7018c21STomi Valkeinen  * this function init by path info and register path to path_list
150f7018c21STomi Valkeinen  * this function also try to connect path with panel by name
151f7018c21STomi Valkeinen  */
mmp_register_path(struct mmp_path_info * info)152f7018c21STomi Valkeinen struct mmp_path *mmp_register_path(struct mmp_path_info *info)
153f7018c21STomi Valkeinen {
154f7018c21STomi Valkeinen 	int i;
155f7018c21STomi Valkeinen 	struct mmp_path *path = NULL;
156f7018c21STomi Valkeinen 	struct mmp_panel *panel;
157f7018c21STomi Valkeinen 
15806b1f4b9SGustavo A. R. Silva 	path = kzalloc(struct_size(path, overlays, info->overlay_num),
15906b1f4b9SGustavo A. R. Silva 		       GFP_KERNEL);
160f7018c21STomi Valkeinen 	if (!path)
161f7018c21STomi Valkeinen 		return NULL;
162f7018c21STomi Valkeinen 
163f7018c21STomi Valkeinen 	/* path set */
164f7018c21STomi Valkeinen 	mutex_init(&path->access_ok);
165f7018c21STomi Valkeinen 	path->dev = info->dev;
166f7018c21STomi Valkeinen 	path->id = info->id;
167f7018c21STomi Valkeinen 	path->name = info->name;
168f7018c21STomi Valkeinen 	path->output_type = info->output_type;
169f7018c21STomi Valkeinen 	path->overlay_num = info->overlay_num;
170f7018c21STomi Valkeinen 	path->plat_data = info->plat_data;
171f7018c21STomi Valkeinen 	path->ops.set_mode = info->set_mode;
172f7018c21STomi Valkeinen 
173f7018c21STomi Valkeinen 	mutex_lock(&disp_lock);
174f7018c21STomi Valkeinen 	/* get panel */
175f7018c21STomi Valkeinen 	list_for_each_entry(panel, &panel_list, node) {
176f7018c21STomi Valkeinen 		if (!strcmp(info->name, panel->plat_path_name)) {
177f7018c21STomi Valkeinen 			dev_info(path->dev, "get panel %s\n", panel->name);
178f7018c21STomi Valkeinen 			path->panel = panel;
179f7018c21STomi Valkeinen 			break;
180f7018c21STomi Valkeinen 		}
181f7018c21STomi Valkeinen 	}
182f7018c21STomi Valkeinen 
183f7018c21STomi Valkeinen 	dev_info(path->dev, "register %s, overlay_num %d\n",
184f7018c21STomi Valkeinen 			path->name, path->overlay_num);
185f7018c21STomi Valkeinen 
186f7018c21STomi Valkeinen 	/* default op set: if already set by driver, never cover it */
187f7018c21STomi Valkeinen 	if (!path->ops.check_status)
188f7018c21STomi Valkeinen 		path->ops.check_status = path_check_status;
189f7018c21STomi Valkeinen 	if (!path->ops.get_overlay)
190f7018c21STomi Valkeinen 		path->ops.get_overlay = path_get_overlay;
191f7018c21STomi Valkeinen 	if (!path->ops.get_modelist)
192f7018c21STomi Valkeinen 		path->ops.get_modelist = path_get_modelist;
193f7018c21STomi Valkeinen 
194f7018c21STomi Valkeinen 	/* step3: init overlays */
195f7018c21STomi Valkeinen 	for (i = 0; i < path->overlay_num; i++) {
196f7018c21STomi Valkeinen 		path->overlays[i].path = path;
197f7018c21STomi Valkeinen 		path->overlays[i].id = i;
198f7018c21STomi Valkeinen 		mutex_init(&path->overlays[i].access_ok);
199f7018c21STomi Valkeinen 		path->overlays[i].ops = info->overlay_ops;
200f7018c21STomi Valkeinen 	}
201f7018c21STomi Valkeinen 
202f7018c21STomi Valkeinen 	/* add to pathlist */
203f7018c21STomi Valkeinen 	list_add_tail(&path->node, &path_list);
204f7018c21STomi Valkeinen 
205f7018c21STomi Valkeinen 	mutex_unlock(&disp_lock);
206f7018c21STomi Valkeinen 	return path;
207f7018c21STomi Valkeinen }
208f7018c21STomi Valkeinen EXPORT_SYMBOL_GPL(mmp_register_path);
209f7018c21STomi Valkeinen 
210f7018c21STomi Valkeinen /*
2119e09d00fSMarkus Elfring  * mmp_unregister_path - unregister and destroy path
21223c12eacSMarkus Elfring  * @p: path to be destroyed.
213f7018c21STomi Valkeinen  *
2149e09d00fSMarkus Elfring  * this function registers path and destroys it.
215f7018c21STomi Valkeinen  */
mmp_unregister_path(struct mmp_path * path)216f7018c21STomi Valkeinen void mmp_unregister_path(struct mmp_path *path)
217f7018c21STomi Valkeinen {
218f7018c21STomi Valkeinen 	int i;
219f7018c21STomi Valkeinen 
220f7018c21STomi Valkeinen 	if (!path)
221f7018c21STomi Valkeinen 		return;
222f7018c21STomi Valkeinen 
223f7018c21STomi Valkeinen 	mutex_lock(&disp_lock);
224f7018c21STomi Valkeinen 	/* del from pathlist */
225f7018c21STomi Valkeinen 	list_del(&path->node);
226f7018c21STomi Valkeinen 
227f7018c21STomi Valkeinen 	/* deinit overlays */
228f7018c21STomi Valkeinen 	for (i = 0; i < path->overlay_num; i++)
229f7018c21STomi Valkeinen 		mutex_destroy(&path->overlays[i].access_ok);
230f7018c21STomi Valkeinen 
231f7018c21STomi Valkeinen 	mutex_destroy(&path->access_ok);
232f7018c21STomi Valkeinen 
233f7018c21STomi Valkeinen 	kfree(path);
234f7018c21STomi Valkeinen 	mutex_unlock(&disp_lock);
235f7018c21STomi Valkeinen }
236f7018c21STomi Valkeinen EXPORT_SYMBOL_GPL(mmp_unregister_path);
237c1530ac5SArnd Bergmann 
238c1530ac5SArnd Bergmann MODULE_AUTHOR("Zhou Zhu <zzhu3@marvell.com>");
239c1530ac5SArnd Bergmann MODULE_DESCRIPTION("Marvell MMP display framework");
240c1530ac5SArnd Bergmann MODULE_LICENSE("GPL");
241