mirror of
https://github.com/edk2-porting/linux-next.git
synced 2024-12-23 04:34:11 +08:00
ba9b40810b
Currently when an error occurs when calling devm_gpiod_get_optional or
calling gpiod_to_irq it causes an uninitialized error return in variable
'error' to be returned. Fix this by ensuring the error variable is set
from da8xx_ohci->oc_gpio and oc_irq.
Thanks to Dan Carpenter for spotting the uninitialized error in the
gpiod_to_irq failure case.
Addresses-Coverity: ("Uninitialized scalar variable")
Fixes: d193abf1c9
("usb: ohci-da8xx: add vbus and overcurrent gpios")
Signed-off-by: Colin Ian King <colin.king@canonical.com>
Cc: stable <stable@vger.kernel.org>
Acked-by: Alan Stern <stern@rowland.harvard.edu>
Link: https://lore.kernel.org/r/20200107123901.101190-1-colin.king@canonical.com
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
584 lines
13 KiB
C
584 lines
13 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/*
|
|
* OHCI HCD (Host Controller Driver) for USB.
|
|
*
|
|
* TI DA8xx (OMAP-L1x) Bus Glue
|
|
*
|
|
* Derived from: ohci-omap.c and ohci-s3c2410.c
|
|
* Copyright (C) 2008-2009 MontaVista Software, Inc. <source@mvista.com>
|
|
*/
|
|
|
|
#include <linux/clk.h>
|
|
#include <linux/gpio/consumer.h>
|
|
#include <linux/io.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/jiffies.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/phy/phy.h>
|
|
#include <linux/platform_data/usb-davinci.h>
|
|
#include <linux/regulator/consumer.h>
|
|
#include <linux/usb.h>
|
|
#include <linux/usb/hcd.h>
|
|
#include <asm/unaligned.h>
|
|
|
|
#include "ohci.h"
|
|
|
|
#define DRIVER_DESC "DA8XX"
|
|
#define DRV_NAME "ohci-da8xx"
|
|
|
|
static struct hc_driver __read_mostly ohci_da8xx_hc_driver;
|
|
|
|
static int (*orig_ohci_hub_control)(struct usb_hcd *hcd, u16 typeReq,
|
|
u16 wValue, u16 wIndex, char *buf, u16 wLength);
|
|
static int (*orig_ohci_hub_status_data)(struct usb_hcd *hcd, char *buf);
|
|
|
|
struct da8xx_ohci_hcd {
|
|
struct usb_hcd *hcd;
|
|
struct clk *usb11_clk;
|
|
struct phy *usb11_phy;
|
|
struct regulator *vbus_reg;
|
|
struct notifier_block nb;
|
|
struct gpio_desc *oc_gpio;
|
|
};
|
|
|
|
#define to_da8xx_ohci(hcd) (struct da8xx_ohci_hcd *)(hcd_to_ohci(hcd)->priv)
|
|
|
|
/* Over-current indicator change bitmask */
|
|
static volatile u16 ocic_mask;
|
|
|
|
static int ohci_da8xx_enable(struct usb_hcd *hcd)
|
|
{
|
|
struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
|
|
int ret;
|
|
|
|
ret = clk_prepare_enable(da8xx_ohci->usb11_clk);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ret = phy_init(da8xx_ohci->usb11_phy);
|
|
if (ret)
|
|
goto err_phy_init;
|
|
|
|
ret = phy_power_on(da8xx_ohci->usb11_phy);
|
|
if (ret)
|
|
goto err_phy_power_on;
|
|
|
|
return 0;
|
|
|
|
err_phy_power_on:
|
|
phy_exit(da8xx_ohci->usb11_phy);
|
|
err_phy_init:
|
|
clk_disable_unprepare(da8xx_ohci->usb11_clk);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static void ohci_da8xx_disable(struct usb_hcd *hcd)
|
|
{
|
|
struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
|
|
|
|
phy_power_off(da8xx_ohci->usb11_phy);
|
|
phy_exit(da8xx_ohci->usb11_phy);
|
|
clk_disable_unprepare(da8xx_ohci->usb11_clk);
|
|
}
|
|
|
|
static int ohci_da8xx_set_power(struct usb_hcd *hcd, int on)
|
|
{
|
|
struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
|
|
struct device *dev = hcd->self.controller;
|
|
int ret;
|
|
|
|
if (!da8xx_ohci->vbus_reg)
|
|
return 0;
|
|
|
|
if (on) {
|
|
ret = regulator_enable(da8xx_ohci->vbus_reg);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to enable regulator: %d\n", ret);
|
|
return ret;
|
|
}
|
|
} else {
|
|
ret = regulator_disable(da8xx_ohci->vbus_reg);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to disable regulator: %d\n", ret);
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ohci_da8xx_get_power(struct usb_hcd *hcd)
|
|
{
|
|
struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
|
|
|
|
if (da8xx_ohci->vbus_reg)
|
|
return regulator_is_enabled(da8xx_ohci->vbus_reg);
|
|
|
|
return 1;
|
|
}
|
|
|
|
static int ohci_da8xx_get_oci(struct usb_hcd *hcd)
|
|
{
|
|
struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
|
|
unsigned int flags;
|
|
int ret;
|
|
|
|
if (da8xx_ohci->oc_gpio)
|
|
return gpiod_get_value_cansleep(da8xx_ohci->oc_gpio);
|
|
|
|
if (!da8xx_ohci->vbus_reg)
|
|
return 0;
|
|
|
|
ret = regulator_get_error_flags(da8xx_ohci->vbus_reg, &flags);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (flags & REGULATOR_ERROR_OVER_CURRENT)
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ohci_da8xx_has_set_power(struct usb_hcd *hcd)
|
|
{
|
|
struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
|
|
|
|
if (da8xx_ohci->vbus_reg)
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ohci_da8xx_has_oci(struct usb_hcd *hcd)
|
|
{
|
|
struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
|
|
|
|
if (da8xx_ohci->oc_gpio)
|
|
return 1;
|
|
|
|
if (da8xx_ohci->vbus_reg)
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ohci_da8xx_has_potpgt(struct usb_hcd *hcd)
|
|
{
|
|
struct device *dev = hcd->self.controller;
|
|
struct da8xx_ohci_root_hub *hub = dev_get_platdata(dev);
|
|
|
|
if (hub && hub->potpgt)
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int ohci_da8xx_regulator_event(struct notifier_block *nb,
|
|
unsigned long event, void *data)
|
|
{
|
|
struct da8xx_ohci_hcd *da8xx_ohci =
|
|
container_of(nb, struct da8xx_ohci_hcd, nb);
|
|
|
|
if (event & REGULATOR_EVENT_OVER_CURRENT) {
|
|
ocic_mask |= 1 << 1;
|
|
ohci_da8xx_set_power(da8xx_ohci->hcd, 0);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static irqreturn_t ohci_da8xx_oc_thread(int irq, void *data)
|
|
{
|
|
struct da8xx_ohci_hcd *da8xx_ohci = data;
|
|
struct device *dev = da8xx_ohci->hcd->self.controller;
|
|
int ret;
|
|
|
|
if (gpiod_get_value_cansleep(da8xx_ohci->oc_gpio) &&
|
|
da8xx_ohci->vbus_reg) {
|
|
ret = regulator_disable(da8xx_ohci->vbus_reg);
|
|
if (ret)
|
|
dev_err(dev, "Failed to disable regulator: %d\n", ret);
|
|
}
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
static int ohci_da8xx_register_notify(struct usb_hcd *hcd)
|
|
{
|
|
struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
|
|
struct device *dev = hcd->self.controller;
|
|
int ret = 0;
|
|
|
|
if (!da8xx_ohci->oc_gpio && da8xx_ohci->vbus_reg) {
|
|
da8xx_ohci->nb.notifier_call = ohci_da8xx_regulator_event;
|
|
ret = devm_regulator_register_notifier(da8xx_ohci->vbus_reg,
|
|
&da8xx_ohci->nb);
|
|
}
|
|
|
|
if (ret)
|
|
dev_err(dev, "Failed to register notifier: %d\n", ret);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int ohci_da8xx_reset(struct usb_hcd *hcd)
|
|
{
|
|
struct device *dev = hcd->self.controller;
|
|
struct da8xx_ohci_root_hub *hub = dev_get_platdata(dev);
|
|
struct ohci_hcd *ohci = hcd_to_ohci(hcd);
|
|
int result;
|
|
u32 rh_a;
|
|
|
|
dev_dbg(dev, "starting USB controller\n");
|
|
|
|
result = ohci_da8xx_enable(hcd);
|
|
if (result < 0)
|
|
return result;
|
|
|
|
/*
|
|
* DA8xx only have 1 port connected to the pins but the HC root hub
|
|
* register A reports 2 ports, thus we'll have to override it...
|
|
*/
|
|
ohci->num_ports = 1;
|
|
|
|
result = ohci_setup(hcd);
|
|
if (result < 0) {
|
|
ohci_da8xx_disable(hcd);
|
|
return result;
|
|
}
|
|
|
|
/*
|
|
* Since we're providing a board-specific root hub port power control
|
|
* and over-current reporting, we have to override the HC root hub A
|
|
* register's default value, so that ohci_hub_control() could return
|
|
* the correct hub descriptor...
|
|
*/
|
|
rh_a = ohci_readl(ohci, &ohci->regs->roothub.a);
|
|
if (ohci_da8xx_has_set_power(hcd)) {
|
|
rh_a &= ~RH_A_NPS;
|
|
rh_a |= RH_A_PSM;
|
|
}
|
|
if (ohci_da8xx_has_oci(hcd)) {
|
|
rh_a &= ~RH_A_NOCP;
|
|
rh_a |= RH_A_OCPM;
|
|
}
|
|
if (ohci_da8xx_has_potpgt(hcd)) {
|
|
rh_a &= ~RH_A_POTPGT;
|
|
rh_a |= hub->potpgt << 24;
|
|
}
|
|
ohci_writel(ohci, rh_a, &ohci->regs->roothub.a);
|
|
|
|
return result;
|
|
}
|
|
|
|
/*
|
|
* Update the status data from the hub with the over-current indicator change.
|
|
*/
|
|
static int ohci_da8xx_hub_status_data(struct usb_hcd *hcd, char *buf)
|
|
{
|
|
int length = orig_ohci_hub_status_data(hcd, buf);
|
|
|
|
/* See if we have OCIC bit set on port 1 */
|
|
if (ocic_mask & (1 << 1)) {
|
|
dev_dbg(hcd->self.controller, "over-current indicator change "
|
|
"on port 1\n");
|
|
|
|
if (!length)
|
|
length = 1;
|
|
|
|
buf[0] |= 1 << 1;
|
|
}
|
|
return length;
|
|
}
|
|
|
|
/*
|
|
* Look at the control requests to the root hub and see if we need to override.
|
|
*/
|
|
static int ohci_da8xx_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
|
|
u16 wIndex, char *buf, u16 wLength)
|
|
{
|
|
struct device *dev = hcd->self.controller;
|
|
int temp;
|
|
|
|
switch (typeReq) {
|
|
case GetPortStatus:
|
|
/* Check the port number */
|
|
if (wIndex != 1)
|
|
break;
|
|
|
|
dev_dbg(dev, "GetPortStatus(%u)\n", wIndex);
|
|
|
|
temp = roothub_portstatus(hcd_to_ohci(hcd), wIndex - 1);
|
|
|
|
/* The port power status (PPS) bit defaults to 1 */
|
|
if (!ohci_da8xx_get_power(hcd))
|
|
temp &= ~RH_PS_PPS;
|
|
|
|
/* The port over-current indicator (POCI) bit is always 0 */
|
|
if (ohci_da8xx_get_oci(hcd) > 0)
|
|
temp |= RH_PS_POCI;
|
|
|
|
/* The over-current indicator change (OCIC) bit is 0 too */
|
|
if (ocic_mask & (1 << wIndex))
|
|
temp |= RH_PS_OCIC;
|
|
|
|
put_unaligned(cpu_to_le32(temp), (__le32 *)buf);
|
|
return 0;
|
|
case SetPortFeature:
|
|
temp = 1;
|
|
goto check_port;
|
|
case ClearPortFeature:
|
|
temp = 0;
|
|
|
|
check_port:
|
|
/* Check the port number */
|
|
if (wIndex != 1)
|
|
break;
|
|
|
|
switch (wValue) {
|
|
case USB_PORT_FEAT_POWER:
|
|
dev_dbg(dev, "%sPortFeature(%u): %s\n",
|
|
temp ? "Set" : "Clear", wIndex, "POWER");
|
|
|
|
return ohci_da8xx_set_power(hcd, temp) ? -EPIPE : 0;
|
|
case USB_PORT_FEAT_C_OVER_CURRENT:
|
|
dev_dbg(dev, "%sPortFeature(%u): %s\n",
|
|
temp ? "Set" : "Clear", wIndex,
|
|
"C_OVER_CURRENT");
|
|
|
|
if (temp)
|
|
ocic_mask |= 1 << wIndex;
|
|
else
|
|
ocic_mask &= ~(1 << wIndex);
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
return orig_ohci_hub_control(hcd, typeReq, wValue,
|
|
wIndex, buf, wLength);
|
|
}
|
|
|
|
/*-------------------------------------------------------------------------*/
|
|
#ifdef CONFIG_OF
|
|
static const struct of_device_id da8xx_ohci_ids[] = {
|
|
{ .compatible = "ti,da830-ohci" },
|
|
{ }
|
|
};
|
|
MODULE_DEVICE_TABLE(of, da8xx_ohci_ids);
|
|
#endif
|
|
|
|
static int ohci_da8xx_probe(struct platform_device *pdev)
|
|
{
|
|
struct da8xx_ohci_hcd *da8xx_ohci;
|
|
struct device *dev = &pdev->dev;
|
|
int error, hcd_irq, oc_irq;
|
|
struct usb_hcd *hcd;
|
|
struct resource *mem;
|
|
|
|
hcd = usb_create_hcd(&ohci_da8xx_hc_driver, dev, dev_name(dev));
|
|
if (!hcd)
|
|
return -ENOMEM;
|
|
|
|
da8xx_ohci = to_da8xx_ohci(hcd);
|
|
da8xx_ohci->hcd = hcd;
|
|
|
|
da8xx_ohci->usb11_clk = devm_clk_get(dev, NULL);
|
|
if (IS_ERR(da8xx_ohci->usb11_clk)) {
|
|
error = PTR_ERR(da8xx_ohci->usb11_clk);
|
|
if (error != -EPROBE_DEFER)
|
|
dev_err(dev, "Failed to get clock.\n");
|
|
goto err;
|
|
}
|
|
|
|
da8xx_ohci->usb11_phy = devm_phy_get(dev, "usb-phy");
|
|
if (IS_ERR(da8xx_ohci->usb11_phy)) {
|
|
error = PTR_ERR(da8xx_ohci->usb11_phy);
|
|
if (error != -EPROBE_DEFER)
|
|
dev_err(dev, "Failed to get phy.\n");
|
|
goto err;
|
|
}
|
|
|
|
da8xx_ohci->vbus_reg = devm_regulator_get_optional(dev, "vbus");
|
|
if (IS_ERR(da8xx_ohci->vbus_reg)) {
|
|
error = PTR_ERR(da8xx_ohci->vbus_reg);
|
|
if (error == -ENODEV) {
|
|
da8xx_ohci->vbus_reg = NULL;
|
|
} else if (error == -EPROBE_DEFER) {
|
|
goto err;
|
|
} else {
|
|
dev_err(dev, "Failed to get regulator\n");
|
|
goto err;
|
|
}
|
|
}
|
|
|
|
da8xx_ohci->oc_gpio = devm_gpiod_get_optional(dev, "oc", GPIOD_IN);
|
|
if (IS_ERR(da8xx_ohci->oc_gpio)) {
|
|
error = PTR_ERR(da8xx_ohci->oc_gpio);
|
|
goto err;
|
|
}
|
|
|
|
if (da8xx_ohci->oc_gpio) {
|
|
oc_irq = gpiod_to_irq(da8xx_ohci->oc_gpio);
|
|
if (oc_irq < 0) {
|
|
error = oc_irq;
|
|
goto err;
|
|
}
|
|
|
|
error = devm_request_threaded_irq(dev, oc_irq, NULL,
|
|
ohci_da8xx_oc_thread, IRQF_TRIGGER_RISING |
|
|
IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
|
|
"OHCI over-current indicator", da8xx_ohci);
|
|
if (error)
|
|
goto err;
|
|
}
|
|
|
|
mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
hcd->regs = devm_ioremap_resource(dev, mem);
|
|
if (IS_ERR(hcd->regs)) {
|
|
error = PTR_ERR(hcd->regs);
|
|
goto err;
|
|
}
|
|
hcd->rsrc_start = mem->start;
|
|
hcd->rsrc_len = resource_size(mem);
|
|
|
|
hcd_irq = platform_get_irq(pdev, 0);
|
|
if (hcd_irq < 0) {
|
|
error = -ENODEV;
|
|
goto err;
|
|
}
|
|
|
|
error = usb_add_hcd(hcd, hcd_irq, 0);
|
|
if (error)
|
|
goto err;
|
|
|
|
device_wakeup_enable(hcd->self.controller);
|
|
|
|
error = ohci_da8xx_register_notify(hcd);
|
|
if (error)
|
|
goto err_remove_hcd;
|
|
|
|
return 0;
|
|
|
|
err_remove_hcd:
|
|
usb_remove_hcd(hcd);
|
|
err:
|
|
usb_put_hcd(hcd);
|
|
return error;
|
|
}
|
|
|
|
static int ohci_da8xx_remove(struct platform_device *pdev)
|
|
{
|
|
struct usb_hcd *hcd = platform_get_drvdata(pdev);
|
|
|
|
usb_remove_hcd(hcd);
|
|
usb_put_hcd(hcd);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int ohci_da8xx_suspend(struct platform_device *pdev,
|
|
pm_message_t message)
|
|
{
|
|
struct usb_hcd *hcd = platform_get_drvdata(pdev);
|
|
struct ohci_hcd *ohci = hcd_to_ohci(hcd);
|
|
bool do_wakeup = device_may_wakeup(&pdev->dev);
|
|
int ret;
|
|
|
|
|
|
if (time_before(jiffies, ohci->next_statechange))
|
|
msleep(5);
|
|
ohci->next_statechange = jiffies;
|
|
|
|
ret = ohci_suspend(hcd, do_wakeup);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ohci_da8xx_disable(hcd);
|
|
hcd->state = HC_STATE_SUSPENDED;
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int ohci_da8xx_resume(struct platform_device *dev)
|
|
{
|
|
struct usb_hcd *hcd = platform_get_drvdata(dev);
|
|
struct ohci_hcd *ohci = hcd_to_ohci(hcd);
|
|
int ret;
|
|
|
|
if (time_before(jiffies, ohci->next_statechange))
|
|
msleep(5);
|
|
ohci->next_statechange = jiffies;
|
|
|
|
ret = ohci_da8xx_enable(hcd);
|
|
if (ret)
|
|
return ret;
|
|
|
|
ohci_resume(hcd, false);
|
|
|
|
return 0;
|
|
}
|
|
#endif
|
|
|
|
static const struct ohci_driver_overrides da8xx_overrides __initconst = {
|
|
.reset = ohci_da8xx_reset,
|
|
.extra_priv_size = sizeof(struct da8xx_ohci_hcd),
|
|
};
|
|
|
|
/*
|
|
* Driver definition to register with platform structure.
|
|
*/
|
|
static struct platform_driver ohci_hcd_da8xx_driver = {
|
|
.probe = ohci_da8xx_probe,
|
|
.remove = ohci_da8xx_remove,
|
|
.shutdown = usb_hcd_platform_shutdown,
|
|
#ifdef CONFIG_PM
|
|
.suspend = ohci_da8xx_suspend,
|
|
.resume = ohci_da8xx_resume,
|
|
#endif
|
|
.driver = {
|
|
.name = DRV_NAME,
|
|
.of_match_table = of_match_ptr(da8xx_ohci_ids),
|
|
},
|
|
};
|
|
|
|
static int __init ohci_da8xx_init(void)
|
|
{
|
|
|
|
if (usb_disabled())
|
|
return -ENODEV;
|
|
|
|
pr_info("%s: " DRIVER_DESC "\n", DRV_NAME);
|
|
ohci_init_driver(&ohci_da8xx_hc_driver, &da8xx_overrides);
|
|
|
|
/*
|
|
* The Davinci da8xx HW has some unusual quirks, which require
|
|
* da8xx-specific workarounds. We override certain hc_driver
|
|
* functions here to achieve that. We explicitly do not enhance
|
|
* ohci_driver_overrides to allow this more easily, since this
|
|
* is an unusual case, and we don't want to encourage others to
|
|
* override these functions by making it too easy.
|
|
*/
|
|
|
|
orig_ohci_hub_control = ohci_da8xx_hc_driver.hub_control;
|
|
orig_ohci_hub_status_data = ohci_da8xx_hc_driver.hub_status_data;
|
|
|
|
ohci_da8xx_hc_driver.hub_status_data = ohci_da8xx_hub_status_data;
|
|
ohci_da8xx_hc_driver.hub_control = ohci_da8xx_hub_control;
|
|
|
|
return platform_driver_register(&ohci_hcd_da8xx_driver);
|
|
}
|
|
module_init(ohci_da8xx_init);
|
|
|
|
static void __exit ohci_da8xx_exit(void)
|
|
{
|
|
platform_driver_unregister(&ohci_hcd_da8xx_driver);
|
|
}
|
|
module_exit(ohci_da8xx_exit);
|
|
MODULE_DESCRIPTION(DRIVER_DESC);
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_ALIAS("platform:" DRV_NAME);
|