diff options
author | Andrey Smirnov <andrew.smirnov@gmail.com> | 2017-03-16 08:04:45 -0700 |
---|---|---|
committer | Sascha Hauer <s.hauer@pengutronix.de> | 2017-03-30 08:23:18 +0200 |
commit | da655ff169661814ecbcc89b8ffde3ae953dd161 (patch) | |
tree | c7971a856d07d02d2c197ca9dff332cfa65a1d92 /drivers/usb/host | |
parent | de6e7f14ee919fc85e03173492fd9dc0bf306cf4 (diff) | |
download | barebox-da655ff169661814ecbcc89b8ffde3ae953dd161.tar.gz barebox-da655ff169661814ecbcc89b8ffde3ae953dd161.tar.xz |
usb: ohci-at91: Add DT support
Acked-by: Sam Ravnborg <sam@ravnborg.org>
Signed-off-by: Andrey Smirnov <andrew.smirnov@gmail.com>
Signed-off-by: Sascha Hauer <s.hauer@pengutronix.de>
Diffstat (limited to 'drivers/usb/host')
-rw-r--r-- | drivers/usb/host/ohci-at91.c | 93 |
1 files changed, 91 insertions, 2 deletions
diff --git a/drivers/usb/host/ohci-at91.c b/drivers/usb/host/ohci-at91.c index 5f745264b7..1013ba39c5 100644 --- a/drivers/usb/host/ohci-at91.c +++ b/drivers/usb/host/ohci-at91.c @@ -23,10 +23,18 @@ #include <usb/usb.h> #include <usb/usb_defs.h> #include <errno.h> +#include <gpio.h> +#include <of_gpio.h> #include <io.h> +#include <mach/board.h> + #include "ohci.h" +#define at91_for_each_port(index) \ + for ((index) = 0; (index) < AT91_MAX_USBH_PORTS; (index)++) + + struct ohci_at91_priv { struct device_d *dev; struct clk *iclk; @@ -59,6 +67,59 @@ static void at91_stop_clock(struct ohci_at91_priv *ohci_at91) clk_disable(ohci_at91->iclk); } +static int at91_ohci_probe_dt(struct device_d *dev) +{ + u32 ports; + int i, ret, gpio; + enum of_gpio_flags flags; + struct at91_usbh_data *pdata; + struct device_node *np = dev->device_node; + + pdata = xzalloc(sizeof(*pdata)); + dev->platform_data = pdata; + + if (!of_property_read_u32(np, "num-ports", &ports)) { + pdata->ports = ports; + } else { + dev_err(dev, "Failed to read 'num-ports' property\n"); + return -EINVAL; + } + + at91_for_each_port(i) { + /* + * do not configure PIO if not in relation with + * real USB port on board + */ + if (i >= pdata->ports) { + pdata->vbus_pin[i] = -EINVAL; + continue; + } + + gpio = of_get_named_gpio_flags(np, "atmel,vbus-gpio", i, + &flags); + pdata->vbus_pin[i] = gpio; + if (!gpio_is_valid(gpio)) + continue; + pdata->vbus_pin_active_low[i] = flags & OF_GPIO_ACTIVE_LOW; + + ret = gpio_request(gpio, "ohci_vbus"); + if (ret) { + dev_err(dev, "can't request vbus gpio %d\n", gpio); + continue; + } + ret = gpio_direction_output(gpio, + !pdata->vbus_pin_active_low[i]); + if (ret) { + dev_err(dev, "can't put vbus gpio %d as output %d\n", + gpio, !pdata->vbus_pin_active_low[i]); + gpio_free(gpio); + continue; + } + } + + return 0; +} + static int at91_ohci_probe(struct device_d *dev) { int ret; @@ -68,6 +129,12 @@ static int at91_ohci_probe(struct device_d *dev) dev->priv = ohci_at91; ohci_at91->dev = dev; + if (dev->device_node) { + ret = at91_ohci_probe_dt(dev); + if (ret < 0) + return ret; + } + io = dev_get_resource(dev, IORESOURCE_MEM, 0); if (IS_ERR(io)) { dev_err(dev, "Failed to get IORESOURCE_MEM\n"); @@ -75,13 +142,13 @@ static int at91_ohci_probe(struct device_d *dev) } ohci_at91->regs = IOMEM(io->start); - ohci_at91->iclk = clk_get(NULL, "ohci_clk"); + ohci_at91->iclk = clk_get(dev, "ohci_clk"); if (IS_ERR(ohci_at91->iclk)) { dev_err(dev, "Failed to get 'ohci_clk'\n"); return PTR_ERR(ohci_at91->iclk); } - ohci_at91->fclk = clk_get(NULL, "uhpck"); + ohci_at91->fclk = clk_get(dev, "uhpck"); if (IS_ERR(ohci_at91->fclk)) { dev_err(dev, "Failed to get 'uhpck'\n"); return PTR_ERR(ohci_at91->fclk); @@ -107,6 +174,7 @@ static int at91_ohci_probe(struct device_d *dev) static void at91_ohci_remove(struct device_d *dev) { + struct at91_usbh_data *pdata = dev->platform_data; struct ohci_at91_priv *ohci_at91 = dev->priv; /* @@ -118,11 +186,32 @@ static void at91_ohci_remove(struct device_d *dev) * Stop the USB clocks. */ at91_stop_clock(ohci_at91); + + if (pdata) { + bool active_low; + int i, gpio; + + at91_for_each_port(i) { + gpio = pdata->vbus_pin[i]; + active_low = pdata->vbus_pin_active_low[i]; + + if (gpio_is_valid(gpio)) { + gpio_set_value(gpio, active_low); + gpio_free(gpio); + } + } + } } +static const struct of_device_id at91_ohci_dt_ids[] = { + { .compatible = "atmel,at91rm9200-ohci" }, + { /* sentinel */ } +}; + static struct driver_d at91_ohci_driver = { .name = "at91_ohci", .probe = at91_ohci_probe, .remove = at91_ohci_remove, + .of_compatible = DRV_OF_COMPAT(at91_ohci_dt_ids), }; device_platform_driver(at91_ohci_driver); |