1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Copyright (c) 2017 Rockchip Electronics Co. Ltd.
4 *
5 * Author: Wyon Bi <bivvy.bi@rock-chips.com>
6 */
7
8 #include <linux/clk.h>
9 #include <linux/delay.h>
10 #include <linux/err.h>
11 #include <linux/mfd/rk618.h>
12 #include <linux/mfd/syscon.h>
13 #include <linux/module.h>
14 #include <linux/of_device.h>
15 #include <linux/regmap.h>
16
17 #include <drm/drm_of.h>
18 #include <drm/drm_drv.h>
19 #include <video/videomode.h>
20
21 #define RK618_VIF0_REG0 0x0000
22 #define VIF_ENABLE HIWORD_UPDATE(1, 0, 0)
23 #define VIF_DISABLE HIWORD_UPDATE(0, 0, 0)
24 #define RK618_VIF0_REG1 0x0004
25 #define VIF_FRAME_VST(x) UPDATE(x, 27, 16)
26 #define VIF_FRAME_HST(x) UPDATE(x, 11, 0)
27 #define RK618_VIF0_REG2 0x0008
28 #define VIF_HS_END(x) UPDATE(x, 23, 16)
29 #define VIF_HTOTAL(x) UPDATE(x, 11, 0)
30 #define RK618_VIF0_REG3 0x000c
31 #define VIF_HACT_END(x) UPDATE(x, 27, 16)
32 #define VIF_HACT_ST(x) UPDATE(x, 11, 0)
33 #define RK618_VIF0_REG4 0x0010
34 #define VIF_VS_END(x) UPDATE(x, 23, 16)
35 #define VIF_VTOTAL(x) UPDATE(x, 11, 0)
36 #define RK618_VIF0_REG5 0x0014
37 #define VIF_VACT_END(x) UPDATE(x, 27, 16)
38 #define VIF_VACT_ST(x) UPDATE(x, 11, 0)
39 #define RK618_VIF1_REG0 0x0018
40 #define RK618_VIF1_REG1 0x001c
41 #define RK618_VIF1_REG2 0x0020
42 #define RK618_VIF1_REG3 0x0024
43 #define RK618_VIF1_REG4 0x0028
44 #define RK618_VIF1_REG5 0x002c
45
46 struct rk618_vif {
47 struct drm_bridge base;
48 struct drm_bridge *bridge;
49 struct drm_display_mode mode;
50 struct device *dev;
51 struct regmap *regmap;
52 struct clk *vif_clk;
53 struct clk *vif_pre_clk;
54 };
55
bridge_to_vif(struct drm_bridge * bridge)56 static inline struct rk618_vif *bridge_to_vif(struct drm_bridge *bridge)
57 {
58 return container_of(bridge, struct rk618_vif, base);
59 }
60
rk618_vif_enable(struct rk618_vif * vif)61 static void rk618_vif_enable(struct rk618_vif *vif)
62 {
63 regmap_write(vif->regmap, RK618_VIF0_REG0, VIF_ENABLE);
64 }
65
rk618_vif_disable(struct rk618_vif * vif)66 static void rk618_vif_disable(struct rk618_vif *vif)
67 {
68 regmap_write(vif->regmap, RK618_VIF0_REG0, VIF_DISABLE);
69 }
70
rk618_vif_init(struct rk618_vif * vif,const struct drm_display_mode * mode)71 static void rk618_vif_init(struct rk618_vif *vif,
72 const struct drm_display_mode *mode)
73 {
74 struct videomode vm;
75 u32 vif_frame_vst, vif_frame_hst;
76 u32 vif_hs_end, vif_htotal, vif_hact_end, vif_hact_st;
77 u32 vif_vs_end, vif_vtotal, vif_vact_end, vif_vact_st;
78
79 drm_display_mode_to_videomode(mode, &vm);
80
81 if (!strcmp(mode->name, "1920x1080")) {
82 vif_frame_vst = 0x001;
83 vif_frame_hst = 0x0cb;
84 } else if (!strcmp(mode->name, "1600x900")) {
85 vif_frame_vst = 0x001;
86 vif_frame_hst = 0x327;
87 } else if (!strcmp(mode->name, "1280x720")) {
88 vif_frame_vst = 0x001;
89 vif_frame_hst = 0x0cf;
90 } else {
91 vif_frame_vst = 0x001;
92 vif_frame_hst = 0x001;
93 }
94
95 dev_dbg(vif->dev, "vif_frame_vst=%d, vif_frame_hst=%d\n",
96 vif_frame_vst, vif_frame_hst);
97
98 vif_hs_end = vm.hsync_len;
99 vif_htotal = vm.hsync_len + vm.hback_porch + vm.hfront_porch +
100 vm.hactive;
101 vif_hact_end = vm.hsync_len + vm.hback_porch + vm.hactive;
102 vif_hact_st = vm.hsync_len + vm.hback_porch;
103 vif_vs_end = vm.vsync_len;
104 vif_vtotal = vm.vsync_len + vm.vback_porch + vm.vfront_porch +
105 vm.vactive;
106 vif_vact_end = vm.vsync_len + vm.vback_porch + vm.vactive;
107 vif_vact_st = vm.vsync_len + vm.vback_porch;
108
109 regmap_write(vif->regmap, RK618_VIF0_REG1,
110 VIF_FRAME_VST(vif_frame_vst) |
111 VIF_FRAME_HST(vif_frame_hst));
112 regmap_write(vif->regmap, RK618_VIF0_REG2,
113 VIF_HS_END(vif_hs_end) | VIF_HTOTAL(vif_htotal));
114 regmap_write(vif->regmap, RK618_VIF0_REG3,
115 VIF_HACT_END(vif_hact_end) | VIF_HACT_ST(vif_hact_st));
116 regmap_write(vif->regmap, RK618_VIF0_REG4,
117 VIF_VS_END(vif_vs_end) | VIF_VTOTAL(vif_vtotal));
118 regmap_write(vif->regmap, RK618_VIF0_REG5,
119 VIF_VACT_END(vif_vact_end) | VIF_VACT_ST(vif_vact_st));
120 }
121
rk618_vif_bridge_enable(struct drm_bridge * bridge)122 static void rk618_vif_bridge_enable(struct drm_bridge *bridge)
123 {
124 struct rk618_vif *vif = bridge_to_vif(bridge);
125 const struct drm_display_mode *mode = &vif->mode;
126 long rate;
127
128 clk_set_parent(vif->vif_clk, vif->vif_pre_clk);
129
130 rate = clk_round_rate(vif->vif_clk, mode->clock * 1000);
131 clk_set_rate(vif->vif_clk, rate);
132 clk_prepare_enable(vif->vif_clk);
133
134 rk618_vif_disable(vif);
135 rk618_vif_init(vif, mode);
136 rk618_vif_enable(vif);
137 }
138
rk618_vif_bridge_disable(struct drm_bridge * bridge)139 static void rk618_vif_bridge_disable(struct drm_bridge *bridge)
140 {
141 struct rk618_vif *vif = bridge_to_vif(bridge);
142
143 rk618_vif_disable(vif);
144 clk_disable_unprepare(vif->vif_clk);
145 }
146
rk618_vif_bridge_mode_set(struct drm_bridge * bridge,const struct drm_display_mode * mode,const struct drm_display_mode * adjusted)147 static void rk618_vif_bridge_mode_set(struct drm_bridge *bridge,
148 const struct drm_display_mode *mode,
149 const struct drm_display_mode *adjusted)
150 {
151 struct rk618_vif *vif = bridge_to_vif(bridge);
152
153 drm_mode_copy(&vif->mode, adjusted);
154 }
155
rk618_vif_bridge_attach(struct drm_bridge * bridge,enum drm_bridge_attach_flags flags)156 static int rk618_vif_bridge_attach(struct drm_bridge *bridge,
157 enum drm_bridge_attach_flags flags)
158 {
159 struct rk618_vif *vif = bridge_to_vif(bridge);
160 struct device *dev = vif->dev;
161 struct device_node *endpoint;
162 int ret;
163
164 endpoint = of_graph_get_endpoint_by_regs(dev->of_node, 1, -1);
165 if (endpoint && of_device_is_available(endpoint)) {
166 struct device_node *remote;
167
168 remote = of_graph_get_remote_port_parent(endpoint);
169 of_node_put(endpoint);
170 if (!remote || !of_device_is_available(remote))
171 return -ENODEV;
172
173 vif->bridge = of_drm_find_bridge(remote);
174 of_node_put(remote);
175 if (!vif->bridge)
176 return -EPROBE_DEFER;
177
178 ret = drm_bridge_attach(bridge->encoder, vif->bridge, bridge, 0);
179 if (ret) {
180 dev_err(dev, "failed to attach bridge\n");
181 return ret;
182 }
183 }
184
185 return 0;
186 }
187
188 static const struct drm_bridge_funcs rk618_vif_bridge_funcs = {
189 .enable = rk618_vif_bridge_enable,
190 .disable = rk618_vif_bridge_disable,
191 .mode_set = rk618_vif_bridge_mode_set,
192 .attach = rk618_vif_bridge_attach,
193 };
194
rk618_vif_probe(struct platform_device * pdev)195 static int rk618_vif_probe(struct platform_device *pdev)
196 {
197 struct rk618 *rk618 = dev_get_drvdata(pdev->dev.parent);
198 struct device *dev = &pdev->dev;
199 struct rk618_vif *vif;
200 int ret;
201
202 if (!of_device_is_available(dev->of_node))
203 return -ENODEV;
204
205 vif = devm_kzalloc(dev, sizeof(*vif), GFP_KERNEL);
206 if (!vif)
207 return -ENOMEM;
208
209 vif->dev = dev;
210 vif->regmap = rk618->regmap;
211 platform_set_drvdata(pdev, vif);
212
213 vif->vif_clk = devm_clk_get(dev, "vif");
214 if (IS_ERR(vif->vif_clk)) {
215 ret = PTR_ERR(vif->vif_clk);
216 dev_err(dev, "failed to get vif clock: %d\n", ret);
217 return ret;
218 }
219
220 vif->vif_pre_clk = devm_clk_get(dev, "vif_pre");
221 if (IS_ERR(vif->vif_pre_clk)) {
222 ret = PTR_ERR(vif->vif_pre_clk);
223 dev_err(dev, "failed to get vif pre clock: %d\n", ret);
224 return ret;
225 }
226
227 vif->base.funcs = &rk618_vif_bridge_funcs;
228 vif->base.of_node = dev->of_node;
229 drm_bridge_add(&vif->base);
230
231 return 0;
232 }
233
rk618_vif_remove(struct platform_device * pdev)234 static int rk618_vif_remove(struct platform_device *pdev)
235 {
236 struct rk618_vif *vif = platform_get_drvdata(pdev);
237
238 drm_bridge_remove(&vif->base);
239
240 return 0;
241 }
242
243 static const struct of_device_id rk618_vif_of_match[] = {
244 { .compatible = "rockchip,rk618-vif", },
245 {},
246 };
247 MODULE_DEVICE_TABLE(of, rk618_vif_of_match);
248
249 static struct platform_driver rk618_vif_driver = {
250 .driver = {
251 .name = "rk618-vif",
252 .of_match_table = of_match_ptr(rk618_vif_of_match),
253 },
254 .probe = rk618_vif_probe,
255 .remove = rk618_vif_remove,
256 };
257 module_platform_driver(rk618_vif_driver);
258
259 MODULE_AUTHOR("Wyon Bi <bivvy.bi@rock-chips.com>");
260 MODULE_DESCRIPTION("Rockchip RK618 VIF driver");
261 MODULE_LICENSE("GPL v2");
262