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