1 // SPDX-License-Identifier: GPL-2.0+ OR BSD-3-Clause
2 /*
3  * Copyright (C) 2019, STMicroelectronics - All Rights Reserved
4  */
5 
6 #include <common.h>
7 #include <display.h>
8 #include <dm.h>
9 #include <dsi_host.h>
10 
11 /**
12  * struct sandbox_dsi_host_priv - private data for driver
13  * @device: DSI peripheral device
14  * @timing: Display timings
15  * @max_data_lanes: maximum number of data lines
16  * @phy_ops: set of function pointers for performing physical operations
17  */
18 struct sandbox_dsi_host_priv {
19 	struct mipi_dsi_device *device;
20 	struct display_timing *timings;
21 	unsigned int max_data_lanes;
22 	const struct mipi_dsi_phy_ops *phy_ops;
23 };
24 
sandbox_dsi_host_init(struct udevice * dev,struct mipi_dsi_device * device,struct display_timing * timings,unsigned int max_data_lanes,const struct mipi_dsi_phy_ops * phy_ops)25 static int sandbox_dsi_host_init(struct udevice *dev,
26 				 struct mipi_dsi_device *device,
27 				 struct display_timing *timings,
28 				 unsigned int max_data_lanes,
29 				 const struct mipi_dsi_phy_ops *phy_ops)
30 {
31 	struct sandbox_dsi_host_priv *priv = dev_get_priv(dev);
32 
33 	if (!device)
34 		return -1;
35 
36 	if (!timings)
37 		return -2;
38 
39 	if (max_data_lanes == 0)
40 		return -3;
41 
42 	if (!phy_ops)
43 		return -4;
44 
45 	if (!phy_ops->init || !phy_ops->get_lane_mbps ||
46 	    !phy_ops->post_set_mode)
47 		return -5;
48 
49 	priv->max_data_lanes = max_data_lanes;
50 	priv->phy_ops = phy_ops;
51 	priv->timings = timings;
52 	priv->device = device;
53 
54 	return 0;
55 }
56 
sandbox_dsi_host_enable(struct udevice * dev)57 static int sandbox_dsi_host_enable(struct udevice *dev)
58 {
59 	struct sandbox_dsi_host_priv *priv = dev_get_priv(dev);
60 	unsigned int lane_mbps;
61 	int ret;
62 
63 	priv->phy_ops->init(priv->device);
64 	ret = priv->phy_ops->get_lane_mbps(priv->device, priv->timings, 2,
65 					   MIPI_DSI_FMT_RGB888, &lane_mbps);
66 	if (ret)
67 		return -1;
68 
69 	priv->phy_ops->post_set_mode(priv->device, MIPI_DSI_MODE_VIDEO);
70 
71 	return 0;
72 }
73 
74 struct dsi_host_ops sandbox_dsi_host_ops = {
75 	.init = sandbox_dsi_host_init,
76 	.enable = sandbox_dsi_host_enable,
77 };
78 
79 static const struct udevice_id sandbox_dsi_host_ids[] = {
80 	{ .compatible = "sandbox,dsi-host"},
81 	{ }
82 };
83 
84 U_BOOT_DRIVER(sandbox_dsi_host) = {
85 	.name		      = "sandbox-dsi-host",
86 	.id		      = UCLASS_DSI_HOST,
87 	.of_match	      = sandbox_dsi_host_ids,
88 	.ops		      = &sandbox_dsi_host_ops,
89 	.priv_auto	= sizeof(struct sandbox_dsi_host_priv),
90 };
91