123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836 |
- // SPDX-License-Identifier: GPL-1.0+
- /*
- * Renesas USB driver
- *
- * Copyright (C) 2011 Renesas Solutions Corp.
- * Copyright (C) 2019 Renesas Electronics Corporation
- * Kuninori Morimoto <[email protected]>
- */
- #include <linux/clk.h>
- #include <linux/err.h>
- #include <linux/gpio/consumer.h>
- #include <linux/io.h>
- #include <linux/module.h>
- #include <linux/of_device.h>
- #include <linux/pm_runtime.h>
- #include <linux/reset.h>
- #include <linux/slab.h>
- #include <linux/sysfs.h>
- #include "common.h"
- #include "rcar2.h"
- #include "rcar3.h"
- #include "rza.h"
- /*
- * image of renesas_usbhs
- *
- * ex) gadget case
- * mod.c
- * mod_gadget.c
- * mod_host.c pipe.c fifo.c
- *
- * +-------+ +-----------+
- * | pipe0 |------>| fifo pio |
- * +------------+ +-------+ +-----------+
- * | mod_gadget |=====> | pipe1 |--+
- * +------------+ +-------+ | +-----------+
- * | pipe2 | | +-| fifo dma0 |
- * +------------+ +-------+ | | +-----------+
- * | mod_host | | pipe3 |<-|--+
- * +------------+ +-------+ | +-----------+
- * | .... | +--->| fifo dma1 |
- * | .... | +-----------+
- */
- /*
- * platform call back
- *
- * renesas usb support platform callback function.
- * Below macro call it.
- * if platform doesn't have callback, it return 0 (no error)
- */
- #define usbhs_platform_call(priv, func, args...)\
- (!(priv) ? -ENODEV : \
- !((priv)->pfunc->func) ? 0 : \
- (priv)->pfunc->func(args))
- /*
- * common functions
- */
- u16 usbhs_read(struct usbhs_priv *priv, u32 reg)
- {
- return ioread16(priv->base + reg);
- }
- void usbhs_write(struct usbhs_priv *priv, u32 reg, u16 data)
- {
- iowrite16(data, priv->base + reg);
- }
- void usbhs_bset(struct usbhs_priv *priv, u32 reg, u16 mask, u16 data)
- {
- u16 val = usbhs_read(priv, reg);
- val &= ~mask;
- val |= data & mask;
- usbhs_write(priv, reg, val);
- }
- struct usbhs_priv *usbhs_pdev_to_priv(struct platform_device *pdev)
- {
- return dev_get_drvdata(&pdev->dev);
- }
- int usbhs_get_id_as_gadget(struct platform_device *pdev)
- {
- return USBHS_GADGET;
- }
- /*
- * syscfg functions
- */
- static void usbhs_sys_clock_ctrl(struct usbhs_priv *priv, int enable)
- {
- usbhs_bset(priv, SYSCFG, SCKE, enable ? SCKE : 0);
- }
- void usbhs_sys_host_ctrl(struct usbhs_priv *priv, int enable)
- {
- u16 mask = DCFM | DRPD | DPRPU | HSE | USBE;
- u16 val = DCFM | DRPD | HSE | USBE;
- /*
- * if enable
- *
- * - select Host mode
- * - D+ Line/D- Line Pull-down
- */
- usbhs_bset(priv, SYSCFG, mask, enable ? val : 0);
- }
- void usbhs_sys_function_ctrl(struct usbhs_priv *priv, int enable)
- {
- u16 mask = DCFM | DRPD | DPRPU | HSE | USBE;
- u16 val = HSE | USBE;
- /* CNEN bit is required for function operation */
- if (usbhs_get_dparam(priv, has_cnen)) {
- mask |= CNEN;
- val |= CNEN;
- }
- /*
- * if enable
- *
- * - select Function mode
- * - D+ Line Pull-up is disabled
- * When D+ Line Pull-up is enabled,
- * calling usbhs_sys_function_pullup(,1)
- */
- usbhs_bset(priv, SYSCFG, mask, enable ? val : 0);
- }
- void usbhs_sys_function_pullup(struct usbhs_priv *priv, int enable)
- {
- usbhs_bset(priv, SYSCFG, DPRPU, enable ? DPRPU : 0);
- }
- void usbhs_sys_set_test_mode(struct usbhs_priv *priv, u16 mode)
- {
- usbhs_write(priv, TESTMODE, mode);
- }
- /*
- * frame functions
- */
- int usbhs_frame_get_num(struct usbhs_priv *priv)
- {
- return usbhs_read(priv, FRMNUM) & FRNM_MASK;
- }
- /*
- * usb request functions
- */
- void usbhs_usbreq_get_val(struct usbhs_priv *priv, struct usb_ctrlrequest *req)
- {
- u16 val;
- val = usbhs_read(priv, USBREQ);
- req->bRequest = (val >> 8) & 0xFF;
- req->bRequestType = (val >> 0) & 0xFF;
- req->wValue = cpu_to_le16(usbhs_read(priv, USBVAL));
- req->wIndex = cpu_to_le16(usbhs_read(priv, USBINDX));
- req->wLength = cpu_to_le16(usbhs_read(priv, USBLENG));
- }
- void usbhs_usbreq_set_val(struct usbhs_priv *priv, struct usb_ctrlrequest *req)
- {
- usbhs_write(priv, USBREQ, (req->bRequest << 8) | req->bRequestType);
- usbhs_write(priv, USBVAL, le16_to_cpu(req->wValue));
- usbhs_write(priv, USBINDX, le16_to_cpu(req->wIndex));
- usbhs_write(priv, USBLENG, le16_to_cpu(req->wLength));
- usbhs_bset(priv, DCPCTR, SUREQ, SUREQ);
- }
- /*
- * bus/vbus functions
- */
- void usbhs_bus_send_sof_enable(struct usbhs_priv *priv)
- {
- u16 status = usbhs_read(priv, DVSTCTR) & (USBRST | UACT);
- if (status != USBRST) {
- struct device *dev = usbhs_priv_to_dev(priv);
- dev_err(dev, "usbhs should be reset\n");
- }
- usbhs_bset(priv, DVSTCTR, (USBRST | UACT), UACT);
- }
- void usbhs_bus_send_reset(struct usbhs_priv *priv)
- {
- usbhs_bset(priv, DVSTCTR, (USBRST | UACT), USBRST);
- }
- int usbhs_bus_get_speed(struct usbhs_priv *priv)
- {
- u16 dvstctr = usbhs_read(priv, DVSTCTR);
- switch (RHST & dvstctr) {
- case RHST_LOW_SPEED:
- return USB_SPEED_LOW;
- case RHST_FULL_SPEED:
- return USB_SPEED_FULL;
- case RHST_HIGH_SPEED:
- return USB_SPEED_HIGH;
- }
- return USB_SPEED_UNKNOWN;
- }
- int usbhs_vbus_ctrl(struct usbhs_priv *priv, int enable)
- {
- struct platform_device *pdev = usbhs_priv_to_pdev(priv);
- return usbhs_platform_call(priv, set_vbus, pdev, enable);
- }
- static void usbhsc_bus_init(struct usbhs_priv *priv)
- {
- usbhs_write(priv, DVSTCTR, 0);
- usbhs_vbus_ctrl(priv, 0);
- }
- /*
- * device configuration
- */
- int usbhs_set_device_config(struct usbhs_priv *priv, int devnum,
- u16 upphub, u16 hubport, u16 speed)
- {
- struct device *dev = usbhs_priv_to_dev(priv);
- u16 usbspd = 0;
- u32 reg = DEVADD0 + (2 * devnum);
- if (devnum > 10) {
- dev_err(dev, "cannot set speed to unknown device %d\n", devnum);
- return -EIO;
- }
- if (upphub > 0xA) {
- dev_err(dev, "unsupported hub number %d\n", upphub);
- return -EIO;
- }
- switch (speed) {
- case USB_SPEED_LOW:
- usbspd = USBSPD_SPEED_LOW;
- break;
- case USB_SPEED_FULL:
- usbspd = USBSPD_SPEED_FULL;
- break;
- case USB_SPEED_HIGH:
- usbspd = USBSPD_SPEED_HIGH;
- break;
- default:
- dev_err(dev, "unsupported speed %d\n", speed);
- return -EIO;
- }
- usbhs_write(priv, reg, UPPHUB(upphub) |
- HUBPORT(hubport)|
- USBSPD(usbspd));
- return 0;
- }
- /*
- * interrupt functions
- */
- void usbhs_xxxsts_clear(struct usbhs_priv *priv, u16 sts_reg, u16 bit)
- {
- u16 pipe_mask = (u16)GENMASK(usbhs_get_dparam(priv, pipe_size), 0);
- usbhs_write(priv, sts_reg, ~(1 << bit) & pipe_mask);
- }
- /*
- * local functions
- */
- static void usbhsc_set_buswait(struct usbhs_priv *priv)
- {
- int wait = usbhs_get_dparam(priv, buswait_bwait);
- /* set bus wait if platform have */
- if (wait)
- usbhs_bset(priv, BUSWAIT, 0x000F, wait);
- }
- static bool usbhsc_is_multi_clks(struct usbhs_priv *priv)
- {
- return priv->dparam.multi_clks;
- }
- static int usbhsc_clk_get(struct device *dev, struct usbhs_priv *priv)
- {
- if (!usbhsc_is_multi_clks(priv))
- return 0;
- /* The first clock should exist */
- priv->clks[0] = of_clk_get(dev_of_node(dev), 0);
- if (IS_ERR(priv->clks[0]))
- return PTR_ERR(priv->clks[0]);
- /*
- * To backward compatibility with old DT, this driver checks the return
- * value if it's -ENOENT or not.
- */
- priv->clks[1] = of_clk_get(dev_of_node(dev), 1);
- if (PTR_ERR(priv->clks[1]) == -ENOENT)
- priv->clks[1] = NULL;
- else if (IS_ERR(priv->clks[1]))
- return PTR_ERR(priv->clks[1]);
- return 0;
- }
- static void usbhsc_clk_put(struct usbhs_priv *priv)
- {
- int i;
- if (!usbhsc_is_multi_clks(priv))
- return;
- for (i = 0; i < ARRAY_SIZE(priv->clks); i++)
- clk_put(priv->clks[i]);
- }
- static int usbhsc_clk_prepare_enable(struct usbhs_priv *priv)
- {
- int i, ret;
- if (!usbhsc_is_multi_clks(priv))
- return 0;
- for (i = 0; i < ARRAY_SIZE(priv->clks); i++) {
- ret = clk_prepare_enable(priv->clks[i]);
- if (ret) {
- while (--i >= 0)
- clk_disable_unprepare(priv->clks[i]);
- return ret;
- }
- }
- return ret;
- }
- static void usbhsc_clk_disable_unprepare(struct usbhs_priv *priv)
- {
- int i;
- if (!usbhsc_is_multi_clks(priv))
- return;
- for (i = 0; i < ARRAY_SIZE(priv->clks); i++)
- clk_disable_unprepare(priv->clks[i]);
- }
- /*
- * platform default param
- */
- /* commonly used on old SH-Mobile SoCs */
- static struct renesas_usbhs_driver_pipe_config usbhsc_default_pipe[] = {
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_CONTROL, 64, 0x00, false),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_ISOC, 1024, 0x08, false),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_ISOC, 1024, 0x18, false),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0x28, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0x38, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0x48, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_INT, 64, 0x04, false),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_INT, 64, 0x05, false),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_INT, 64, 0x06, false),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_INT, 64, 0x07, false),
- };
- /* commonly used on newer SH-Mobile and R-Car SoCs */
- static struct renesas_usbhs_driver_pipe_config usbhsc_new_pipe[] = {
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_CONTROL, 64, 0x00, false),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_ISOC, 1024, 0x08, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_ISOC, 1024, 0x28, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0x48, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0x58, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0x68, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_INT, 64, 0x04, false),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_INT, 64, 0x05, false),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_INT, 64, 0x06, false),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0x78, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0x88, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0x98, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0xa8, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0xb8, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0xc8, true),
- RENESAS_USBHS_PIPE(USB_ENDPOINT_XFER_BULK, 512, 0xd8, true),
- };
- /*
- * power control
- */
- static void usbhsc_power_ctrl(struct usbhs_priv *priv, int enable)
- {
- struct platform_device *pdev = usbhs_priv_to_pdev(priv);
- struct device *dev = usbhs_priv_to_dev(priv);
- if (enable) {
- /* enable PM */
- pm_runtime_get_sync(dev);
- /* enable clks */
- if (usbhsc_clk_prepare_enable(priv))
- return;
- /* enable platform power */
- usbhs_platform_call(priv, power_ctrl, pdev, priv->base, enable);
- /* USB on */
- usbhs_sys_clock_ctrl(priv, enable);
- } else {
- /* USB off */
- usbhs_sys_clock_ctrl(priv, enable);
- /* disable platform power */
- usbhs_platform_call(priv, power_ctrl, pdev, priv->base, enable);
- /* disable clks */
- usbhsc_clk_disable_unprepare(priv);
- /* disable PM */
- pm_runtime_put_sync(dev);
- }
- }
- /*
- * hotplug
- */
- static void usbhsc_hotplug(struct usbhs_priv *priv)
- {
- struct platform_device *pdev = usbhs_priv_to_pdev(priv);
- struct usbhs_mod *mod = usbhs_mod_get_current(priv);
- int id;
- int enable;
- int cable;
- int ret;
- /*
- * get vbus status from platform
- */
- enable = usbhs_mod_info_call(priv, get_vbus, pdev);
- /*
- * get id from platform
- */
- id = usbhs_platform_call(priv, get_id, pdev);
- if (enable && !mod) {
- if (priv->edev) {
- cable = extcon_get_state(priv->edev, EXTCON_USB_HOST);
- if ((cable > 0 && id != USBHS_HOST) ||
- (!cable && id != USBHS_GADGET)) {
- dev_info(&pdev->dev,
- "USB cable plugged in doesn't match the selected role!\n");
- return;
- }
- }
- ret = usbhs_mod_change(priv, id);
- if (ret < 0)
- return;
- dev_dbg(&pdev->dev, "%s enable\n", __func__);
- /* power on */
- if (usbhs_get_dparam(priv, runtime_pwctrl))
- usbhsc_power_ctrl(priv, enable);
- /* bus init */
- usbhsc_set_buswait(priv);
- usbhsc_bus_init(priv);
- /* module start */
- usbhs_mod_call(priv, start, priv);
- } else if (!enable && mod) {
- dev_dbg(&pdev->dev, "%s disable\n", __func__);
- /* module stop */
- usbhs_mod_call(priv, stop, priv);
- /* bus init */
- usbhsc_bus_init(priv);
- /* power off */
- if (usbhs_get_dparam(priv, runtime_pwctrl))
- usbhsc_power_ctrl(priv, enable);
- usbhs_mod_change(priv, -1);
- /* reset phy for next connection */
- usbhs_platform_call(priv, phy_reset, pdev);
- }
- }
- /*
- * notify hotplug
- */
- static void usbhsc_notify_hotplug(struct work_struct *work)
- {
- struct usbhs_priv *priv = container_of(work,
- struct usbhs_priv,
- notify_hotplug_work.work);
- usbhsc_hotplug(priv);
- }
- int usbhsc_schedule_notify_hotplug(struct platform_device *pdev)
- {
- struct usbhs_priv *priv = usbhs_pdev_to_priv(pdev);
- int delay = usbhs_get_dparam(priv, detection_delay);
- /*
- * This functions will be called in interrupt.
- * To make sure safety context,
- * use workqueue for usbhs_notify_hotplug
- */
- schedule_delayed_work(&priv->notify_hotplug_work,
- msecs_to_jiffies(delay));
- return 0;
- }
- /*
- * platform functions
- */
- static const struct of_device_id usbhs_of_match[] = {
- {
- .compatible = "renesas,usbhs-r8a774c0",
- .data = &usbhs_rcar_gen3_with_pll_plat_info,
- },
- {
- .compatible = "renesas,usbhs-r8a7790",
- .data = &usbhs_rcar_gen2_plat_info,
- },
- {
- .compatible = "renesas,usbhs-r8a7791",
- .data = &usbhs_rcar_gen2_plat_info,
- },
- {
- .compatible = "renesas,usbhs-r8a7794",
- .data = &usbhs_rcar_gen2_plat_info,
- },
- {
- .compatible = "renesas,usbhs-r8a7795",
- .data = &usbhs_rcar_gen3_plat_info,
- },
- {
- .compatible = "renesas,usbhs-r8a7796",
- .data = &usbhs_rcar_gen3_plat_info,
- },
- {
- .compatible = "renesas,usbhs-r8a77990",
- .data = &usbhs_rcar_gen3_with_pll_plat_info,
- },
- {
- .compatible = "renesas,usbhs-r8a77995",
- .data = &usbhs_rcar_gen3_with_pll_plat_info,
- },
- {
- .compatible = "renesas,rcar-gen2-usbhs",
- .data = &usbhs_rcar_gen2_plat_info,
- },
- {
- .compatible = "renesas,rcar-gen3-usbhs",
- .data = &usbhs_rcar_gen3_plat_info,
- },
- {
- .compatible = "renesas,rza1-usbhs",
- .data = &usbhs_rza1_plat_info,
- },
- {
- .compatible = "renesas,rza2-usbhs",
- .data = &usbhs_rza2_plat_info,
- },
- { },
- };
- MODULE_DEVICE_TABLE(of, usbhs_of_match);
- static int usbhs_probe(struct platform_device *pdev)
- {
- const struct renesas_usbhs_platform_info *info;
- struct usbhs_priv *priv;
- struct device *dev = &pdev->dev;
- struct gpio_desc *gpiod;
- int ret;
- u32 tmp;
- int irq;
- /* check device node */
- if (dev_of_node(dev))
- info = of_device_get_match_data(dev);
- else
- info = renesas_usbhs_get_info(pdev);
- /* check platform information */
- if (!info) {
- dev_err(dev, "no platform information\n");
- return -EINVAL;
- }
- /* platform data */
- irq = platform_get_irq(pdev, 0);
- if (irq < 0)
- return irq;
- /* usb private data */
- priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
- if (!priv)
- return -ENOMEM;
- priv->base = devm_platform_ioremap_resource(pdev, 0);
- if (IS_ERR(priv->base))
- return PTR_ERR(priv->base);
- if (of_property_read_bool(dev_of_node(dev), "extcon")) {
- priv->edev = extcon_get_edev_by_phandle(dev, 0);
- if (IS_ERR(priv->edev))
- return PTR_ERR(priv->edev);
- }
- priv->rsts = devm_reset_control_array_get_optional_shared(dev);
- if (IS_ERR(priv->rsts))
- return PTR_ERR(priv->rsts);
- /*
- * care platform info
- */
- priv->dparam = info->driver_param;
- if (!info->platform_callback.get_id) {
- dev_err(dev, "no platform callbacks\n");
- return -EINVAL;
- }
- priv->pfunc = &info->platform_callback;
- /* set default param if platform doesn't have */
- if (usbhs_get_dparam(priv, has_new_pipe_configs)) {
- priv->dparam.pipe_configs = usbhsc_new_pipe;
- priv->dparam.pipe_size = ARRAY_SIZE(usbhsc_new_pipe);
- } else if (!priv->dparam.pipe_configs) {
- priv->dparam.pipe_configs = usbhsc_default_pipe;
- priv->dparam.pipe_size = ARRAY_SIZE(usbhsc_default_pipe);
- }
- if (!priv->dparam.pio_dma_border)
- priv->dparam.pio_dma_border = 64; /* 64byte */
- if (!of_property_read_u32(dev_of_node(dev), "renesas,buswait", &tmp))
- priv->dparam.buswait_bwait = tmp;
- gpiod = devm_gpiod_get_optional(dev, "renesas,enable", GPIOD_IN);
- if (IS_ERR(gpiod))
- return PTR_ERR(gpiod);
- /* FIXME */
- /* runtime power control ? */
- if (priv->pfunc->get_vbus)
- usbhs_get_dparam(priv, runtime_pwctrl) = 1;
- /*
- * priv settings
- */
- priv->irq = irq;
- priv->pdev = pdev;
- INIT_DELAYED_WORK(&priv->notify_hotplug_work, usbhsc_notify_hotplug);
- spin_lock_init(usbhs_priv_to_lock(priv));
- /* call pipe and module init */
- ret = usbhs_pipe_probe(priv);
- if (ret < 0)
- return ret;
- ret = usbhs_fifo_probe(priv);
- if (ret < 0)
- goto probe_end_pipe_exit;
- ret = usbhs_mod_probe(priv);
- if (ret < 0)
- goto probe_end_fifo_exit;
- /* dev_set_drvdata should be called after usbhs_mod_init */
- platform_set_drvdata(pdev, priv);
- ret = reset_control_deassert(priv->rsts);
- if (ret)
- goto probe_fail_rst;
- ret = usbhsc_clk_get(dev, priv);
- if (ret)
- goto probe_fail_clks;
- /*
- * deviece reset here because
- * USB device might be used in boot loader.
- */
- usbhs_sys_clock_ctrl(priv, 0);
- /* check GPIO determining if USB function should be enabled */
- if (gpiod) {
- ret = !gpiod_get_value(gpiod);
- if (ret) {
- dev_warn(dev, "USB function not selected (GPIO)\n");
- ret = -ENOTSUPP;
- goto probe_end_mod_exit;
- }
- }
- /*
- * platform call
- *
- * USB phy setup might depend on CPU/Board.
- * If platform has its callback functions,
- * call it here.
- */
- ret = usbhs_platform_call(priv, hardware_init, pdev);
- if (ret < 0) {
- dev_err(dev, "platform init failed.\n");
- goto probe_end_mod_exit;
- }
- /* reset phy for connection */
- usbhs_platform_call(priv, phy_reset, pdev);
- /* power control */
- pm_runtime_enable(dev);
- if (!usbhs_get_dparam(priv, runtime_pwctrl)) {
- usbhsc_power_ctrl(priv, 1);
- usbhs_mod_autonomy_mode(priv);
- } else {
- usbhs_mod_non_autonomy_mode(priv);
- }
- /*
- * manual call notify_hotplug for cold plug
- */
- usbhsc_schedule_notify_hotplug(pdev);
- dev_info(dev, "probed\n");
- return ret;
- probe_end_mod_exit:
- usbhsc_clk_put(priv);
- probe_fail_clks:
- reset_control_assert(priv->rsts);
- probe_fail_rst:
- usbhs_mod_remove(priv);
- probe_end_fifo_exit:
- usbhs_fifo_remove(priv);
- probe_end_pipe_exit:
- usbhs_pipe_remove(priv);
- dev_info(dev, "probe failed (%d)\n", ret);
- return ret;
- }
- static int usbhs_remove(struct platform_device *pdev)
- {
- struct usbhs_priv *priv = usbhs_pdev_to_priv(pdev);
- dev_dbg(&pdev->dev, "usb remove\n");
- /* power off */
- if (!usbhs_get_dparam(priv, runtime_pwctrl))
- usbhsc_power_ctrl(priv, 0);
- pm_runtime_disable(&pdev->dev);
- usbhs_platform_call(priv, hardware_exit, pdev);
- usbhsc_clk_put(priv);
- reset_control_assert(priv->rsts);
- usbhs_mod_remove(priv);
- usbhs_fifo_remove(priv);
- usbhs_pipe_remove(priv);
- return 0;
- }
- static __maybe_unused int usbhsc_suspend(struct device *dev)
- {
- struct usbhs_priv *priv = dev_get_drvdata(dev);
- struct usbhs_mod *mod = usbhs_mod_get_current(priv);
- if (mod) {
- usbhs_mod_call(priv, stop, priv);
- usbhs_mod_change(priv, -1);
- }
- if (mod || !usbhs_get_dparam(priv, runtime_pwctrl))
- usbhsc_power_ctrl(priv, 0);
- return 0;
- }
- static __maybe_unused int usbhsc_resume(struct device *dev)
- {
- struct usbhs_priv *priv = dev_get_drvdata(dev);
- struct platform_device *pdev = usbhs_priv_to_pdev(priv);
- if (!usbhs_get_dparam(priv, runtime_pwctrl)) {
- usbhsc_power_ctrl(priv, 1);
- usbhs_mod_autonomy_mode(priv);
- }
- usbhs_platform_call(priv, phy_reset, pdev);
- usbhsc_schedule_notify_hotplug(pdev);
- return 0;
- }
- static SIMPLE_DEV_PM_OPS(usbhsc_pm_ops, usbhsc_suspend, usbhsc_resume);
- static struct platform_driver renesas_usbhs_driver = {
- .driver = {
- .name = "renesas_usbhs",
- .pm = &usbhsc_pm_ops,
- .of_match_table = of_match_ptr(usbhs_of_match),
- },
- .probe = usbhs_probe,
- .remove = usbhs_remove,
- };
- module_platform_driver(renesas_usbhs_driver);
- MODULE_LICENSE("GPL");
- MODULE_DESCRIPTION("Renesas USB driver");
- MODULE_AUTHOR("Kuninori Morimoto <[email protected]>");
|