- DWC2 gadget EP fix, nuvoton NPCM7xx ehci/ohci driver
This commit is contained in:
Tom Rini 2022-09-26 08:29:42 -04:00
commit d9993452cb
5 changed files with 248 additions and 3 deletions

View File

@ -890,7 +890,7 @@ static int dwc2_ep0_write(struct dwc2_udc *dev)
static int dwc2_udc_get_status(struct dwc2_udc *dev,
struct usb_ctrlrequest *crq)
{
u8 ep_num = crq->wIndex & 0x7F;
u8 ep_num = crq->wIndex & 0x3;
u16 g_status = 0;
u32 ep_ctrl;
@ -1418,7 +1418,7 @@ static void dwc2_ep0_setup(struct dwc2_udc *dev)
break;
case USB_REQ_CLEAR_FEATURE:
ep_num = usb_ctrl->wIndex & 0x7f;
ep_num = usb_ctrl->wIndex & 0x3;
if (!dwc2_udc_clear_feature(&dev->ep[ep_num].ep))
return;
@ -1426,7 +1426,7 @@ static void dwc2_ep0_setup(struct dwc2_udc *dev)
break;
case USB_REQ_SET_FEATURE:
ep_num = usb_ctrl->wIndex & 0x7f;
ep_num = usb_ctrl->wIndex & 0x3;
if (!dwc2_udc_set_feature(&dev->ep[ep_num].ep))
return;

View File

@ -214,6 +214,14 @@ config USB_EHCI_MXS
Enables support for the on-chip EHCI controller on i.MX23 and
i.MX28 SoCs.
config USB_EHCI_NPCM
bool "Support for Nuvoton NPCM on-chip EHCI USB controller"
depends on ARCH_NPCM
default n
---help---
Enables support for the on-chip EHCI controller on
Nuvoton NPCM chips.
config USB_EHCI_OMAP
bool "Support for OMAP3+ on-chip EHCI USB controller"
depends on ARCH_OMAP2PLUS
@ -343,6 +351,14 @@ config USB_OHCI_DA8XX
help
Enable support for the da850 USB controller.
config USB_OHCI_NPCM
bool "Support for Nuvoton NPCM on-chip OHCI USB controller"
depends on ARCH_NPCM
default n
---help---
Enables support for the on-chip OHCI controller on
Nuvoton NPCM chips.
endif # USB_OHCI_HCD
config SYS_USB_OHCI_SLOT_NAME

View File

@ -21,6 +21,7 @@ obj-$(CONFIG_USB_SL811HS) += sl811-hcd.o
obj-$(CONFIG_USB_OHCI_LPC32XX) += ohci-lpc32xx.o
obj-$(CONFIG_USB_OHCI_PCI) += ohci-pci.o
obj-$(CONFIG_USB_OHCI_GENERIC) += ohci-generic.o
obj-$(CONFIG_USB_OHCI_NPCM) += ohci-npcm.o
# echi
obj-$(CONFIG_USB_EHCI_HCD) += ehci-hcd.o
@ -34,6 +35,7 @@ obj-$(CONFIG_USB_EHCI_MXS) += ehci-mxs.o
obj-$(CONFIG_USB_EHCI_MX5) += ehci-mx5.o
obj-$(CONFIG_USB_EHCI_MX6) += ehci-mx6.o
obj-$(CONFIG_USB_EHCI_MX7) += ehci-mx6.o
obj-$(CONFIG_USB_EHCI_NPCM) += ehci-npcm.o
obj-$(CONFIG_USB_EHCI_OMAP) += ehci-omap.o
obj-$(CONFIG_USB_EHCI_MARVELL) += ehci-marvell.o
obj-$(CONFIG_USB_EHCI_MSM) += ehci-msm.o

View File

@ -0,0 +1,119 @@
// SPDX-License-Identifier: GPL-2.0+
/*
* Copyright (c) 2021 Nuvoton Technology Corp.
*/
#include <common.h>
#include <dm.h>
#include <generic-phy.h>
#include <reset.h>
#include <asm/io.h>
#include <dm/device_compat.h>
#include <linux/delay.h>
#include "ehci.h"
struct npcm_ehci_priv {
struct ehci_ctrl ctrl;
struct ehci_hccr *hcd;
struct phy phy;
};
static int npcm_ehci_setup_phy(struct udevice *dev, struct phy *phy)
{
int ret;
if (!phy)
return 0;
ret = generic_phy_get_by_index(dev, 0, phy);
if (ret) {
if (ret != -ENOENT) {
dev_err(dev, "failed to get usb phy\n");
return ret;
}
} else {
ret = generic_phy_init(phy);
if (ret) {
dev_err(dev, "failed to init usb phy\n");
return ret;
}
}
return 0;
}
static int npcm_ehci_init(struct udevice *dev)
{
struct npcm_ehci_priv *priv = dev_get_priv(dev);
struct reset_ctl reset;
int ret;
ret = reset_get_by_index(dev, 0, &reset);
if (ret && ret != -ENOENT && ret != -ENOTSUPP) {
dev_err(dev, "failed to get reset\n");
return ret;
}
/* reset controller */
if (reset_valid(&reset))
reset_assert(&reset);
/* setup phy */
ret = npcm_ehci_setup_phy(dev, &priv->phy);
if (ret)
return ret;
/* release controller from reset */
if (reset_valid(&reset))
reset_deassert(&reset);
return 0;
}
static int npcm_ehci_probe(struct udevice *dev)
{
struct npcm_ehci_priv *priv = dev_get_priv(dev);
struct ehci_hcor *hcor;
enum usb_init_type type = dev_get_driver_data(dev);
int ret;
ret = npcm_ehci_init(dev);
if (ret)
return ret;
priv->hcd = (struct ehci_hccr *)dev_read_addr_ptr(dev);
debug("USB HCD @0x%p\n", priv->hcd);
hcor = (struct ehci_hcor *)((uintptr_t)priv->hcd +
HC_LENGTH(ehci_readl(&priv->hcd->cr_capbase)));
return ehci_register(dev, priv->hcd, hcor, NULL, 0, type);
}
static int npcm_ehci_remove(struct udevice *dev)
{
struct npcm_ehci_priv *priv = dev_get_priv(dev);
generic_phy_exit(&priv->phy);
return ehci_deregister(dev);
}
static const struct udevice_id npcm_ehci_ids[] = {
{ .compatible = "nuvoton,npcm845-ehci", .data = USB_INIT_HOST },
{ .compatible = "nuvoton,npcm845-udc", .data = USB_INIT_DEVICE },
{ .compatible = "nuvoton,npcm750-ehci", .data = USB_INIT_HOST },
{ .compatible = "nuvoton,npcm750-udc", .data = USB_INIT_DEVICE },
{ }
};
U_BOOT_DRIVER(ehci_npcm) = {
.name = "ehci_npcm",
.id = UCLASS_USB,
.of_match = npcm_ehci_ids,
.probe = npcm_ehci_probe,
.remove = npcm_ehci_remove,
.ops = &ehci_usb_ops,
.priv_auto = sizeof(struct npcm_ehci_priv),
.plat_auto = sizeof(struct usb_plat),
.flags = DM_FLAG_ALLOC_PRIV_DMA,
};

View File

@ -0,0 +1,108 @@
// SPDX-License-Identifier: GPL-2.0+
/*
* Copyright (c) 2021 Nuvoton Technology Corp.
*/
#include <common.h>
#include <dm.h>
#include <generic-phy.h>
#include <reset.h>
#include <asm/io.h>
#include <dm/device_compat.h>
#include <linux/delay.h>
#include "ohci.h"
struct npcm_ohci_priv {
ohci_t ohci;
struct phy phy;
};
static int npcm_ohci_setup_phy(struct udevice *dev, struct phy *phy)
{
int ret;
if (!phy)
return 0;
ret = generic_phy_get_by_index(dev, 0, phy);
if (ret) {
if (ret != -ENOENT) {
dev_err(dev, "failed to get usb phy\n");
return ret;
}
} else {
ret = generic_phy_init(phy);
if (ret) {
dev_err(dev, "failed to init usb phy\n");
return ret;
}
}
return 0;
}
static int npcm_ohci_init(struct udevice *dev)
{
struct npcm_ohci_priv *priv = dev_get_priv(dev);
struct reset_ctl reset;
int ret;
ret = reset_get_by_index(dev, 0, &reset);
if (ret && ret != -ENOENT && ret != -ENOTSUPP) {
dev_err(dev, "failed to get reset\n");
return ret;
}
/* reset controller */
if (reset_valid(&reset))
reset_assert(&reset);
/* setup phy */
ret = npcm_ohci_setup_phy(dev, &priv->phy);
if (ret)
return ret;
/* release controller from reset */
if (reset_valid(&reset))
reset_deassert(&reset);
return 0;
}
static int npcm_ohci_probe(struct udevice *dev)
{
struct ohci_regs *regs = dev_read_addr_ptr(dev);
int ret;
ret = npcm_ohci_init(dev);
if (ret)
return ret;
return ohci_register(dev, regs);
}
static int npcm_ohci_remove(struct udevice *dev)
{
struct npcm_ohci_priv *priv = dev_get_priv(dev);
generic_phy_exit(&priv->phy);
return ohci_deregister(dev);
}
static const struct udevice_id npcm_ohci_ids[] = {
{ .compatible = "nuvoton,npcm845-ohci" },
{ .compatible = "nuvoton,npcm750-ohci" },
{ }
};
U_BOOT_DRIVER(ohci_npcm) = {
.name = "ohci_npcm",
.id = UCLASS_USB,
.of_match = npcm_ohci_ids,
.probe = npcm_ohci_probe,
.remove = npcm_ohci_remove,
.ops = &ohci_usb_ops,
.priv_auto = sizeof(struct npcm_ohci_priv),
.flags = DM_FLAG_ALLOC_PRIV_DMA,
};