86 lines
1.5 KiB
C
86 lines
1.5 KiB
C
/*
|
|
* Copyright (C) 2015 Masahiro Yamada <yamada.masahiro@socionext.com>
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <linux/err.h>
|
|
#include <linux/io.h>
|
|
#include <usb.h>
|
|
#include <fdtdec.h>
|
|
#include "xhci.h"
|
|
|
|
static int get_uniphier_xhci_base(int index, struct xhci_hccr **base)
|
|
{
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
int node_list[2];
|
|
fdt_addr_t addr;
|
|
int count;
|
|
|
|
count = fdtdec_find_aliases_for_id(gd->fdt_blob, "usb",
|
|
COMPAT_SOCIONEXT_XHCI, node_list,
|
|
ARRAY_SIZE(node_list));
|
|
|
|
if (index >= count)
|
|
return -ENODEV;
|
|
|
|
addr = fdtdec_get_addr(gd->fdt_blob, node_list[index], "reg");
|
|
if (addr == FDT_ADDR_T_NONE)
|
|
return -ENODEV;
|
|
|
|
*base = (struct xhci_hccr *)addr;
|
|
|
|
return 0;
|
|
}
|
|
|
|
#define USB3_RST_CTRL 0x00100040
|
|
#define IOMMU_RST_N (1 << 5)
|
|
#define LINK_RST_N (1 << 4)
|
|
|
|
static void uniphier_xhci_reset(void __iomem *base, int on)
|
|
{
|
|
u32 tmp;
|
|
|
|
tmp = readl(base + USB3_RST_CTRL);
|
|
|
|
if (on)
|
|
tmp &= ~(IOMMU_RST_N | LINK_RST_N);
|
|
else
|
|
tmp |= IOMMU_RST_N | LINK_RST_N;
|
|
|
|
writel(tmp, base + USB3_RST_CTRL);
|
|
}
|
|
|
|
int xhci_hcd_init(int index, struct xhci_hccr **hccr, struct xhci_hcor **hcor)
|
|
{
|
|
int ret;
|
|
struct xhci_hccr *cr;
|
|
struct xhci_hcor *or;
|
|
|
|
ret = get_uniphier_xhci_base(index, &cr);
|
|
if (ret < 0)
|
|
return ret;
|
|
|
|
uniphier_xhci_reset(cr, 0);
|
|
|
|
or = (void *)cr + HC_LENGTH(xhci_readl(&cr->cr_capbase));
|
|
|
|
*hccr = cr;
|
|
*hcor = or;
|
|
|
|
return 0;
|
|
}
|
|
|
|
void xhci_hcd_stop(int index)
|
|
{
|
|
int ret;
|
|
struct xhci_hccr *cr;
|
|
|
|
ret = get_uniphier_xhci_base(index, &cr);
|
|
if (ret < 0)
|
|
return;
|
|
|
|
uniphier_xhci_reset(cr, 1);
|
|
}
|