1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
|
// SPDX-License-Identifier: GPL-2.0
/*
* Copyright (C) 2025 Inochi Amaoto <inochiama@outlook.com>
*/
#include <linux/clk.h>
#include <linux/bitfield.h>
#include <linux/debugfs.h>
#include <linux/kernel.h>
#include <linux/mfd/syscon.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_address.h>
#include <linux/of_gpio.h>
#include <linux/platform_device.h>
#include <linux/phy/phy.h>
#include <linux/regmap.h>
#include <linux/spinlock.h>
#define REG_USB_PHY_CTRL 0x048
#define PHY_VBUS_POWER_EN BIT(0)
#define PHY_VBUS_POWER BIT(1)
#define PHY_ID_OVERWRITE_EN BIT(6)
#define PHY_ID_OVERWRITE_MODE BIT(7)
#define PHY_ID_OVERWRITE_MODE_HOST FIELD_PREP(BIT(7), 0)
#define PHY_ID_OVERWRITE_MODE_DEVICE FIELD_PREP(BIT(7), 1)
#define PHY_APP_CLK_RATE 125000000
#define PHY_LPM_CLK_RATE 12000000
#define PHY_STB_CLK_RATE 333334
struct cv1800_usb_phy {
struct phy *phy;
struct regmap *syscon;
spinlock_t lock;
struct clk *usb_app_clk;
struct clk *usb_lpm_clk;
struct clk *usb_stb_clk;
bool support_otg;
};
static int cv1800_usb_phy_set_mode(struct phy *_phy,
enum phy_mode mode, int submode)
{
struct cv1800_usb_phy *phy = phy_get_drvdata(_phy);
unsigned int regval = 0;
int ret;
dev_info(&phy->phy->dev, "set mode %d", (int)mode);
switch (mode) {
case PHY_MODE_USB_DEVICE:
regval = PHY_ID_OVERWRITE_EN | PHY_ID_OVERWRITE_MODE_DEVICE;
regmap_clear_bits(phy->syscon, REG_USB_PHY_CTRL, PHY_VBUS_POWER);
break;
case PHY_MODE_USB_HOST:
regval = PHY_ID_OVERWRITE_EN | PHY_ID_OVERWRITE_MODE_HOST;
regmap_set_bits(phy->syscon, REG_USB_PHY_CTRL, PHY_VBUS_POWER);
break;
case PHY_MODE_USB_OTG:
if (!phy->support_otg)
return 0;
ret = regmap_read(phy->syscon, REG_USB_PHY_CTRL, ®val);
if (ret)
return ret;
regval = FIELD_GET(PHY_ID_OVERWRITE_MODE, regval);
break;
default:
return -EINVAL;
}
return regmap_update_bits(phy->syscon, REG_USB_PHY_CTRL,
PHY_ID_OVERWRITE_EN | PHY_ID_OVERWRITE_MODE,
regval);
}
static int cv1800_usb_phy_set_clock(struct cv1800_usb_phy *phy)
{
int ret;
ret = clk_set_rate(phy->usb_app_clk, PHY_APP_CLK_RATE);
if (ret)
return ret;
ret = clk_set_rate(phy->usb_lpm_clk, PHY_LPM_CLK_RATE);
if (ret)
return ret;
return clk_set_rate(phy->usb_stb_clk, PHY_STB_CLK_RATE);
}
static const struct phy_ops cv1800_usb_phy_ops = {
.set_mode = cv1800_usb_phy_set_mode,
.owner = THIS_MODULE,
};
static int cv1800_usb_phy_probe(struct platform_device *pdev)
{
struct device *dev = &pdev->dev;
struct device *parent = dev->parent;
struct cv1800_usb_phy *phy;
struct phy_provider *phy_provider;
int ret;
if (!parent)
return -ENODEV;
phy = devm_kmalloc(dev, sizeof(*phy), GFP_KERNEL);
if (!phy)
return -ENOMEM;
phy->syscon = syscon_node_to_regmap(parent->of_node);
if (IS_ERR_OR_NULL(phy->syscon))
return -ENODEV;
phy->support_otg = false;
spin_lock_init(&phy->lock);
phy->usb_app_clk = devm_clk_get_enabled(dev, "app");
if (IS_ERR(phy->usb_app_clk))
return dev_err_probe(dev, PTR_ERR(phy->usb_app_clk),
"Failed to get app clock\n");
phy->usb_lpm_clk = devm_clk_get_enabled(dev, "lpm");
if (IS_ERR(phy->usb_lpm_clk))
return dev_err_probe(dev, PTR_ERR(phy->usb_lpm_clk),
"Failed to get lpm clock\n");
phy->usb_stb_clk = devm_clk_get_enabled(dev, "stb");
if (IS_ERR(phy->usb_stb_clk))
return dev_err_probe(dev, PTR_ERR(phy->usb_stb_clk),
"Failed to get stb clock\n");
phy->phy = devm_phy_create(dev, NULL, &cv1800_usb_phy_ops);
if (IS_ERR(phy->phy))
return dev_err_probe(dev, PTR_ERR(phy->phy),
"Failed to create phy\n");
ret = cv1800_usb_phy_set_clock(phy);
if (ret)
return ret;
phy_set_drvdata(phy->phy, phy);
phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
return PTR_ERR_OR_ZERO(phy_provider);
}
static const struct of_device_id cv1800_usb_phy_ids[] = {
{ .compatible = "sophgo,cv1800b-usb2-phy" },
{ },
};
MODULE_DEVICE_TABLE(of, cv1800_usb_phy_ids);
static struct platform_driver cv1800_usb_phy_driver = {
.probe = cv1800_usb_phy_probe,
.driver = {
.name = "cv1800-usb2-phy",
.of_match_table = cv1800_usb_phy_ids,
},
};
module_platform_driver(cv1800_usb_phy_driver);
MODULE_AUTHOR("Inochi Amaoto <inochiama@outlook.com>");
MODULE_DESCRIPTION("CV1800/SG2000 SoC USB 2.0 PHY driver");
MODULE_LICENSE("GPL");
|
