123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722 |
- /*
- * platform.c - DesignWare HS OTG Controller platform driver
- *
- * Copyright (C) Matthijs Kooijman <matthijs@stdin.nl>
- *
- * Redistribution and use in source and binary forms, with or without
- * modification, are permitted provided that the following conditions
- * are met:
- * 1. Redistributions of source code must retain the above copyright
- * notice, this list of conditions, and the following disclaimer,
- * without modification.
- * 2. Redistributions in binary form must reproduce the above copyright
- * notice, this list of conditions and the following disclaimer in the
- * documentation and/or other materials provided with the distribution.
- * 3. The names of the above-listed copyright holders may not be used
- * to endorse or promote products derived from this software without
- * specific prior written permission.
- *
- * ALTERNATIVELY, this software may be distributed under the terms of the
- * GNU General Public License ("GPL") as published by the Free Software
- * Foundation; either version 2 of the License, or (at your option) any
- * later version.
- *
- * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
- * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
- * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
- * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
- * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
- * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
- * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
- * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
- * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
- * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
- * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- */
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/slab.h>
- #include <linux/clk.h>
- #include <linux/device.h>
- #include <linux/dma-mapping.h>
- #include <linux/of_device.h>
- #include <linux/mutex.h>
- #include <linux/platform_device.h>
- #include <linux/phy/phy.h>
- #include <linux/platform_data/s3c-hsotg.h>
- #include <linux/reset.h>
- #include <linux/usb/of.h>
- #include "core.h"
- #include "hcd.h"
- #include "debug.h"
- static const char dwc2_driver_name[] = "dwc2";
- static const struct dwc2_core_params params_hi6220 = {
- .otg_cap = 2, /* No HNP/SRP capable */
- .otg_ver = 0, /* 1.3 */
- .dma_enable = 1,
- .dma_desc_enable = 0,
- .dma_desc_fs_enable = 0,
- .speed = 0, /* High Speed */
- .enable_dynamic_fifo = 1,
- .en_multiple_tx_fifo = 1,
- .host_rx_fifo_size = 512,
- .host_nperio_tx_fifo_size = 512,
- .host_perio_tx_fifo_size = 512,
- .max_transfer_size = 65535,
- .max_packet_count = 511,
- .host_channels = 16,
- .phy_type = 1, /* UTMI */
- .phy_utmi_width = 8,
- .phy_ulpi_ddr = 0, /* Single */
- .phy_ulpi_ext_vbus = 0,
- .i2c_enable = 0,
- .ulpi_fs_ls = 0,
- .host_support_fs_ls_low_power = 0,
- .host_ls_low_power_phy_clk = 0, /* 48 MHz */
- .ts_dline = 0,
- .reload_ctl = 0,
- .ahbcfg = GAHBCFG_HBSTLEN_INCR16 <<
- GAHBCFG_HBSTLEN_SHIFT,
- .uframe_sched = 0,
- .external_id_pin_ctl = -1,
- .hibernation = -1,
- };
- static const struct dwc2_core_params params_bcm2835 = {
- .otg_cap = 0, /* HNP/SRP capable */
- .otg_ver = 0, /* 1.3 */
- .dma_enable = 1,
- .dma_desc_enable = 0,
- .dma_desc_fs_enable = 0,
- .speed = 0, /* High Speed */
- .enable_dynamic_fifo = 1,
- .en_multiple_tx_fifo = 1,
- .host_rx_fifo_size = 774, /* 774 DWORDs */
- .host_nperio_tx_fifo_size = 256, /* 256 DWORDs */
- .host_perio_tx_fifo_size = 512, /* 512 DWORDs */
- .max_transfer_size = 65535,
- .max_packet_count = 511,
- .host_channels = 8,
- .phy_type = 1, /* UTMI */
- .phy_utmi_width = 8, /* 8 bits */
- .phy_ulpi_ddr = 0, /* Single */
- .phy_ulpi_ext_vbus = 0,
- .i2c_enable = 0,
- .ulpi_fs_ls = 0,
- .host_support_fs_ls_low_power = 0,
- .host_ls_low_power_phy_clk = 0, /* 48 MHz */
- .ts_dline = 0,
- .reload_ctl = 0,
- .ahbcfg = 0x10,
- .uframe_sched = 0,
- .external_id_pin_ctl = -1,
- .hibernation = -1,
- };
- static const struct dwc2_core_params params_rk3066 = {
- .otg_cap = 2, /* non-HNP/non-SRP */
- .otg_ver = -1,
- .dma_enable = -1,
- .dma_desc_enable = 0,
- .dma_desc_fs_enable = 0,
- .speed = -1,
- .enable_dynamic_fifo = 1,
- .en_multiple_tx_fifo = -1,
- .host_rx_fifo_size = 525, /* 525 DWORDs */
- .host_nperio_tx_fifo_size = 128, /* 128 DWORDs */
- .host_perio_tx_fifo_size = 256, /* 256 DWORDs */
- .max_transfer_size = -1,
- .max_packet_count = -1,
- .host_channels = -1,
- .phy_type = -1,
- .phy_utmi_width = -1,
- .phy_ulpi_ddr = -1,
- .phy_ulpi_ext_vbus = -1,
- .i2c_enable = -1,
- .ulpi_fs_ls = -1,
- .host_support_fs_ls_low_power = -1,
- .host_ls_low_power_phy_clk = -1,
- .ts_dline = -1,
- .reload_ctl = -1,
- .ahbcfg = GAHBCFG_HBSTLEN_INCR16 <<
- GAHBCFG_HBSTLEN_SHIFT,
- .uframe_sched = -1,
- .external_id_pin_ctl = -1,
- .hibernation = -1,
- };
- static const struct dwc2_core_params params_ltq = {
- .otg_cap = 2, /* non-HNP/non-SRP */
- .otg_ver = -1,
- .dma_enable = -1,
- .dma_desc_enable = -1,
- .dma_desc_fs_enable = -1,
- .speed = -1,
- .enable_dynamic_fifo = -1,
- .en_multiple_tx_fifo = -1,
- .host_rx_fifo_size = 288, /* 288 DWORDs */
- .host_nperio_tx_fifo_size = 128, /* 128 DWORDs */
- .host_perio_tx_fifo_size = 96, /* 96 DWORDs */
- .max_transfer_size = 65535,
- .max_packet_count = 511,
- .host_channels = -1,
- .phy_type = -1,
- .phy_utmi_width = -1,
- .phy_ulpi_ddr = -1,
- .phy_ulpi_ext_vbus = -1,
- .i2c_enable = -1,
- .ulpi_fs_ls = -1,
- .host_support_fs_ls_low_power = -1,
- .host_ls_low_power_phy_clk = -1,
- .ts_dline = -1,
- .reload_ctl = -1,
- .ahbcfg = GAHBCFG_HBSTLEN_INCR16 <<
- GAHBCFG_HBSTLEN_SHIFT,
- .uframe_sched = -1,
- .external_id_pin_ctl = -1,
- .hibernation = -1,
- };
- static const struct dwc2_core_params params_amlogic = {
- .otg_cap = DWC2_CAP_PARAM_NO_HNP_SRP_CAPABLE,
- .otg_ver = -1,
- .dma_enable = 1,
- .dma_desc_enable = 0,
- .dma_desc_fs_enable = 0,
- .speed = DWC2_SPEED_PARAM_HIGH,
- .enable_dynamic_fifo = 1,
- .en_multiple_tx_fifo = -1,
- .host_rx_fifo_size = 512,
- .host_nperio_tx_fifo_size = 500,
- .host_perio_tx_fifo_size = 500,
- .max_transfer_size = -1,
- .max_packet_count = -1,
- .host_channels = 16,
- .phy_type = DWC2_PHY_TYPE_PARAM_UTMI,
- .phy_utmi_width = -1,
- .phy_ulpi_ddr = -1,
- .phy_ulpi_ext_vbus = -1,
- .i2c_enable = -1,
- .ulpi_fs_ls = -1,
- .host_support_fs_ls_low_power = -1,
- .host_ls_low_power_phy_clk = -1,
- .ts_dline = -1,
- .reload_ctl = 1,
- .ahbcfg = GAHBCFG_HBSTLEN_INCR8 <<
- GAHBCFG_HBSTLEN_SHIFT,
- .uframe_sched = 0,
- .external_id_pin_ctl = -1,
- .hibernation = -1,
- };
- /*
- * Check the dr_mode against the module configuration and hardware
- * capabilities.
- *
- * The hardware, module, and dr_mode, can each be set to host, device,
- * or otg. Check that all these values are compatible and adjust the
- * value of dr_mode if possible.
- *
- * actual
- * HW MOD dr_mode dr_mode
- * ------------------------------
- * HST HST any : HST
- * HST DEV any : ---
- * HST OTG any : HST
- *
- * DEV HST any : ---
- * DEV DEV any : DEV
- * DEV OTG any : DEV
- *
- * OTG HST any : HST
- * OTG DEV any : DEV
- * OTG OTG any : dr_mode
- */
- static int dwc2_get_dr_mode(struct dwc2_hsotg *hsotg)
- {
- enum usb_dr_mode mode;
- hsotg->dr_mode = usb_get_dr_mode(hsotg->dev);
- if (hsotg->dr_mode == USB_DR_MODE_UNKNOWN)
- hsotg->dr_mode = USB_DR_MODE_OTG;
- mode = hsotg->dr_mode;
- if (dwc2_hw_is_device(hsotg)) {
- if (IS_ENABLED(CONFIG_USB_DWC2_HOST)) {
- dev_err(hsotg->dev,
- "Controller does not support host mode.\n");
- return -EINVAL;
- }
- mode = USB_DR_MODE_PERIPHERAL;
- } else if (dwc2_hw_is_host(hsotg)) {
- if (IS_ENABLED(CONFIG_USB_DWC2_PERIPHERAL)) {
- dev_err(hsotg->dev,
- "Controller does not support device mode.\n");
- return -EINVAL;
- }
- mode = USB_DR_MODE_HOST;
- } else {
- if (IS_ENABLED(CONFIG_USB_DWC2_HOST))
- mode = USB_DR_MODE_HOST;
- else if (IS_ENABLED(CONFIG_USB_DWC2_PERIPHERAL))
- mode = USB_DR_MODE_PERIPHERAL;
- }
- if (mode != hsotg->dr_mode) {
- dev_warn(hsotg->dev,
- "Configuration mismatch. dr_mode forced to %s\n",
- mode == USB_DR_MODE_HOST ? "host" : "device");
- hsotg->dr_mode = mode;
- }
- return 0;
- }
- static int __dwc2_lowlevel_hw_enable(struct dwc2_hsotg *hsotg)
- {
- struct platform_device *pdev = to_platform_device(hsotg->dev);
- int ret;
- ret = regulator_bulk_enable(ARRAY_SIZE(hsotg->supplies),
- hsotg->supplies);
- if (ret)
- return ret;
- if (hsotg->clk) {
- ret = clk_prepare_enable(hsotg->clk);
- if (ret)
- return ret;
- }
- if (hsotg->uphy)
- ret = usb_phy_init(hsotg->uphy);
- else if (hsotg->plat && hsotg->plat->phy_init)
- ret = hsotg->plat->phy_init(pdev, hsotg->plat->phy_type);
- else {
- ret = phy_power_on(hsotg->phy);
- if (ret == 0)
- ret = phy_init(hsotg->phy);
- }
- return ret;
- }
- /**
- * dwc2_lowlevel_hw_enable - enable platform lowlevel hw resources
- * @hsotg: The driver state
- *
- * A wrapper for platform code responsible for controlling
- * low-level USB platform resources (phy, clock, regulators)
- */
- int dwc2_lowlevel_hw_enable(struct dwc2_hsotg *hsotg)
- {
- int ret = __dwc2_lowlevel_hw_enable(hsotg);
- if (ret == 0)
- hsotg->ll_hw_enabled = true;
- return ret;
- }
- static int __dwc2_lowlevel_hw_disable(struct dwc2_hsotg *hsotg)
- {
- struct platform_device *pdev = to_platform_device(hsotg->dev);
- int ret = 0;
- if (hsotg->uphy)
- usb_phy_shutdown(hsotg->uphy);
- else if (hsotg->plat && hsotg->plat->phy_exit)
- ret = hsotg->plat->phy_exit(pdev, hsotg->plat->phy_type);
- else {
- ret = phy_exit(hsotg->phy);
- if (ret == 0)
- ret = phy_power_off(hsotg->phy);
- }
- if (ret)
- return ret;
- if (hsotg->clk)
- clk_disable_unprepare(hsotg->clk);
- ret = regulator_bulk_disable(ARRAY_SIZE(hsotg->supplies),
- hsotg->supplies);
- return ret;
- }
- /**
- * dwc2_lowlevel_hw_disable - disable platform lowlevel hw resources
- * @hsotg: The driver state
- *
- * A wrapper for platform code responsible for controlling
- * low-level USB platform resources (phy, clock, regulators)
- */
- int dwc2_lowlevel_hw_disable(struct dwc2_hsotg *hsotg)
- {
- int ret = __dwc2_lowlevel_hw_disable(hsotg);
- if (ret == 0)
- hsotg->ll_hw_enabled = false;
- return ret;
- }
- static int dwc2_lowlevel_hw_init(struct dwc2_hsotg *hsotg)
- {
- int i, ret;
- hsotg->reset = devm_reset_control_get_optional(hsotg->dev, "dwc2");
- if (IS_ERR(hsotg->reset)) {
- ret = PTR_ERR(hsotg->reset);
- switch (ret) {
- case -ENOENT:
- case -ENOTSUPP:
- hsotg->reset = NULL;
- break;
- default:
- dev_err(hsotg->dev, "error getting reset control %d\n",
- ret);
- return ret;
- }
- }
- if (hsotg->reset)
- reset_control_deassert(hsotg->reset);
- /* Set default UTMI width */
- hsotg->phyif = GUSBCFG_PHYIF16;
- /*
- * Attempt to find a generic PHY, then look for an old style
- * USB PHY and then fall back to pdata
- */
- hsotg->phy = devm_phy_get(hsotg->dev, "usb2-phy");
- if (IS_ERR(hsotg->phy)) {
- ret = PTR_ERR(hsotg->phy);
- switch (ret) {
- case -ENODEV:
- case -ENOSYS:
- hsotg->phy = NULL;
- break;
- case -EPROBE_DEFER:
- return ret;
- default:
- dev_err(hsotg->dev, "error getting phy %d\n", ret);
- return ret;
- }
- }
- if (!hsotg->phy) {
- hsotg->uphy = devm_usb_get_phy(hsotg->dev, USB_PHY_TYPE_USB2);
- if (IS_ERR(hsotg->uphy)) {
- ret = PTR_ERR(hsotg->uphy);
- switch (ret) {
- case -ENODEV:
- case -ENXIO:
- hsotg->uphy = NULL;
- break;
- case -EPROBE_DEFER:
- return ret;
- default:
- dev_err(hsotg->dev, "error getting usb phy %d\n",
- ret);
- return ret;
- }
- }
- }
- hsotg->plat = dev_get_platdata(hsotg->dev);
- if (hsotg->phy) {
- /*
- * If using the generic PHY framework, check if the PHY bus
- * width is 8-bit and set the phyif appropriately.
- */
- if (phy_get_bus_width(hsotg->phy) == 8)
- hsotg->phyif = GUSBCFG_PHYIF8;
- }
- /* Clock */
- hsotg->clk = devm_clk_get(hsotg->dev, "otg");
- if (IS_ERR(hsotg->clk)) {
- hsotg->clk = NULL;
- dev_dbg(hsotg->dev, "cannot get otg clock\n");
- }
- /* Regulators */
- for (i = 0; i < ARRAY_SIZE(hsotg->supplies); i++)
- hsotg->supplies[i].supply = dwc2_hsotg_supply_names[i];
- ret = devm_regulator_bulk_get(hsotg->dev, ARRAY_SIZE(hsotg->supplies),
- hsotg->supplies);
- if (ret) {
- dev_err(hsotg->dev, "failed to request supplies: %d\n", ret);
- return ret;
- }
- return 0;
- }
- /**
- * dwc2_driver_remove() - Called when the DWC_otg core is unregistered with the
- * DWC_otg driver
- *
- * @dev: Platform device
- *
- * This routine is called, for example, when the rmmod command is executed. The
- * device may or may not be electrically present. If it is present, the driver
- * stops device processing. Any resources used on behalf of this device are
- * freed.
- */
- static int dwc2_driver_remove(struct platform_device *dev)
- {
- struct dwc2_hsotg *hsotg = platform_get_drvdata(dev);
- dwc2_debugfs_exit(hsotg);
- if (hsotg->hcd_enabled)
- dwc2_hcd_remove(hsotg);
- if (hsotg->gadget_enabled)
- dwc2_hsotg_remove(hsotg);
- if (hsotg->ll_hw_enabled)
- dwc2_lowlevel_hw_disable(hsotg);
- if (hsotg->reset)
- reset_control_assert(hsotg->reset);
- return 0;
- }
- /**
- * dwc2_driver_shutdown() - Called on device shutdown
- *
- * @dev: Platform device
- *
- * In specific conditions (involving usb hubs) dwc2 devices can create a
- * lot of interrupts, even to the point of overwhelming devices running
- * at low frequencies. Some devices need to do special clock handling
- * at shutdown-time which may bring the system clock below the threshold
- * of being able to handle the dwc2 interrupts. Disabling dwc2-irqs
- * prevents reboots/poweroffs from getting stuck in such cases.
- */
- static void dwc2_driver_shutdown(struct platform_device *dev)
- {
- struct dwc2_hsotg *hsotg = platform_get_drvdata(dev);
- disable_irq(hsotg->irq);
- }
- static const struct of_device_id dwc2_of_match_table[] = {
- { .compatible = "brcm,bcm2835-usb", .data = ¶ms_bcm2835 },
- { .compatible = "hisilicon,hi6220-usb", .data = ¶ms_hi6220 },
- { .compatible = "rockchip,rk3066-usb", .data = ¶ms_rk3066 },
- { .compatible = "lantiq,arx100-usb", .data = ¶ms_ltq },
- { .compatible = "lantiq,xrx200-usb", .data = ¶ms_ltq },
- { .compatible = "snps,dwc2", .data = NULL },
- { .compatible = "samsung,s3c6400-hsotg", .data = NULL},
- { .compatible = "amlogic,meson8b-usb", .data = ¶ms_amlogic },
- { .compatible = "amlogic,meson-gxbb-usb", .data = ¶ms_amlogic },
- {},
- };
- MODULE_DEVICE_TABLE(of, dwc2_of_match_table);
- /**
- * dwc2_driver_probe() - Called when the DWC_otg core is bound to the DWC_otg
- * driver
- *
- * @dev: Platform device
- *
- * This routine creates the driver components required to control the device
- * (core, HCD, and PCD) and initializes the device. The driver components are
- * stored in a dwc2_hsotg structure. A reference to the dwc2_hsotg is saved
- * in the device private data. This allows the driver to access the dwc2_hsotg
- * structure on subsequent calls to driver methods for this device.
- */
- static int dwc2_driver_probe(struct platform_device *dev)
- {
- const struct of_device_id *match;
- const struct dwc2_core_params *params;
- struct dwc2_core_params defparams;
- struct dwc2_hsotg *hsotg;
- struct resource *res;
- int retval;
- match = of_match_device(dwc2_of_match_table, &dev->dev);
- if (match && match->data) {
- params = match->data;
- } else {
- /* Default all params to autodetect */
- dwc2_set_all_params(&defparams, -1);
- params = &defparams;
- /*
- * Disable descriptor dma mode by default as the HW can support
- * it, but does not support it for SPLIT transactions.
- * Disable it for FS devices as well.
- */
- defparams.dma_desc_enable = 0;
- defparams.dma_desc_fs_enable = 0;
- }
- hsotg = devm_kzalloc(&dev->dev, sizeof(*hsotg), GFP_KERNEL);
- if (!hsotg)
- return -ENOMEM;
- hsotg->dev = &dev->dev;
- /*
- * Use reasonable defaults so platforms don't have to provide these.
- */
- if (!dev->dev.dma_mask)
- dev->dev.dma_mask = &dev->dev.coherent_dma_mask;
- retval = dma_set_coherent_mask(&dev->dev, DMA_BIT_MASK(32));
- if (retval)
- return retval;
- res = platform_get_resource(dev, IORESOURCE_MEM, 0);
- hsotg->regs = devm_ioremap_resource(&dev->dev, res);
- if (IS_ERR(hsotg->regs))
- return PTR_ERR(hsotg->regs);
- dev_dbg(&dev->dev, "mapped PA %08lx to VA %p\n",
- (unsigned long)res->start, hsotg->regs);
- retval = dwc2_lowlevel_hw_init(hsotg);
- if (retval)
- return retval;
- spin_lock_init(&hsotg->lock);
- hsotg->core_params = devm_kzalloc(&dev->dev,
- sizeof(*hsotg->core_params), GFP_KERNEL);
- if (!hsotg->core_params)
- return -ENOMEM;
- dwc2_set_all_params(hsotg->core_params, -1);
- hsotg->irq = platform_get_irq(dev, 0);
- if (hsotg->irq < 0) {
- dev_err(&dev->dev, "missing IRQ resource\n");
- return hsotg->irq;
- }
- dev_dbg(hsotg->dev, "registering common handler for irq%d\n",
- hsotg->irq);
- retval = devm_request_irq(hsotg->dev, hsotg->irq,
- dwc2_handle_common_intr, IRQF_SHARED,
- dev_name(hsotg->dev), hsotg);
- if (retval)
- return retval;
- retval = dwc2_lowlevel_hw_enable(hsotg);
- if (retval)
- return retval;
- retval = dwc2_get_dr_mode(hsotg);
- if (retval)
- goto error;
- /*
- * Reset before dwc2_get_hwparams() then it could get power-on real
- * reset value form registers.
- */
- dwc2_core_reset_and_force_dr_mode(hsotg);
- /* Detect config values from hardware */
- retval = dwc2_get_hwparams(hsotg);
- if (retval)
- goto error;
- /* Validate parameter values */
- dwc2_set_parameters(hsotg, params);
- dwc2_force_dr_mode(hsotg);
- if (hsotg->dr_mode != USB_DR_MODE_HOST) {
- retval = dwc2_gadget_init(hsotg, hsotg->irq);
- if (retval)
- goto error;
- hsotg->gadget_enabled = 1;
- }
- if (hsotg->dr_mode != USB_DR_MODE_PERIPHERAL) {
- retval = dwc2_hcd_init(hsotg, hsotg->irq);
- if (retval) {
- if (hsotg->gadget_enabled)
- dwc2_hsotg_remove(hsotg);
- goto error;
- }
- hsotg->hcd_enabled = 1;
- }
- platform_set_drvdata(dev, hsotg);
- dwc2_debugfs_init(hsotg);
- /* Gadget code manages lowlevel hw on its own */
- if (hsotg->dr_mode == USB_DR_MODE_PERIPHERAL)
- dwc2_lowlevel_hw_disable(hsotg);
- return 0;
- error:
- dwc2_lowlevel_hw_disable(hsotg);
- return retval;
- }
- static int __maybe_unused dwc2_suspend(struct device *dev)
- {
- struct dwc2_hsotg *dwc2 = dev_get_drvdata(dev);
- int ret = 0;
- if (dwc2_is_device_mode(dwc2))
- dwc2_hsotg_suspend(dwc2);
- if (dwc2->ll_hw_enabled)
- ret = __dwc2_lowlevel_hw_disable(dwc2);
- return ret;
- }
- static int __maybe_unused dwc2_resume(struct device *dev)
- {
- struct dwc2_hsotg *dwc2 = dev_get_drvdata(dev);
- int ret = 0;
- if (dwc2->ll_hw_enabled) {
- ret = __dwc2_lowlevel_hw_enable(dwc2);
- if (ret)
- return ret;
- }
- if (dwc2_is_device_mode(dwc2))
- ret = dwc2_hsotg_resume(dwc2);
- return ret;
- }
- static const struct dev_pm_ops dwc2_dev_pm_ops = {
- SET_SYSTEM_SLEEP_PM_OPS(dwc2_suspend, dwc2_resume)
- };
- static struct platform_driver dwc2_platform_driver = {
- .driver = {
- .name = dwc2_driver_name,
- .of_match_table = dwc2_of_match_table,
- .pm = &dwc2_dev_pm_ops,
- },
- .probe = dwc2_driver_probe,
- .remove = dwc2_driver_remove,
- .shutdown = dwc2_driver_shutdown,
- };
- module_platform_driver(dwc2_platform_driver);
- MODULE_DESCRIPTION("DESIGNWARE HS OTG Platform Glue");
- MODULE_AUTHOR("Matthijs Kooijman <matthijs@stdin.nl>");
- MODULE_LICENSE("Dual BSD/GPL");
|