1 #include <linux/module.h> 2 #include <linux/platform_device.h> 3 #include <linux/err.h> 4 #include <linux/of.h> 5 #include <linux/io.h> 6 #include <linux/delay.h> 7 #include "am35x-phy-control.h" 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 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 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: 77 WARN_ON(1); 78 return; 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); 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); 98 } 99 100 static const struct phy_control ctrl_am335x = { 101 .phy_power = am335x_phy_power, 102 .phy_wkup = am335x_phy_wkup, 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); 129 if (!dev) 130 return NULL; 131 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); 153 if (!ctrl_usb) 154 return -ENOMEM; 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); 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 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", 179 .of_match_table = omap_control_usb_id_table, 180 }, 181 }; 182 183 module_platform_driver(am335x_control_driver); 184 MODULE_LICENSE("GPL v2"); 185