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