1// SPDX-License-Identifier: GPL-2.0+
2/*
3 * StarFive JH7110 DPHY RX driver
4 *
5 * Copyright (C) 2023 StarFive Technology Co., Ltd.
6 * Author: Jack Zhu <jack.zhu@starfivetech.com>
7 * Author: Changhuang Liang <changhuang.liang@starfivetech.com>
8 */
9
10#include <linux/bitfield.h>
11#include <linux/bitops.h>
12#include <linux/clk.h>
13#include <linux/io.h>
14#include <linux/module.h>
15#include <linux/of.h>
16#include <linux/phy/phy.h>
17#include <linux/platform_device.h>
18#include <linux/pm_runtime.h>
19#include <linux/reset.h>
20
21#define STF_DPHY_APBCFGSAIF_SYSCFG(x) (x)
22
23#define STF_DPHY_ENABLE_CLK BIT(6)
24#define STF_DPHY_ENABLE_CLK1 BIT(7)
25#define STF_DPHY_ENABLE_LAN0 BIT(8)
26#define STF_DPHY_ENABLE_LAN1 BIT(9)
27#define STF_DPHY_ENABLE_LAN2 BIT(10)
28#define STF_DPHY_ENABLE_LAN3 BIT(11)
29#define STF_DPHY_LANE_SWAP_CLK GENMASK(22, 20)
30#define STF_DPHY_LANE_SWAP_CLK1 GENMASK(25, 23)
31#define STF_DPHY_LANE_SWAP_LAN0 GENMASK(28, 26)
32#define STF_DPHY_LANE_SWAP_LAN1 GENMASK(31, 29)
33
34#define STF_DPHY_LANE_SWAP_LAN2 GENMASK(2, 0)
35#define STF_DPHY_LANE_SWAP_LAN3 GENMASK(5, 3)
36#define STF_DPHY_PLL_CLK_SEL GENMASK(21, 12)
37#define STF_DPHY_PRECOUNTER_IN_CLK GENMASK(29, 22)
38
39#define STF_DPHY_PRECOUNTER_IN_CLK1 GENMASK(7, 0)
40#define STF_DPHY_PRECOUNTER_IN_LAN0 GENMASK(15, 8)
41#define STF_DPHY_PRECOUNTER_IN_LAN1 GENMASK(23, 16)
42#define STF_DPHY_PRECOUNTER_IN_LAN2 GENMASK(31, 24)
43
44#define STF_DPHY_PRECOUNTER_IN_LAN3 GENMASK(7, 0)
45#define STF_DPHY_RX_1C2C_SEL BIT(8)
46
47#define STF_MAP_LANES_NUM 6
48
49struct regval {
50 u32 addr;
51 u32 val;
52};
53
54struct stf_dphy_info {
55 /**
56 * @maps:
57 *
58 * Physical lanes and logic lanes mapping table.
59 *
60 * The default order is:
61 * [clk lane0, data lane 0, data lane 1, data lane 2, date lane 3, clk lane 1]
62 */
63 u8 maps[STF_MAP_LANES_NUM];
64};
65
66struct stf_dphy {
67 struct device *dev;
68 void __iomem *regs;
69 struct clk *cfg_clk;
70 struct clk *ref_clk;
71 struct clk *tx_clk;
72 struct reset_control *rstc;
73 struct regulator *mipi_0p9;
74 struct phy *phy;
75 const struct stf_dphy_info *info;
76};
77
78static int stf_dphy_configure(struct phy *phy, union phy_configure_opts *opts)
79{
80 struct stf_dphy *dphy = phy_get_drvdata(phy);
81 const struct stf_dphy_info *info = dphy->info;
82
83 writel(FIELD_PREP(STF_DPHY_ENABLE_CLK, 1) |
84 FIELD_PREP(STF_DPHY_ENABLE_CLK1, 1) |
85 FIELD_PREP(STF_DPHY_ENABLE_LAN0, 1) |
86 FIELD_PREP(STF_DPHY_ENABLE_LAN1, 1) |
87 FIELD_PREP(STF_DPHY_ENABLE_LAN2, 1) |
88 FIELD_PREP(STF_DPHY_ENABLE_LAN3, 1) |
89 FIELD_PREP(STF_DPHY_LANE_SWAP_CLK, info->maps[0]) |
90 FIELD_PREP(STF_DPHY_LANE_SWAP_CLK1, info->maps[5]) |
91 FIELD_PREP(STF_DPHY_LANE_SWAP_LAN0, info->maps[1]) |
92 FIELD_PREP(STF_DPHY_LANE_SWAP_LAN1, info->maps[2]),
93 addr: dphy->regs + STF_DPHY_APBCFGSAIF_SYSCFG(188));
94
95 writel(FIELD_PREP(STF_DPHY_LANE_SWAP_LAN2, info->maps[3]) |
96 FIELD_PREP(STF_DPHY_LANE_SWAP_LAN3, info->maps[4]) |
97 FIELD_PREP(STF_DPHY_PRECOUNTER_IN_CLK, 8),
98 addr: dphy->regs + STF_DPHY_APBCFGSAIF_SYSCFG(192));
99
100 writel(FIELD_PREP(STF_DPHY_PRECOUNTER_IN_CLK1, 8) |
101 FIELD_PREP(STF_DPHY_PRECOUNTER_IN_LAN0, 7) |
102 FIELD_PREP(STF_DPHY_PRECOUNTER_IN_LAN1, 7) |
103 FIELD_PREP(STF_DPHY_PRECOUNTER_IN_LAN2, 7),
104 addr: dphy->regs + STF_DPHY_APBCFGSAIF_SYSCFG(196));
105
106 writel(FIELD_PREP(STF_DPHY_PRECOUNTER_IN_LAN3, 7),
107 addr: dphy->regs + STF_DPHY_APBCFGSAIF_SYSCFG(200));
108
109 return 0;
110}
111
112static int stf_dphy_power_on(struct phy *phy)
113{
114 struct stf_dphy *dphy = phy_get_drvdata(phy);
115 int ret;
116
117 ret = pm_runtime_resume_and_get(dev: dphy->dev);
118 if (ret < 0)
119 return ret;
120
121 ret = regulator_enable(regulator: dphy->mipi_0p9);
122 if (ret) {
123 pm_runtime_put(dev: dphy->dev);
124 return ret;
125 }
126
127 clk_set_rate(clk: dphy->cfg_clk, rate: 99000000);
128 clk_set_rate(clk: dphy->ref_clk, rate: 49500000);
129 clk_set_rate(clk: dphy->tx_clk, rate: 19800000);
130 reset_control_deassert(rstc: dphy->rstc);
131
132 return 0;
133}
134
135static int stf_dphy_power_off(struct phy *phy)
136{
137 struct stf_dphy *dphy = phy_get_drvdata(phy);
138
139 reset_control_assert(rstc: dphy->rstc);
140
141 regulator_disable(regulator: dphy->mipi_0p9);
142
143 pm_runtime_put_sync(dev: dphy->dev);
144
145 return 0;
146}
147
148static const struct phy_ops stf_dphy_ops = {
149 .configure = stf_dphy_configure,
150 .power_on = stf_dphy_power_on,
151 .power_off = stf_dphy_power_off,
152};
153
154static int stf_dphy_probe(struct platform_device *pdev)
155{
156 struct phy_provider *phy_provider;
157 struct stf_dphy *dphy;
158
159 dphy = devm_kzalloc(dev: &pdev->dev, size: sizeof(*dphy), GFP_KERNEL);
160 if (!dphy)
161 return -ENOMEM;
162
163 dphy->info = of_device_get_match_data(dev: &pdev->dev);
164
165 dev_set_drvdata(dev: &pdev->dev, data: dphy);
166 dphy->dev = &pdev->dev;
167
168 dphy->regs = devm_platform_ioremap_resource(pdev, index: 0);
169 if (IS_ERR(ptr: dphy->regs))
170 return PTR_ERR(ptr: dphy->regs);
171
172 dphy->cfg_clk = devm_clk_get(dev: &pdev->dev, id: "cfg");
173 if (IS_ERR(ptr: dphy->cfg_clk))
174 return PTR_ERR(ptr: dphy->cfg_clk);
175
176 dphy->ref_clk = devm_clk_get(dev: &pdev->dev, id: "ref");
177 if (IS_ERR(ptr: dphy->ref_clk))
178 return PTR_ERR(ptr: dphy->ref_clk);
179
180 dphy->tx_clk = devm_clk_get(dev: &pdev->dev, id: "tx");
181 if (IS_ERR(ptr: dphy->tx_clk))
182 return PTR_ERR(ptr: dphy->tx_clk);
183
184 dphy->rstc = devm_reset_control_array_get_exclusive(dev: &pdev->dev);
185 if (IS_ERR(ptr: dphy->rstc))
186 return PTR_ERR(ptr: dphy->rstc);
187
188 dphy->mipi_0p9 = devm_regulator_get(dev: &pdev->dev, id: "mipi_0p9");
189 if (IS_ERR(ptr: dphy->mipi_0p9))
190 return PTR_ERR(ptr: dphy->mipi_0p9);
191
192 dphy->phy = devm_phy_create(dev: &pdev->dev, NULL, ops: &stf_dphy_ops);
193 if (IS_ERR(ptr: dphy->phy)) {
194 dev_err(&pdev->dev, "Failed to create PHY\n");
195 return PTR_ERR(ptr: dphy->phy);
196 }
197
198 pm_runtime_enable(dev: &pdev->dev);
199
200 phy_set_drvdata(phy: dphy->phy, data: dphy);
201 phy_provider = devm_of_phy_provider_register(&pdev->dev,
202 of_phy_simple_xlate);
203
204 return PTR_ERR_OR_ZERO(ptr: phy_provider);
205}
206
207static const struct stf_dphy_info starfive_dphy_info = {
208 .maps = {4, 0, 1, 2, 3, 5},
209};
210
211static const struct of_device_id stf_dphy_dt_ids[] = {
212 {
213 .compatible = "starfive,jh7110-dphy-rx",
214 .data = &starfive_dphy_info,
215 },
216 { /* sentinel */ },
217};
218MODULE_DEVICE_TABLE(of, stf_dphy_dt_ids);
219
220static struct platform_driver stf_dphy_driver = {
221 .probe = stf_dphy_probe,
222 .driver = {
223 .name = "starfive-dphy-rx",
224 .of_match_table = stf_dphy_dt_ids,
225 },
226};
227module_platform_driver(stf_dphy_driver);
228
229MODULE_AUTHOR("Jack Zhu <jack.zhu@starfivetech.com>");
230MODULE_AUTHOR("Changhuang Liang <changhuang.liang@starfivetech.com>");
231MODULE_DESCRIPTION("StarFive JH7110 DPHY RX driver");
232MODULE_LICENSE("GPL");
233

source code of linux/drivers/phy/starfive/phy-jh7110-dphy-rx.c