2 * Samsung S5P/EXYNOS SoC series MIPI CSIS/DSIM DPHY driver
4 * Copyright (C) 2013 Samsung Electronics Co., Ltd.
5 * Author: Sylwester Nawrocki <s.nawrocki@samsung.com>
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.
12 #include <linux/err.h>
14 #include <linux/kernel.h>
15 #include <linux/module.h>
17 #include <linux/of_address.h>
18 #include <linux/phy/phy.h>
19 #include <linux/platform_device.h>
20 #include <linux/spinlock.h>
22 /* MIPI_PHYn_CONTROL register offset: n = 0..1 */
23 #define EXYNOS_MIPI_PHY_CONTROL(n) ((n) * 4)
24 #define EXYNOS_MIPI_PHY_ENABLE (1 << 0)
25 #define EXYNOS_MIPI_PHY_SRESETN (1 << 1)
26 #define EXYNOS_MIPI_PHY_MRESETN (1 << 2)
27 #define EXYNOS_MIPI_PHY_RESET_MASK (3 << 1)
29 enum exynos_mipi_phy_id
{
30 EXYNOS_MIPI_PHY_ID_CSIS0
,
31 EXYNOS_MIPI_PHY_ID_DSIM0
,
32 EXYNOS_MIPI_PHY_ID_CSIS1
,
33 EXYNOS_MIPI_PHY_ID_DSIM1
,
37 #define is_mipi_dsim_phy_id(id) \
38 ((id) == EXYNOS_MIPI_PHY_ID_DSIM0 || (id) == EXYNOS_MIPI_PHY_ID_DSIM1)
40 struct exynos_mipi_video_phy
{
42 struct video_phy_desc
{
45 } phys
[EXYNOS_MIPI_PHYS_NUM
];
49 static int __set_phy_state(struct exynos_mipi_video_phy
*state
,
50 enum exynos_mipi_phy_id id
, unsigned int on
)
55 addr
= state
->regs
+ EXYNOS_MIPI_PHY_CONTROL(id
/ 2);
57 if (is_mipi_dsim_phy_id(id
))
58 reset
= EXYNOS_MIPI_PHY_MRESETN
;
60 reset
= EXYNOS_MIPI_PHY_SRESETN
;
62 spin_lock(&state
->slock
);
70 /* Clear ENABLE bit only if MRESETN, SRESETN bits are not set. */
72 reg
|= EXYNOS_MIPI_PHY_ENABLE
;
73 else if (!(reg
& EXYNOS_MIPI_PHY_RESET_MASK
))
74 reg
&= ~EXYNOS_MIPI_PHY_ENABLE
;
77 spin_unlock(&state
->slock
);
81 #define to_mipi_video_phy(desc) \
82 container_of((desc), struct exynos_mipi_video_phy, phys[(desc)->index]);
84 static int exynos_mipi_video_phy_power_on(struct phy
*phy
)
86 struct video_phy_desc
*phy_desc
= phy_get_drvdata(phy
);
87 struct exynos_mipi_video_phy
*state
= to_mipi_video_phy(phy_desc
);
89 return __set_phy_state(state
, phy_desc
->index
, 1);
92 static int exynos_mipi_video_phy_power_off(struct phy
*phy
)
94 struct video_phy_desc
*phy_desc
= phy_get_drvdata(phy
);
95 struct exynos_mipi_video_phy
*state
= to_mipi_video_phy(phy_desc
);
97 return __set_phy_state(state
, phy_desc
->index
, 0);
100 static struct phy
*exynos_mipi_video_phy_xlate(struct device
*dev
,
101 struct of_phandle_args
*args
)
103 struct exynos_mipi_video_phy
*state
= dev_get_drvdata(dev
);
105 if (WARN_ON(args
->args
[0] >= EXYNOS_MIPI_PHYS_NUM
))
106 return ERR_PTR(-ENODEV
);
108 return state
->phys
[args
->args
[0]].phy
;
111 static struct phy_ops exynos_mipi_video_phy_ops
= {
112 .power_on
= exynos_mipi_video_phy_power_on
,
113 .power_off
= exynos_mipi_video_phy_power_off
,
114 .owner
= THIS_MODULE
,
117 static int exynos_mipi_video_phy_probe(struct platform_device
*pdev
)
119 struct exynos_mipi_video_phy
*state
;
120 struct device
*dev
= &pdev
->dev
;
121 struct resource
*res
;
122 struct phy_provider
*phy_provider
;
125 state
= devm_kzalloc(dev
, sizeof(*state
), GFP_KERNEL
);
129 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
131 state
->regs
= devm_ioremap_resource(dev
, res
);
132 if (IS_ERR(state
->regs
))
133 return PTR_ERR(state
->regs
);
135 dev_set_drvdata(dev
, state
);
136 spin_lock_init(&state
->slock
);
138 for (i
= 0; i
< EXYNOS_MIPI_PHYS_NUM
; i
++) {
139 struct phy
*phy
= devm_phy_create(dev
, NULL
,
140 &exynos_mipi_video_phy_ops
, NULL
);
142 dev_err(dev
, "failed to create PHY %d\n", i
);
146 state
->phys
[i
].phy
= phy
;
147 state
->phys
[i
].index
= i
;
148 phy_set_drvdata(phy
, &state
->phys
[i
]);
151 phy_provider
= devm_of_phy_provider_register(dev
,
152 exynos_mipi_video_phy_xlate
);
154 return PTR_ERR_OR_ZERO(phy_provider
);
157 static const struct of_device_id exynos_mipi_video_phy_of_match
[] = {
158 { .compatible
= "samsung,s5pv210-mipi-video-phy" },
161 MODULE_DEVICE_TABLE(of
, exynos_mipi_video_phy_of_match
);
163 static struct platform_driver exynos_mipi_video_phy_driver
= {
164 .probe
= exynos_mipi_video_phy_probe
,
166 .of_match_table
= exynos_mipi_video_phy_of_match
,
167 .name
= "exynos-mipi-video-phy",
170 module_platform_driver(exynos_mipi_video_phy_driver
);
172 MODULE_DESCRIPTION("Samsung S5P/EXYNOS SoC MIPI CSI-2/DSI PHY driver");
173 MODULE_AUTHOR("Sylwester Nawrocki <s.nawrocki@samsung.com>");
174 MODULE_LICENSE("GPL v2");