Commit | Line | Data |
---|---|---|
069d2e26 SN |
1 | /* |
2 | * Samsung S5P/EXYNOS SoC series MIPI CSIS/DSIM DPHY driver | |
3 | * | |
71f5c63c | 4 | * Copyright (C) 2013,2016 Samsung Electronics Co., Ltd. |
069d2e26 SN |
5 | * Author: Sylwester Nawrocki <s.nawrocki@samsung.com> |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License version 2 as | |
9 | * published by the Free Software Foundation. | |
10 | */ | |
11 | ||
22fda307 | 12 | #include <linux/err.h> |
069d2e26 SN |
13 | #include <linux/io.h> |
14 | #include <linux/kernel.h> | |
e4b3d380 | 15 | #include <linux/mfd/syscon/exynos4-pmu.h> |
71f5c63c | 16 | #include <linux/mfd/syscon/exynos5-pmu.h> |
069d2e26 SN |
17 | #include <linux/module.h> |
18 | #include <linux/of.h> | |
19 | #include <linux/of_address.h> | |
97a3042f | 20 | #include <linux/of_device.h> |
069d2e26 | 21 | #include <linux/phy/phy.h> |
e4b3d380 | 22 | #include <linux/regmap.h> |
069d2e26 | 23 | #include <linux/spinlock.h> |
e4b3d380 | 24 | #include <linux/mfd/syscon.h> |
069d2e26 | 25 | |
069d2e26 | 26 | enum exynos_mipi_phy_id { |
97a3042f | 27 | EXYNOS_MIPI_PHY_ID_NONE = -1, |
069d2e26 SN |
28 | EXYNOS_MIPI_PHY_ID_CSIS0, |
29 | EXYNOS_MIPI_PHY_ID_DSIM0, | |
30 | EXYNOS_MIPI_PHY_ID_CSIS1, | |
31 | EXYNOS_MIPI_PHY_ID_DSIM1, | |
71f5c63c | 32 | EXYNOS_MIPI_PHY_ID_CSIS2, |
069d2e26 SN |
33 | EXYNOS_MIPI_PHYS_NUM |
34 | }; | |
35 | ||
97a3042f MS |
36 | enum exynos_mipi_phy_regmap_id { |
37 | EXYNOS_MIPI_REGMAP_PMU, | |
71f5c63c MS |
38 | EXYNOS_MIPI_REGMAP_DISP, |
39 | EXYNOS_MIPI_REGMAP_CAM0, | |
40 | EXYNOS_MIPI_REGMAP_CAM1, | |
97a3042f MS |
41 | EXYNOS_MIPI_REGMAPS_NUM |
42 | }; | |
43 | ||
44 | struct mipi_phy_device_desc { | |
45 | int num_phys; | |
46 | int num_regmaps; | |
47 | const char *regmap_names[EXYNOS_MIPI_REGMAPS_NUM]; | |
48 | struct exynos_mipi_phy_desc { | |
49 | enum exynos_mipi_phy_id coupled_phy_id; | |
50 | u32 enable_val; | |
51 | unsigned int enable_reg; | |
52 | enum exynos_mipi_phy_regmap_id enable_map; | |
53 | u32 resetn_val; | |
54 | unsigned int resetn_reg; | |
55 | enum exynos_mipi_phy_regmap_id resetn_map; | |
56 | } phys[EXYNOS_MIPI_PHYS_NUM]; | |
57 | }; | |
58 | ||
59 | static const struct mipi_phy_device_desc s5pv210_mipi_phy = { | |
60 | .num_regmaps = 1, | |
61 | .regmap_names = {"syscon"}, | |
62 | .num_phys = 4, | |
63 | .phys = { | |
64 | { | |
65 | /* EXYNOS_MIPI_PHY_ID_CSIS0 */ | |
66 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_DSIM0, | |
67 | .enable_val = EXYNOS4_MIPI_PHY_ENABLE, | |
68 | .enable_reg = EXYNOS4_MIPI_PHY_CONTROL(0), | |
69 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
70 | .resetn_val = EXYNOS4_MIPI_PHY_SRESETN, | |
71 | .resetn_reg = EXYNOS4_MIPI_PHY_CONTROL(0), | |
72 | .resetn_map = EXYNOS_MIPI_REGMAP_PMU, | |
73 | }, { | |
74 | /* EXYNOS_MIPI_PHY_ID_DSIM0 */ | |
75 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_CSIS0, | |
76 | .enable_val = EXYNOS4_MIPI_PHY_ENABLE, | |
77 | .enable_reg = EXYNOS4_MIPI_PHY_CONTROL(0), | |
78 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
79 | .resetn_val = EXYNOS4_MIPI_PHY_MRESETN, | |
80 | .resetn_reg = EXYNOS4_MIPI_PHY_CONTROL(0), | |
81 | .resetn_map = EXYNOS_MIPI_REGMAP_PMU, | |
82 | }, { | |
83 | /* EXYNOS_MIPI_PHY_ID_CSIS1 */ | |
84 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_DSIM1, | |
85 | .enable_val = EXYNOS4_MIPI_PHY_ENABLE, | |
86 | .enable_reg = EXYNOS4_MIPI_PHY_CONTROL(1), | |
87 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
88 | .resetn_val = EXYNOS4_MIPI_PHY_SRESETN, | |
89 | .resetn_reg = EXYNOS4_MIPI_PHY_CONTROL(1), | |
90 | .resetn_map = EXYNOS_MIPI_REGMAP_PMU, | |
91 | }, { | |
92 | /* EXYNOS_MIPI_PHY_ID_DSIM1 */ | |
93 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_CSIS1, | |
94 | .enable_val = EXYNOS4_MIPI_PHY_ENABLE, | |
95 | .enable_reg = EXYNOS4_MIPI_PHY_CONTROL(1), | |
96 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
97 | .resetn_val = EXYNOS4_MIPI_PHY_MRESETN, | |
98 | .resetn_reg = EXYNOS4_MIPI_PHY_CONTROL(1), | |
99 | .resetn_map = EXYNOS_MIPI_REGMAP_PMU, | |
100 | }, | |
101 | }, | |
102 | }; | |
103 | ||
71f5c63c MS |
104 | static const struct mipi_phy_device_desc exynos5420_mipi_phy = { |
105 | .num_regmaps = 1, | |
106 | .regmap_names = {"syscon"}, | |
107 | .num_phys = 5, | |
108 | .phys = { | |
109 | { | |
110 | /* EXYNOS_MIPI_PHY_ID_CSIS0 */ | |
111 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_DSIM0, | |
112 | .enable_val = EXYNOS5_PHY_ENABLE, | |
113 | .enable_reg = EXYNOS5420_MIPI_PHY0_CONTROL, | |
114 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
115 | .resetn_val = EXYNOS5_MIPI_PHY_S_RESETN, | |
116 | .resetn_reg = EXYNOS5420_MIPI_PHY0_CONTROL, | |
117 | .resetn_map = EXYNOS_MIPI_REGMAP_PMU, | |
118 | }, { | |
119 | /* EXYNOS_MIPI_PHY_ID_DSIM0 */ | |
120 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_CSIS0, | |
121 | .enable_val = EXYNOS5_PHY_ENABLE, | |
122 | .enable_reg = EXYNOS5420_MIPI_PHY0_CONTROL, | |
123 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
124 | .resetn_val = EXYNOS5_MIPI_PHY_M_RESETN, | |
125 | .resetn_reg = EXYNOS5420_MIPI_PHY0_CONTROL, | |
126 | .resetn_map = EXYNOS_MIPI_REGMAP_PMU, | |
127 | }, { | |
128 | /* EXYNOS_MIPI_PHY_ID_CSIS1 */ | |
129 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_DSIM1, | |
130 | .enable_val = EXYNOS5_PHY_ENABLE, | |
131 | .enable_reg = EXYNOS5420_MIPI_PHY1_CONTROL, | |
132 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
133 | .resetn_val = EXYNOS5_MIPI_PHY_S_RESETN, | |
134 | .resetn_reg = EXYNOS5420_MIPI_PHY1_CONTROL, | |
135 | .resetn_map = EXYNOS_MIPI_REGMAP_PMU, | |
136 | }, { | |
137 | /* EXYNOS_MIPI_PHY_ID_DSIM1 */ | |
138 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_CSIS1, | |
139 | .enable_val = EXYNOS5_PHY_ENABLE, | |
140 | .enable_reg = EXYNOS5420_MIPI_PHY1_CONTROL, | |
141 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
142 | .resetn_val = EXYNOS5_MIPI_PHY_M_RESETN, | |
143 | .resetn_reg = EXYNOS5420_MIPI_PHY1_CONTROL, | |
144 | .resetn_map = EXYNOS_MIPI_REGMAP_PMU, | |
145 | }, { | |
146 | /* EXYNOS_MIPI_PHY_ID_CSIS2 */ | |
147 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_NONE, | |
148 | .enable_val = EXYNOS5_PHY_ENABLE, | |
149 | .enable_reg = EXYNOS5420_MIPI_PHY2_CONTROL, | |
150 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
151 | .resetn_val = EXYNOS5_MIPI_PHY_S_RESETN, | |
152 | .resetn_reg = EXYNOS5420_MIPI_PHY2_CONTROL, | |
153 | .resetn_map = EXYNOS_MIPI_REGMAP_PMU, | |
154 | }, | |
155 | }, | |
156 | }; | |
157 | ||
158 | #define EXYNOS5433_SYSREG_DISP_MIPI_PHY 0x100C | |
159 | #define EXYNOS5433_SYSREG_CAM0_MIPI_DPHY_CON 0x1014 | |
160 | #define EXYNOS5433_SYSREG_CAM1_MIPI_DPHY_CON 0x1020 | |
161 | ||
162 | static const struct mipi_phy_device_desc exynos5433_mipi_phy = { | |
163 | .num_regmaps = 4, | |
164 | .regmap_names = { | |
165 | "samsung,pmu-syscon", | |
166 | "samsung,disp-sysreg", | |
167 | "samsung,cam0-sysreg", | |
168 | "samsung,cam1-sysreg" | |
169 | }, | |
170 | .num_phys = 5, | |
171 | .phys = { | |
172 | { | |
173 | /* EXYNOS_MIPI_PHY_ID_CSIS0 */ | |
174 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_DSIM0, | |
175 | .enable_val = EXYNOS5_PHY_ENABLE, | |
176 | .enable_reg = EXYNOS5433_MIPI_PHY0_CONTROL, | |
177 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
178 | .resetn_val = BIT(0), | |
179 | .resetn_reg = EXYNOS5433_SYSREG_CAM0_MIPI_DPHY_CON, | |
180 | .resetn_map = EXYNOS_MIPI_REGMAP_CAM0, | |
181 | }, { | |
182 | /* EXYNOS_MIPI_PHY_ID_DSIM0 */ | |
183 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_CSIS0, | |
184 | .enable_val = EXYNOS5_PHY_ENABLE, | |
185 | .enable_reg = EXYNOS5433_MIPI_PHY0_CONTROL, | |
186 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
187 | .resetn_val = BIT(0), | |
188 | .resetn_reg = EXYNOS5433_SYSREG_DISP_MIPI_PHY, | |
189 | .resetn_map = EXYNOS_MIPI_REGMAP_DISP, | |
190 | }, { | |
191 | /* EXYNOS_MIPI_PHY_ID_CSIS1 */ | |
192 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_NONE, | |
193 | .enable_val = EXYNOS5_PHY_ENABLE, | |
194 | .enable_reg = EXYNOS5433_MIPI_PHY1_CONTROL, | |
195 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
196 | .resetn_val = BIT(1), | |
197 | .resetn_reg = EXYNOS5433_SYSREG_CAM0_MIPI_DPHY_CON, | |
198 | .resetn_map = EXYNOS_MIPI_REGMAP_CAM0, | |
199 | }, { | |
200 | /* EXYNOS_MIPI_PHY_ID_DSIM1 */ | |
201 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_NONE, | |
202 | .enable_val = EXYNOS5_PHY_ENABLE, | |
203 | .enable_reg = EXYNOS5433_MIPI_PHY1_CONTROL, | |
204 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
205 | .resetn_val = BIT(1), | |
206 | .resetn_reg = EXYNOS5433_SYSREG_DISP_MIPI_PHY, | |
207 | .resetn_map = EXYNOS_MIPI_REGMAP_DISP, | |
208 | }, { | |
209 | /* EXYNOS_MIPI_PHY_ID_CSIS2 */ | |
210 | .coupled_phy_id = EXYNOS_MIPI_PHY_ID_NONE, | |
211 | .enable_val = EXYNOS5_PHY_ENABLE, | |
212 | .enable_reg = EXYNOS5433_MIPI_PHY2_CONTROL, | |
213 | .enable_map = EXYNOS_MIPI_REGMAP_PMU, | |
214 | .resetn_val = BIT(0), | |
215 | .resetn_reg = EXYNOS5433_SYSREG_CAM1_MIPI_DPHY_CON, | |
216 | .resetn_map = EXYNOS_MIPI_REGMAP_CAM1, | |
217 | }, | |
218 | }, | |
219 | }; | |
069d2e26 SN |
220 | |
221 | struct exynos_mipi_video_phy { | |
97a3042f MS |
222 | struct regmap *regmaps[EXYNOS_MIPI_REGMAPS_NUM]; |
223 | int num_phys; | |
069d2e26 SN |
224 | struct video_phy_desc { |
225 | struct phy *phy; | |
226 | unsigned int index; | |
97a3042f | 227 | const struct exynos_mipi_phy_desc *data; |
069d2e26 | 228 | } phys[EXYNOS_MIPI_PHYS_NUM]; |
e4b3d380 | 229 | spinlock_t slock; |
069d2e26 SN |
230 | }; |
231 | ||
97a3042f MS |
232 | static inline int __is_running(const struct exynos_mipi_phy_desc *data, |
233 | struct exynos_mipi_video_phy *state) | |
069d2e26 | 234 | { |
97a3042f | 235 | u32 val; |
069d2e26 | 236 | |
97a3042f MS |
237 | regmap_read(state->regmaps[data->resetn_map], data->resetn_reg, &val); |
238 | return val & data->resetn_val; | |
239 | } | |
240 | ||
241 | static int __set_phy_state(const struct exynos_mipi_phy_desc *data, | |
242 | struct exynos_mipi_video_phy *state, unsigned int on) | |
243 | { | |
244 | u32 val; | |
e4b3d380 | 245 | |
af69decc AL |
246 | spin_lock(&state->slock); |
247 | ||
97a3042f MS |
248 | /* disable in PMU sysreg */ |
249 | if (!on && data->coupled_phy_id >= 0 && | |
250 | !__is_running(state->phys[data->coupled_phy_id].data, state)) { | |
251 | regmap_read(state->regmaps[data->enable_map], data->enable_reg, | |
252 | &val); | |
253 | val &= ~data->enable_val; | |
254 | regmap_write(state->regmaps[data->enable_map], data->enable_reg, | |
255 | val); | |
256 | } | |
257 | ||
258 | /* PHY reset */ | |
259 | regmap_read(state->regmaps[data->resetn_map], data->resetn_reg, &val); | |
260 | val = on ? (val | data->resetn_val) : (val & ~data->resetn_val); | |
261 | regmap_write(state->regmaps[data->resetn_map], data->resetn_reg, val); | |
262 | ||
263 | /* enable in PMU sysreg */ | |
264 | if (on) { | |
265 | regmap_read(state->regmaps[data->enable_map], data->enable_reg, | |
266 | &val); | |
267 | val |= data->enable_val; | |
268 | regmap_write(state->regmaps[data->enable_map], data->enable_reg, | |
269 | val); | |
270 | } | |
069d2e26 | 271 | |
af69decc | 272 | spin_unlock(&state->slock); |
97a3042f | 273 | |
069d2e26 SN |
274 | return 0; |
275 | } | |
276 | ||
277 | #define to_mipi_video_phy(desc) \ | |
97a3042f | 278 | container_of((desc), struct exynos_mipi_video_phy, phys[(desc)->index]) |
069d2e26 SN |
279 | |
280 | static int exynos_mipi_video_phy_power_on(struct phy *phy) | |
281 | { | |
282 | struct video_phy_desc *phy_desc = phy_get_drvdata(phy); | |
283 | struct exynos_mipi_video_phy *state = to_mipi_video_phy(phy_desc); | |
284 | ||
97a3042f | 285 | return __set_phy_state(phy_desc->data, state, 1); |
069d2e26 SN |
286 | } |
287 | ||
288 | static int exynos_mipi_video_phy_power_off(struct phy *phy) | |
289 | { | |
290 | struct video_phy_desc *phy_desc = phy_get_drvdata(phy); | |
291 | struct exynos_mipi_video_phy *state = to_mipi_video_phy(phy_desc); | |
292 | ||
97a3042f | 293 | return __set_phy_state(phy_desc->data, state, 0); |
069d2e26 SN |
294 | } |
295 | ||
296 | static struct phy *exynos_mipi_video_phy_xlate(struct device *dev, | |
297 | struct of_phandle_args *args) | |
298 | { | |
299 | struct exynos_mipi_video_phy *state = dev_get_drvdata(dev); | |
300 | ||
97a3042f | 301 | if (WARN_ON(args->args[0] >= state->num_phys)) |
069d2e26 SN |
302 | return ERR_PTR(-ENODEV); |
303 | ||
304 | return state->phys[args->args[0]].phy; | |
305 | } | |
306 | ||
4a9e5ca1 | 307 | static const struct phy_ops exynos_mipi_video_phy_ops = { |
069d2e26 SN |
308 | .power_on = exynos_mipi_video_phy_power_on, |
309 | .power_off = exynos_mipi_video_phy_power_off, | |
310 | .owner = THIS_MODULE, | |
311 | }; | |
312 | ||
313 | static int exynos_mipi_video_phy_probe(struct platform_device *pdev) | |
314 | { | |
97a3042f | 315 | const struct mipi_phy_device_desc *phy_dev; |
069d2e26 SN |
316 | struct exynos_mipi_video_phy *state; |
317 | struct device *dev = &pdev->dev; | |
97a3042f | 318 | struct device_node *np = dev->of_node; |
069d2e26 SN |
319 | struct phy_provider *phy_provider; |
320 | unsigned int i; | |
321 | ||
97a3042f MS |
322 | phy_dev = of_device_get_match_data(dev); |
323 | if (!phy_dev) | |
324 | return -ENODEV; | |
325 | ||
069d2e26 SN |
326 | state = devm_kzalloc(dev, sizeof(*state), GFP_KERNEL); |
327 | if (!state) | |
328 | return -ENOMEM; | |
329 | ||
97a3042f MS |
330 | for (i = 0; i < phy_dev->num_regmaps; i++) { |
331 | state->regmaps[i] = syscon_regmap_lookup_by_phandle(np, | |
332 | phy_dev->regmap_names[i]); | |
333 | if (IS_ERR(state->regmaps[i])) | |
334 | return PTR_ERR(state->regmaps[i]); | |
335 | } | |
336 | state->num_phys = phy_dev->num_phys; | |
337 | spin_lock_init(&state->slock); | |
069d2e26 SN |
338 | |
339 | dev_set_drvdata(dev, state); | |
069d2e26 | 340 | |
97a3042f | 341 | for (i = 0; i < state->num_phys; i++) { |
f0ed8176 | 342 | struct phy *phy = devm_phy_create(dev, NULL, |
dbc98635 | 343 | &exynos_mipi_video_phy_ops); |
069d2e26 SN |
344 | if (IS_ERR(phy)) { |
345 | dev_err(dev, "failed to create PHY %d\n", i); | |
346 | return PTR_ERR(phy); | |
347 | } | |
348 | ||
349 | state->phys[i].phy = phy; | |
350 | state->phys[i].index = i; | |
97a3042f | 351 | state->phys[i].data = &phy_dev->phys[i]; |
069d2e26 SN |
352 | phy_set_drvdata(phy, &state->phys[i]); |
353 | } | |
354 | ||
64fe1891 KVA |
355 | phy_provider = devm_of_phy_provider_register(dev, |
356 | exynos_mipi_video_phy_xlate); | |
64fe1891 | 357 | |
22fda307 | 358 | return PTR_ERR_OR_ZERO(phy_provider); |
069d2e26 SN |
359 | } |
360 | ||
361 | static const struct of_device_id exynos_mipi_video_phy_of_match[] = { | |
97a3042f MS |
362 | { |
363 | .compatible = "samsung,s5pv210-mipi-video-phy", | |
364 | .data = &s5pv210_mipi_phy, | |
71f5c63c MS |
365 | }, { |
366 | .compatible = "samsung,exynos5420-mipi-video-phy", | |
367 | .data = &exynos5420_mipi_phy, | |
368 | }, { | |
369 | .compatible = "samsung,exynos5433-mipi-video-phy", | |
370 | .data = &exynos5433_mipi_phy, | |
97a3042f MS |
371 | }, |
372 | { /* sentinel */ }, | |
069d2e26 SN |
373 | }; |
374 | MODULE_DEVICE_TABLE(of, exynos_mipi_video_phy_of_match); | |
375 | ||
376 | static struct platform_driver exynos_mipi_video_phy_driver = { | |
377 | .probe = exynos_mipi_video_phy_probe, | |
378 | .driver = { | |
379 | .of_match_table = exynos_mipi_video_phy_of_match, | |
380 | .name = "exynos-mipi-video-phy", | |
069d2e26 SN |
381 | } |
382 | }; | |
383 | module_platform_driver(exynos_mipi_video_phy_driver); | |
384 | ||
385 | MODULE_DESCRIPTION("Samsung S5P/EXYNOS SoC MIPI CSI-2/DSI PHY driver"); | |
386 | MODULE_AUTHOR("Sylwester Nawrocki <s.nawrocki@samsung.com>"); | |
387 | MODULE_LICENSE("GPL v2"); |