sunxi: Move usb-controller init code out of ehci-sunxi.c for reuse for otg
Most of the usb-controller init code found in ehci-sunxi.c also is necessary to init the otg usb controller, so move it to a common place. While at it also update various #ifdefs / defines for sun8i support. Signed-off-by: Hans de Goede <hdegoede@redhat.com> Acked-by: Ian Campbell <ijc@hellion.org.uk>
This commit is contained in:
@@ -9,199 +9,23 @@
|
||||
* SPDX-License-Identifier: GPL-2.0+
|
||||
*/
|
||||
|
||||
#include <asm/arch/clock.h>
|
||||
#include <asm/arch/cpu.h>
|
||||
#include <asm/gpio.h>
|
||||
#include <asm/io.h>
|
||||
#include <asm/arch/usbc.h>
|
||||
#include <common.h>
|
||||
#include "ehci.h"
|
||||
|
||||
#define SUNXI_USB_PMU_IRQ_ENABLE 0x800
|
||||
#define SUNXI_USB_CSR 0x404
|
||||
#define SUNXI_USB_PASSBY_EN 1
|
||||
|
||||
#define SUNXI_EHCI_AHB_ICHR8_EN (1 << 10)
|
||||
#define SUNXI_EHCI_AHB_INCR4_BURST_EN (1 << 9)
|
||||
#define SUNXI_EHCI_AHB_INCRX_ALIGN_EN (1 << 8)
|
||||
#define SUNXI_EHCI_ULPI_BYPASS_EN (1 << 0)
|
||||
|
||||
static struct sunxi_ehci_hcd {
|
||||
struct usb_hcd *hcd;
|
||||
int usb_rst_mask;
|
||||
int ahb_clk_mask;
|
||||
int gpio_vbus;
|
||||
int irq;
|
||||
int id;
|
||||
} sunxi_echi_hcd[] = {
|
||||
{
|
||||
.usb_rst_mask = CCM_USB_CTRL_PHY1_RST | CCM_USB_CTRL_PHY1_CLK,
|
||||
.ahb_clk_mask = 1 << AHB_GATE_OFFSET_USB_EHCI0,
|
||||
#ifndef CONFIG_MACH_SUN6I
|
||||
.irq = 39,
|
||||
#else
|
||||
.irq = 72,
|
||||
#endif
|
||||
.id = 1,
|
||||
},
|
||||
#if (CONFIG_USB_MAX_CONTROLLER_COUNT > 1)
|
||||
{
|
||||
.usb_rst_mask = CCM_USB_CTRL_PHY2_RST | CCM_USB_CTRL_PHY2_CLK,
|
||||
.ahb_clk_mask = 1 << AHB_GATE_OFFSET_USB_EHCI1,
|
||||
#ifndef CONFIG_MACH_SUN6I
|
||||
.irq = 40,
|
||||
#else
|
||||
.irq = 74,
|
||||
#endif
|
||||
.id = 2,
|
||||
}
|
||||
#endif
|
||||
};
|
||||
|
||||
static int enabled_hcd_count;
|
||||
|
||||
static void *get_io_base(int hcd_id)
|
||||
{
|
||||
switch (hcd_id) {
|
||||
case 0:
|
||||
return (void *)SUNXI_USB0_BASE;
|
||||
case 1:
|
||||
return (void *)SUNXI_USB1_BASE;
|
||||
case 2:
|
||||
return (void *)SUNXI_USB2_BASE;
|
||||
default:
|
||||
return NULL;
|
||||
}
|
||||
}
|
||||
|
||||
static int get_vbus_gpio(int hcd_id)
|
||||
{
|
||||
switch (hcd_id) {
|
||||
case 1: return sunxi_name_to_gpio(CONFIG_USB1_VBUS_PIN);
|
||||
case 2: return sunxi_name_to_gpio(CONFIG_USB2_VBUS_PIN);
|
||||
}
|
||||
return -1;
|
||||
}
|
||||
|
||||
static void usb_phy_write(struct sunxi_ehci_hcd *sunxi_ehci, int addr,
|
||||
int data, int len)
|
||||
{
|
||||
int j = 0, usbc_bit = 0;
|
||||
void *dest = get_io_base(0) + SUNXI_USB_CSR;
|
||||
|
||||
usbc_bit = 1 << (sunxi_ehci->id * 2);
|
||||
for (j = 0; j < len; j++) {
|
||||
/* set the bit address to be written */
|
||||
clrbits_le32(dest, 0xff << 8);
|
||||
setbits_le32(dest, (addr + j) << 8);
|
||||
|
||||
clrbits_le32(dest, usbc_bit);
|
||||
/* set data bit */
|
||||
if (data & 0x1)
|
||||
setbits_le32(dest, 1 << 7);
|
||||
else
|
||||
clrbits_le32(dest, 1 << 7);
|
||||
|
||||
setbits_le32(dest, usbc_bit);
|
||||
|
||||
clrbits_le32(dest, usbc_bit);
|
||||
|
||||
data >>= 1;
|
||||
}
|
||||
}
|
||||
|
||||
static void sunxi_usb_phy_init(struct sunxi_ehci_hcd *sunxi_ehci)
|
||||
{
|
||||
/* The following comments are machine
|
||||
* translated from Chinese, you have been warned!
|
||||
*/
|
||||
|
||||
/* adjust PHY's magnitude and rate */
|
||||
usb_phy_write(sunxi_ehci, 0x20, 0x14, 5);
|
||||
|
||||
/* threshold adjustment disconnect */
|
||||
#if defined CONFIG_MACH_SUN4I || defined CONFIG_MACH_SUN6I
|
||||
usb_phy_write(sunxi_ehci, 0x2a, 3, 2);
|
||||
#else
|
||||
usb_phy_write(sunxi_ehci, 0x2a, 2, 2);
|
||||
#endif
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
static void sunxi_usb_passby(struct sunxi_ehci_hcd *sunxi_ehci, int enable)
|
||||
{
|
||||
unsigned long bits = 0;
|
||||
void *addr = get_io_base(sunxi_ehci->id) + SUNXI_USB_PMU_IRQ_ENABLE;
|
||||
|
||||
bits = SUNXI_EHCI_AHB_ICHR8_EN |
|
||||
SUNXI_EHCI_AHB_INCR4_BURST_EN |
|
||||
SUNXI_EHCI_AHB_INCRX_ALIGN_EN |
|
||||
SUNXI_EHCI_ULPI_BYPASS_EN;
|
||||
|
||||
if (enable)
|
||||
setbits_le32(addr, bits);
|
||||
else
|
||||
clrbits_le32(addr, bits);
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
static void sunxi_ehci_enable(struct sunxi_ehci_hcd *sunxi_ehci)
|
||||
{
|
||||
struct sunxi_ccm_reg *ccm = (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
|
||||
|
||||
setbits_le32(&ccm->usb_clk_cfg, sunxi_ehci->usb_rst_mask);
|
||||
setbits_le32(&ccm->ahb_gate0, sunxi_ehci->ahb_clk_mask);
|
||||
#ifdef CONFIG_MACH_SUN6I
|
||||
setbits_le32(&ccm->ahb_reset0_cfg, sunxi_ehci->ahb_clk_mask);
|
||||
#endif
|
||||
|
||||
sunxi_usb_phy_init(sunxi_ehci);
|
||||
|
||||
sunxi_usb_passby(sunxi_ehci, SUNXI_USB_PASSBY_EN);
|
||||
|
||||
if (sunxi_ehci->gpio_vbus != -1)
|
||||
gpio_direction_output(sunxi_ehci->gpio_vbus, 1);
|
||||
}
|
||||
|
||||
static void sunxi_ehci_disable(struct sunxi_ehci_hcd *sunxi_ehci)
|
||||
{
|
||||
struct sunxi_ccm_reg *ccm = (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
|
||||
|
||||
if (sunxi_ehci->gpio_vbus != -1)
|
||||
gpio_direction_output(sunxi_ehci->gpio_vbus, 0);
|
||||
|
||||
sunxi_usb_passby(sunxi_ehci, !SUNXI_USB_PASSBY_EN);
|
||||
|
||||
#ifdef CONFIG_MACH_SUN6I
|
||||
clrbits_le32(&ccm->ahb_reset0_cfg, sunxi_ehci->ahb_clk_mask);
|
||||
#endif
|
||||
clrbits_le32(&ccm->ahb_gate0, sunxi_ehci->ahb_clk_mask);
|
||||
clrbits_le32(&ccm->usb_clk_cfg, sunxi_ehci->usb_rst_mask);
|
||||
}
|
||||
|
||||
int ehci_hcd_init(int index, enum usb_init_type init, struct ehci_hccr **hccr,
|
||||
struct ehci_hcor **hcor)
|
||||
{
|
||||
struct sunxi_ccm_reg *ccm = (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
|
||||
struct sunxi_ehci_hcd *sunxi_ehci = &sunxi_echi_hcd[index];
|
||||
int err;
|
||||
|
||||
sunxi_ehci->gpio_vbus = get_vbus_gpio(sunxi_ehci->id);
|
||||
err = sunxi_usbc_request_resources(index + 1);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
/* enable common PHY only once */
|
||||
if (index == 0)
|
||||
setbits_le32(&ccm->usb_clk_cfg, CCM_USB_CTRL_PHYGATE);
|
||||
sunxi_usbc_enable(index + 1);
|
||||
sunxi_usbc_vbus_enable(index + 1);
|
||||
|
||||
if (sunxi_ehci->gpio_vbus != -1) {
|
||||
err = gpio_request(sunxi_ehci->gpio_vbus, "ehci_vbus");
|
||||
if (err)
|
||||
return err;
|
||||
}
|
||||
|
||||
sunxi_ehci_enable(sunxi_ehci);
|
||||
|
||||
*hccr = get_io_base(sunxi_ehci->id);
|
||||
*hccr = sunxi_usbc_get_io_base(index + 1);
|
||||
|
||||
*hcor = (struct ehci_hcor *)((uint32_t) *hccr
|
||||
+ HC_LENGTH(ehci_readl(&(*hccr)->cr_capbase)));
|
||||
@@ -210,30 +34,13 @@ int ehci_hcd_init(int index, enum usb_init_type init, struct ehci_hccr **hccr,
|
||||
(uint32_t)*hccr, (uint32_t)*hcor,
|
||||
(uint32_t)HC_LENGTH(ehci_readl(&(*hccr)->cr_capbase)));
|
||||
|
||||
enabled_hcd_count++;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int ehci_hcd_stop(int index)
|
||||
{
|
||||
struct sunxi_ccm_reg *ccm = (struct sunxi_ccm_reg *)SUNXI_CCM_BASE;
|
||||
struct sunxi_ehci_hcd *sunxi_ehci = &sunxi_echi_hcd[index];
|
||||
int err;
|
||||
sunxi_usbc_vbus_disable(index + 1);
|
||||
sunxi_usbc_disable(index + 1);
|
||||
|
||||
sunxi_ehci_disable(sunxi_ehci);
|
||||
|
||||
if (sunxi_ehci->gpio_vbus != -1) {
|
||||
err = gpio_free(sunxi_ehci->gpio_vbus);
|
||||
if (err)
|
||||
return err;
|
||||
}
|
||||
|
||||
/* disable common PHY only once, for the last enabled hcd */
|
||||
if (enabled_hcd_count == 1)
|
||||
clrbits_le32(&ccm->usb_clk_cfg, CCM_USB_CTRL_PHYGATE);
|
||||
|
||||
enabled_hcd_count--;
|
||||
|
||||
return 0;
|
||||
return sunxi_usbc_free_resources(index + 1);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user