|
@@ -0,0 +1,85 @@
|
|
|
+/*
|
|
|
+ * Copyright (C) 2015 Panasonic Corporation
|
|
|
+ * Author: Masahiro Yamada <yamada.m@jp.panasonic.com>
|
|
|
+ *
|
|
|
+ * SPDX-License-Identifier: GPL-2.0+
|
|
|
+ */
|
|
|
+
|
|
|
+#include <common.h>
|
|
|
+#include <linux/err.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_PANASONIC_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);
|
|
|
+}
|