]>
Commit | Line | Data |
---|---|---|
3bb869c8 SAS |
1 | #include <linux/module.h> |
2 | #include <linux/platform_device.h> | |
8b841cb2 | 3 | #include <linux/err.h> |
3bb869c8 SAS |
4 | #include <linux/of.h> |
5 | #include <linux/io.h> | |
a31a942a | 6 | #include <linux/delay.h> |
db67bc04 | 7 | #include "am35x-phy-control.h" |
3bb869c8 SAS |
8 | |
9 | struct am335x_control_usb { | |
10 | struct device *dev; | |
11 | void __iomem *phy_reg; | |
12 | void __iomem *wkup; | |
13 | spinlock_t lock; | |
14 | struct phy_control phy_ctrl; | |
15 | }; | |
16 | ||
17 | #define AM335X_USB0_CTRL 0x0 | |
18 | #define AM335X_USB1_CTRL 0x8 | |
19 | #define AM335x_USB_WKUP 0x0 | |
20 | ||
21 | #define USBPHY_CM_PWRDN (1 << 0) | |
22 | #define USBPHY_OTG_PWRDN (1 << 1) | |
23 | #define USBPHY_OTGVDET_EN (1 << 19) | |
24 | #define USBPHY_OTGSESSEND_EN (1 << 20) | |
25 | ||
a1222639 SAS |
26 | #define AM335X_PHY0_WK_EN (1 << 0) |
27 | #define AM335X_PHY1_WK_EN (1 << 8) | |
28 | ||
29 | static void am335x_phy_wkup(struct phy_control *phy_ctrl, u32 id, bool on) | |
30 | { | |
31 | struct am335x_control_usb *usb_ctrl; | |
32 | u32 val; | |
33 | u32 reg; | |
34 | ||
35 | usb_ctrl = container_of(phy_ctrl, struct am335x_control_usb, phy_ctrl); | |
36 | ||
37 | switch (id) { | |
38 | case 0: | |
39 | reg = AM335X_PHY0_WK_EN; | |
40 | break; | |
41 | case 1: | |
42 | reg = AM335X_PHY1_WK_EN; | |
43 | break; | |
44 | default: | |
45 | WARN_ON(1); | |
46 | return; | |
47 | } | |
48 | ||
49 | spin_lock(&usb_ctrl->lock); | |
50 | val = readl(usb_ctrl->wkup); | |
51 | ||
52 | if (on) | |
53 | val |= reg; | |
54 | else | |
55 | val &= ~reg; | |
56 | ||
57 | writel(val, usb_ctrl->wkup); | |
58 | spin_unlock(&usb_ctrl->lock); | |
59 | } | |
60 | ||
3bb869c8 SAS |
61 | static void am335x_phy_power(struct phy_control *phy_ctrl, u32 id, bool on) |
62 | { | |
63 | struct am335x_control_usb *usb_ctrl; | |
64 | u32 val; | |
65 | u32 reg; | |
66 | ||
67 | usb_ctrl = container_of(phy_ctrl, struct am335x_control_usb, phy_ctrl); | |
68 | ||
69 | switch (id) { | |
70 | case 0: | |
71 | reg = AM335X_USB0_CTRL; | |
72 | break; | |
73 | case 1: | |
74 | reg = AM335X_USB1_CTRL; | |
75 | break; | |
76 | default: | |
4ff74571 SAS |
77 | WARN_ON(1); |
78 | return; | |
3bb869c8 SAS |
79 | } |
80 | ||
81 | val = readl(usb_ctrl->phy_reg + reg); | |
82 | if (on) { | |
83 | val &= ~(USBPHY_CM_PWRDN | USBPHY_OTG_PWRDN); | |
84 | val |= USBPHY_OTGVDET_EN | USBPHY_OTGSESSEND_EN; | |
85 | } else { | |
86 | val |= USBPHY_CM_PWRDN | USBPHY_OTG_PWRDN; | |
87 | } | |
88 | ||
89 | writel(val, usb_ctrl->phy_reg + reg); | |
a31a942a DM |
90 | |
91 | /* | |
92 | * Give the PHY ~1ms to complete the power up operation. | |
93 | * Tests have shown unstable behaviour if other USB PHY related | |
94 | * registers are written too shortly after such a transition. | |
95 | */ | |
96 | if (on) | |
97 | mdelay(1); | |
3bb869c8 SAS |
98 | } |
99 | ||
100 | static const struct phy_control ctrl_am335x = { | |
101 | .phy_power = am335x_phy_power, | |
a1222639 | 102 | .phy_wkup = am335x_phy_wkup, |
3bb869c8 SAS |
103 | }; |
104 | ||
105 | static const struct of_device_id omap_control_usb_id_table[] = { | |
106 | { .compatible = "ti,am335x-usb-ctrl-module", .data = &ctrl_am335x }, | |
107 | {} | |
108 | }; | |
109 | MODULE_DEVICE_TABLE(of, omap_control_usb_id_table); | |
110 | ||
111 | static struct platform_driver am335x_control_driver; | |
112 | static int match(struct device *dev, void *data) | |
113 | { | |
114 | struct device_node *node = (struct device_node *)data; | |
115 | return dev->of_node == node && | |
116 | dev->driver == &am335x_control_driver.driver; | |
117 | } | |
118 | ||
119 | struct phy_control *am335x_get_phy_control(struct device *dev) | |
120 | { | |
121 | struct device_node *node; | |
122 | struct am335x_control_usb *ctrl_usb; | |
123 | ||
124 | node = of_parse_phandle(dev->of_node, "ti,ctrl_mod", 0); | |
125 | if (!node) | |
126 | return NULL; | |
127 | ||
128 | dev = bus_find_device(&platform_bus_type, NULL, node, match); | |
d0f347d6 DD |
129 | if (!dev) |
130 | return NULL; | |
131 | ||
3bb869c8 SAS |
132 | ctrl_usb = dev_get_drvdata(dev); |
133 | if (!ctrl_usb) | |
134 | return NULL; | |
135 | return &ctrl_usb->phy_ctrl; | |
136 | } | |
137 | EXPORT_SYMBOL_GPL(am335x_get_phy_control); | |
138 | ||
139 | static int am335x_control_usb_probe(struct platform_device *pdev) | |
140 | { | |
141 | struct resource *res; | |
142 | struct am335x_control_usb *ctrl_usb; | |
143 | const struct of_device_id *of_id; | |
144 | const struct phy_control *phy_ctrl; | |
145 | ||
146 | of_id = of_match_node(omap_control_usb_id_table, pdev->dev.of_node); | |
147 | if (!of_id) | |
148 | return -EINVAL; | |
149 | ||
150 | phy_ctrl = of_id->data; | |
151 | ||
152 | ctrl_usb = devm_kzalloc(&pdev->dev, sizeof(*ctrl_usb), GFP_KERNEL); | |
9aabd032 | 153 | if (!ctrl_usb) |
3bb869c8 | 154 | return -ENOMEM; |
3bb869c8 SAS |
155 | |
156 | ctrl_usb->dev = &pdev->dev; | |
157 | ||
158 | res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "phy_ctrl"); | |
159 | ctrl_usb->phy_reg = devm_ioremap_resource(&pdev->dev, res); | |
160 | if (IS_ERR(ctrl_usb->phy_reg)) | |
161 | return PTR_ERR(ctrl_usb->phy_reg); | |
a1222639 SAS |
162 | |
163 | res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "wakeup"); | |
164 | ctrl_usb->wkup = devm_ioremap_resource(&pdev->dev, res); | |
165 | if (IS_ERR(ctrl_usb->wkup)) | |
166 | return PTR_ERR(ctrl_usb->wkup); | |
167 | ||
3bb869c8 SAS |
168 | spin_lock_init(&ctrl_usb->lock); |
169 | ctrl_usb->phy_ctrl = *phy_ctrl; | |
170 | ||
171 | dev_set_drvdata(ctrl_usb->dev, ctrl_usb); | |
172 | return 0; | |
173 | } | |
174 | ||
175 | static struct platform_driver am335x_control_driver = { | |
176 | .probe = am335x_control_usb_probe, | |
177 | .driver = { | |
178 | .name = "am335x-control-usb", | |
c4df9ae0 | 179 | .of_match_table = omap_control_usb_id_table, |
3bb869c8 SAS |
180 | }, |
181 | }; | |
182 | ||
183 | module_platform_driver(am335x_control_driver); | |
184 | MODULE_LICENSE("GPL v2"); |