netease
/
SmartAudio
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
SmartAudio/lichee/linux-4.9/drivers/usb/host/ehci_sunxi.c

1007 lines
23 KiB
C
Executable File
Raw Blame History

/**
* drivers/usb/host/ehci_sunxi.c
* (C) Copyright 2010-2015
* Allwinner Technology Co., Ltd. <www.allwinnertech.com>
* yangnaitian, 2011-5-24, create this file
* javen, 2011-6-26, add suspend and resume
* javen, 2011-7-18, move clock and power operations out from driver
*
* SoftWinner EHCI Driver
*
* This program is free software; you can redistribute it and/or
* modify it under the terms of the GNU General Public License as
* published by the Free Software Foundation; either version 2 of
* the License, or (at your option) any later version.
*
*/
#include <linux/platform_device.h>
#include <linux/time.h>
#include <linux/timer.h>
#include <linux/clk.h>
#include "sunxi_hci.h"
#define SUNXI_EHCI_NAME "sunxi-ehci"
static const char ehci_name[] = SUNXI_EHCI_NAME;
#if IS_ENABLED(CONFIG_USB_SUNXI_EHCI0)
#define SUNXI_EHCI0_OF_MATCH "allwinner,sunxi-ehci0"
#else
#define SUNXI_EHCI0_OF_MATCH "null"
#endif
#if IS_ENABLED(CONFIG_USB_SUNXI_EHCI1)
#define SUNXI_EHCI1_OF_MATCH "allwinner,sunxi-ehci1"
#else
#define SUNXI_EHCI1_OF_MATCH "null"
#endif
#if IS_ENABLED(CONFIG_USB_SUNXI_EHCI2)
#define SUNXI_EHCI2_OF_MATCH "allwinner,sunxi-ehci2"
#else
#define SUNXI_EHCI2_OF_MATCH "null"
#endif
#if IS_ENABLED(CONFIG_USB_SUNXI_EHCI3)
#define SUNXI_EHCI3_OF_MATCH "allwinner,sunxi-ehci3"
#else
#define SUNXI_EHCI3_OF_MATCH "null"
#endif
static struct sunxi_hci_hcd *g_sunxi_ehci[4];
static u32 ehci_first_probe[4] = {1, 1, 1, 1};
static u32 ehci_enable[4] = {1, 1, 1, 1};
#ifdef CONFIG_PM
static void sunxi_ehci_resume_work(struct work_struct *work);
#endif
int sunxi_usb_disable_ehci(__u32 usbc_no);
int sunxi_usb_enable_ehci(__u32 usbc_no);
static void ehci_set_interrupt_enable(const struct ehci_hcd *ehci,
void __iomem *regs, u32 enable)
{
ehci_writel(ehci, enable & 0x3f, (regs + EHCI_OPR_USBINTR));
}
static void ehci_disable_periodic_schedule(const struct ehci_hcd *ehci,
void __iomem *regs)
{
u32 reg_val = 0;
reg_val = ehci_readl(ehci, (regs + EHCI_OPR_USBCMD));
reg_val &= ~(0x1<<4);
ehci_writel(ehci, reg_val, (regs + EHCI_OPR_USBCMD));
}
static void ehci_disable_async_schedule(const struct ehci_hcd *ehci,
void __iomem *regs)
{
unsigned int reg_val = 0;
reg_val = ehci_readl(ehci, (regs + EHCI_OPR_USBCMD));
reg_val &= ~(0x1<<5);
ehci_writel(ehci, reg_val, (regs + EHCI_OPR_USBCMD));
}
static void ehci_set_config_flag(const struct ehci_hcd *ehci,
void __iomem *regs)
{
ehci_writel(ehci, 0x1, (regs + EHCI_OPR_CFGFLAG));
}
static void ehci_test_stop(const struct ehci_hcd *ehci,
void __iomem *regs)
{
unsigned int reg_val = 0;
reg_val = ehci_readl(ehci, (regs + EHCI_OPR_USBCMD));
reg_val &= (~0x1);
ehci_writel(ehci, reg_val, (regs + EHCI_OPR_USBCMD));
}
static void ehci_test_reset(const struct ehci_hcd *ehci,
void __iomem *regs)
{
u32 reg_val = 0;
reg_val = ehci_readl(ehci, (regs + EHCI_OPR_USBCMD));
reg_val |= (0x1<<1);
ehci_writel(ehci, reg_val, (regs + EHCI_OPR_USBCMD));
}
static unsigned int ehci_test_reset_complete(const struct ehci_hcd *ehci,
void __iomem *regs)
{
unsigned int reg_val = 0;
reg_val = ehci_readl(ehci, (regs + EHCI_OPR_USBCMD));
reg_val &= (0x1<<1);
return !reg_val;
}
static void ehci_start(const struct ehci_hcd *ehci, void __iomem *regs)
{
unsigned int reg_val = 0;
reg_val = ehci_readl(ehci, (regs + EHCI_OPR_USBCMD));
reg_val |= 0x1;
ehci_writel(ehci, reg_val, (regs + EHCI_OPR_USBCMD));
}
static unsigned int ehci_is_halt(const struct ehci_hcd *ehci,
void __iomem *regs)
{
unsigned int reg_val = 0;
reg_val = ehci_readl(ehci, (regs + EHCI_OPR_USBSTS)) >> 12;
reg_val &= 0x1;
return reg_val;
}
static void ehci_port_control(const struct ehci_hcd *ehci,
void __iomem *regs, u32 port_no, u32 control)
{
ehci_writel(ehci, control, (regs + EHCI_OPR_USBCMD + (port_no<<2)));
}
static void ehci_put_port_suspend(const struct ehci_hcd *ehci,
void __iomem *regs)
{
unsigned int reg_val = 0;
reg_val = ehci_readl(ehci, (regs + EHCI_OPR_PORTSC));
reg_val |= (0x01<<7);
ehci_writel(ehci, reg_val, (regs + EHCI_OPR_PORTSC));
}
static void ehci_test_mode(const struct ehci_hcd *ehci,
void __iomem *regs, u32 test_mode)
{
unsigned int reg_val = 0;
reg_val = ehci_readl(ehci, (regs + EHCI_OPR_PORTSC));
reg_val &= ~(0x0f<<16);
reg_val |= test_mode;
ehci_writel(ehci, reg_val, (regs + EHCI_OPR_PORTSC));
}
static void __ehci_ed_test(const struct ehci_hcd *ehci,
void __iomem *regs, __u32 test_mode)
{
ehci_set_interrupt_enable(ehci, regs, 0x00);
ehci_disable_periodic_schedule(ehci, regs);
ehci_disable_async_schedule(ehci, regs);
ehci_set_config_flag(ehci, regs);
ehci_test_stop(ehci, regs);
ehci_test_reset(ehci, regs);
/* Wait until EHCI reset complete. */
while (!ehci_test_reset_complete(ehci, regs))
;
if (!ehci_is_halt(ehci, regs))
DMSG_ERR("%s_%d\n", __func__, __LINE__);
ehci_start(ehci, regs);
/* Wait until EHCI to be not halt. */
while (ehci_is_halt(ehci, regs))
;
/* Ehci start, config to test. */
ehci_set_config_flag(ehci, regs);
ehci_port_control(ehci, regs, 0, EHCI_PORTSC_POWER);
ehci_disable_periodic_schedule(ehci, regs);
ehci_disable_async_schedule(ehci, regs);
/* Put port suspend. */
ehci_put_port_suspend(ehci, regs);
ehci_test_stop(ehci, regs);
while ((!ehci_is_halt(ehci, regs)))
;
/* Test pack. */
DMSG_INFO("Start Host Test,mode:0x%x!\n", test_mode);
ehci_test_mode(ehci, regs, test_mode);
DMSG_INFO("End Host Test,mode:0x%x!\n", test_mode);
}
static ssize_t show_ed_test(struct device *dev,
struct device_attribute *attr, char *buf)
{
return sprintf(buf, "USB2.0 host test mode:\n"
"echo:\ntest_j_state\ntest_k_state\ntest_se0_nak\n"
"test_pack\ntest_force_enable\ntest_mask\n\n");
}
static ssize_t ehci_ed_test(struct device *dev, struct device_attribute *attr,
const char *buf, size_t count)
{
__u32 test_mode = 0;
struct usb_hcd *hcd = NULL;
struct ehci_hcd *ehci = NULL;
if (dev == NULL) {
DMSG_PANIC("ERR: Argment is invalid\n");
return 0;
}
hcd = dev_get_drvdata(dev);
if (hcd == NULL) {
DMSG_PANIC("ERR: hcd is null\n");
return 0;
}
ehci = hcd_to_ehci(hcd);
if (ehci == NULL) {
DMSG_PANIC("ERR: ehci is null\n");
return 0;
}
mutex_lock(&dev->mutex);
DMSG_INFO("ehci_ed_test:%s\n", buf);
if (!strncmp(buf, "test_not_operating", 18)) {
test_mode = EHCI_PORTSC_PTC_DIS;
DMSG_INFO("test_mode:0x%x\n", test_mode);
} else if (!strncmp(buf, "test_j_state", 12)) {
test_mode = EHCI_PORTSC_PTC_J;
DMSG_INFO("test_mode:0x%x\n", test_mode);
} else if (!strncmp(buf, "test_k_state", 12)) {
test_mode = EHCI_PORTSC_PTC_K;
DMSG_INFO("test_mode:0x%x\n", test_mode);
} else if (!strncmp(buf, "test_se0_nak", 12)) {
test_mode = EHCI_PORTSC_PTC_SE0NAK;
DMSG_INFO("test_mode:0x%x\n", test_mode);
} else if (!strncmp(buf, "test_pack", 9)) {
test_mode = EHCI_PORTSC_PTC_PACKET;
DMSG_INFO("test_mode:0x%x\n", test_mode);
} else if (!strncmp(buf, "test_force_enable", 17)) {
test_mode = EHCI_PORTSC_PTC_FORCE;
DMSG_INFO("test_mode:0x%x\n", test_mode);
} else if (!strncmp(buf, "test_mask", 9)) {
test_mode = EHCI_PORTSC_PTC_MASK;
DMSG_INFO("test_mode:0x%x\n", test_mode);
} else {
DMSG_PANIC("ERR: test_mode Argment is invalid\n");
mutex_unlock(&dev->mutex);
return count;
}
DMSG_INFO("regs: 0x%p\n", hcd->regs);
__ehci_ed_test(ehci, hcd->regs, test_mode);
mutex_unlock(&dev->mutex);
return count;
}
static DEVICE_ATTR(ed_test, 0644, show_ed_test, ehci_ed_test);
static ssize_t show_phy_threshold(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
sunxi_ehci = dev->platform_data;
return sprintf(buf, "threshold:0x%x\n",
usb_phyx_tp_read(sunxi_ehci, 0x2a, 2));
}
static ssize_t ehci_phy_threshold(struct device *dev,
struct device_attribute *attr, const char *buf, size_t count)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
int val = 0;
int err;
err = kstrtoint(buf, 16, &val);
if (err != 0)
return -EINVAL;
if (dev == NULL) {
DMSG_PANIC("ERR: Argment is invalid\n");
return 0;
}
sunxi_ehci = dev->platform_data;
if ((val >= 0) && (val <= 0x3)) {
usb_phyx_tp_write(sunxi_ehci, 0x2a, val, 2);
} else {
DMSG_PANIC("adjust disconnect threshold 0x%x is fail, value:0x0~0x3\n", val);
return count;
}
DMSG_INFO("adjust succeed: threshold val:0x%x, no:%x\n",
usb_phyx_tp_read(sunxi_ehci, 0x2a, 2),
sunxi_ehci->usbc_no);
return count;
}
static DEVICE_ATTR(phy_threshold, 0644, show_phy_threshold, ehci_phy_threshold);
static ssize_t show_phy_range(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
sunxi_ehci = dev->platform_data;
return sprintf(buf, "rate:0x%x\n",
usb_phyx_tp_read(sunxi_ehci, 0x20, 5));
}
static ssize_t ehci_phy_range(struct device *dev, struct device_attribute *attr,
const char *buf, size_t count)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
int val = 0;
int err;
if (dev == NULL) {
DMSG_PANIC("ERR: Argment is invalid\n");
return 0;
}
err = kstrtoint(buf, 16, &val);
if (err != 0)
return -EINVAL;
sunxi_ehci = dev->platform_data;
DMSG_INFO("adjust PHY's rate and range:0x0~0x1f\n");
if ((val >= 0) && (val <= 0x1f)) {
usb_phyx_tp_write(sunxi_ehci, 0x20, val, 5);
} else {
DMSG_PANIC("adjust PHY's rate and range 0x%x is fail, value:0x0~0x1f\n", val);
return count;
}
DMSG_INFO("adjust succeed:,rate val:0x%x, no:%d\n",
usb_phyx_tp_read(sunxi_ehci, 0x20, 5),
sunxi_ehci->usbc_no);
return count;
}
static DEVICE_ATTR(phy_range, 0644, show_phy_range, ehci_phy_range);
static ssize_t ehci_enable_show(struct device *dev,
struct device_attribute *attr, char *buf)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
if (dev == NULL) {
DMSG_PANIC("ERR: Argment is invalid\n");
return 0;
}
sunxi_ehci = dev->platform_data;
if (sunxi_ehci == NULL) {
DMSG_PANIC("ERR: sw_ehci is null\n");
return 0;
}
return sprintf(buf, "ehci:%d, probe:%u\n",
sunxi_ehci->usbc_no, sunxi_ehci->probe);
}
static ssize_t ehci_enable_store(struct device *dev,
struct device_attribute *attr, const char *buf, size_t count)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
int value = 0;
int err;
if (dev == NULL) {
DMSG_PANIC("ERR: Argment is invalid\n");
return 0;
}
sunxi_ehci = dev->platform_data;
if (sunxi_ehci == NULL) {
DMSG_PANIC("ERR: sw_ehci is null\n");
return 0;
}
sunxi_ehci->host_init_state = 0;
ehci_first_probe[sunxi_ehci->usbc_no] = 0;
err = kstrtoint(buf, 10, &value);
if (err != 0)
return -EINVAL;
if (value == 1) {
ehci_enable[sunxi_ehci->usbc_no] = 0;
sunxi_ehci->hsic_enable_flag = 1;
sunxi_usb_enable_ehci(sunxi_ehci->usbc_no);
if (sunxi_ehci->usbc_no == HCI0_USBC_NO)
sunxi_set_host_vbus(sunxi_ehci, 1);
if (sunxi_ehci->hsic_ctrl_flag)
sunxi_set_host_hisc_rdy(sunxi_ehci, 1);
} else if (value == 0) {
if (sunxi_ehci->hsic_ctrl_flag)
sunxi_set_host_hisc_rdy(sunxi_ehci, 0);
ehci_enable[sunxi_ehci->usbc_no] = 1;
sunxi_usb_disable_ehci(sunxi_ehci->usbc_no);
sunxi_ehci->hsic_enable_flag = 0;
ehci_enable[sunxi_ehci->usbc_no] = 0;
} else {
DMSG_INFO("unknown value (%d)\n", value);
}
return count;
}
static DEVICE_ATTR(ehci_enable, 0664, ehci_enable_show, ehci_enable_store);
static void sunxi_hcd_board_set_vbus(
struct sunxi_hci_hcd *sunxi_ehci, int is_on)
{
sunxi_ehci->set_power(sunxi_ehci, is_on);
}
static void sunxi_hcd_board_set_passby(struct sunxi_hci_hcd *sunxi_ehci,
int is_on)
{
sunxi_ehci->usb_passby(sunxi_ehci, is_on);
}
static int open_ehci_clock(struct sunxi_hci_hcd *sunxi_ehci)
{
return sunxi_ehci->open_clock(sunxi_ehci, 0);
}
static int close_ehci_clock(struct sunxi_hci_hcd *sunxi_ehci)
{
return sunxi_ehci->close_clock(sunxi_ehci, 0);
}
static void sunxi_start_ehci(struct sunxi_hci_hcd *sunxi_ehci)
{
open_ehci_clock(sunxi_ehci);
sunxi_hcd_board_set_passby(sunxi_ehci, 1);
sunxi_hcd_board_set_vbus(sunxi_ehci, 1);
}
static void sunxi_stop_ehci(struct sunxi_hci_hcd *sunxi_ehci)
{
sunxi_hcd_board_set_vbus(sunxi_ehci, 0);
sunxi_hcd_board_set_passby(sunxi_ehci, 0);
close_ehci_clock(sunxi_ehci);
}
static int sunxi_ehci_setup(struct usb_hcd *hcd)
{
struct ehci_hcd *ehci = hcd_to_ehci(hcd);
int ret = ehci_init(hcd);
ehci->need_io_watchdog = 0;
return ret;
}
static const struct hc_driver sunxi_ehci_hc_driver = {
.description = hcd_name,
.product_desc = "SW USB2.0 'Enhanced' Host Controller (EHCI) Driver",
.hcd_priv_size = sizeof(struct ehci_hcd),
/**
* generic hardware linkage
*/
.irq = ehci_irq,
.flags = HCD_MEMORY | HCD_USB2 | HCD_BH,
/**
* basic lifecycle operations
*
* FIXME -- ehci_init() doesn't do enough here.
* See ehci-ppc-soc for a complete implementation.
*/
.reset = sunxi_ehci_setup,
.start = ehci_run,
.stop = ehci_stop,
.shutdown = ehci_shutdown,
/**
* managing i/o requests and associated device resources
*/
.urb_enqueue = ehci_urb_enqueue,
.urb_dequeue = ehci_urb_dequeue,
.endpoint_disable = ehci_endpoint_disable,
.endpoint_reset = ehci_endpoint_reset,
/**
* scheduling support
*/
.get_frame_number = ehci_get_frame,
/**
* root hub support
*/
.hub_status_data = ehci_hub_status_data,
.hub_control = ehci_hub_control,
.bus_suspend = ehci_bus_suspend,
.bus_resume = ehci_bus_resume,
.relinquish_port = ehci_relinquish_port,
.port_handed_over = ehci_port_handed_over,
.clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,
};
int sunxi_insmod_ehci(struct platform_device *pdev)
{
struct usb_hcd *hcd = NULL;
struct ehci_hcd *ehci = NULL;
struct sunxi_hci_hcd *sunxi_ehci = NULL;
int ret = 0;
sunxi_ehci = pdev->dev.platform_data;
if (!sunxi_ehci) {
DMSG_PANIC("ERR: sunxi_ehci is null\n");
ret = -ENOMEM;
goto ERR1;
}
sunxi_ehci->pdev = pdev;
g_sunxi_ehci[sunxi_ehci->usbc_no] = sunxi_ehci;
DMSG_INFO("[%s%d]: probe, pdev->name: %s, sunxi_ehci: 0x%p, 0x:%p, irq_no:%x\n",
ehci_name, sunxi_ehci->usbc_no, pdev->name,
sunxi_ehci, sunxi_ehci->usb_vbase, sunxi_ehci->irq_no);
/* get io resource */
sunxi_ehci->ehci_base = sunxi_ehci->usb_vbase;
sunxi_ehci->ehci_reg_length = SUNXI_USB_EHCI_LEN;
/* creat a usb_hcd for the ehci controller */
hcd = usb_create_hcd(&sunxi_ehci_hc_driver, &pdev->dev, ehci_name);
if (!hcd) {
DMSG_PANIC("ERR: usb_create_hcd failed\n");
ret = -ENOMEM;
goto ERR2;
}
hcd->rsrc_start = sunxi_ehci->usb_base_res->start;
hcd->rsrc_len = SUNXI_USB_EHCI_LEN;
hcd->regs = sunxi_ehci->ehci_base;
sunxi_ehci->hcd = hcd;
/* echi start to work */
sunxi_start_ehci(sunxi_ehci);
ehci = hcd_to_ehci(hcd);
ehci->caps = hcd->regs;
ehci->regs = hcd->regs +
HC_LENGTH(ehci, readl(&ehci->caps->hc_capbase));
/* cache this readonly data, minimize chip reads */
ehci->hcs_params = readl(&ehci->caps->hcs_params);
ret = usb_add_hcd(hcd, sunxi_ehci->irq_no, IRQF_SHARED);
if (ret != 0) {
DMSG_PANIC("ERR: usb_add_hcd failed\n");
ret = -ENOMEM;
goto ERR3;
}
device_wakeup_enable(hcd->self.controller);
platform_set_drvdata(pdev, hcd);
device_create_file(&pdev->dev, &dev_attr_ed_test);
device_create_file(&pdev->dev, &dev_attr_phy_threshold);
device_create_file(&pdev->dev, &dev_attr_phy_range);
#ifndef USB_SYNC_SUSPEND
device_enable_async_suspend(&pdev->dev);
#endif
sunxi_ehci->probe = 1;
#ifdef CONFIG_PM
if (!sunxi_ehci->wakeup_suspend)
INIT_WORK(&sunxi_ehci->resume_work, sunxi_ehci_resume_work);
#endif
/* Disable ehci, when driver probe */
if (sunxi_ehci->host_init_state == 0) {
if (ehci_first_probe[sunxi_ehci->usbc_no]) {
sunxi_usb_disable_ehci(sunxi_ehci->usbc_no);
ehci_first_probe[sunxi_ehci->usbc_no] = 0;
}
}
return 0;
ERR3:
usb_put_hcd(hcd);
sunxi_stop_ehci(sunxi_ehci);
ERR2:
sunxi_ehci->hcd = NULL;
g_sunxi_ehci[sunxi_ehci->usbc_no] = NULL;
ERR1:
return ret;
}
int sunxi_rmmod_ehci(struct platform_device *pdev)
{
struct usb_hcd *hcd = NULL;
struct sunxi_hci_hcd *sunxi_ehci = NULL;
if (pdev == NULL) {
DMSG_PANIC("ERR: Argment is invalid\n");
return -1;
}
hcd = platform_get_drvdata(pdev);
if (hcd == NULL) {
DMSG_PANIC("ERR: hcd is null\n");
return -1;
}
sunxi_ehci = pdev->dev.platform_data;
if (sunxi_ehci == NULL) {
DMSG_PANIC("ERR: sunxi_ehci is null\n");
return -1;
}
DMSG_INFO("[%s%d]: remove, pdev->name: %s, sunxi_ehci: 0x%p\n",
ehci_name, sunxi_ehci->usbc_no, pdev->name, sunxi_ehci);
device_remove_file(&pdev->dev, &dev_attr_ed_test);
device_remove_file(&pdev->dev, &dev_attr_phy_threshold);
device_remove_file(&pdev->dev, &dev_attr_phy_range);
usb_remove_hcd(hcd);
usb_put_hcd(hcd);
sunxi_stop_ehci(sunxi_ehci);
sunxi_ehci->probe = 0;
sunxi_ehci->hcd = NULL;
return 0;
}
static int sunxi_ehci_hcd_probe(struct platform_device *pdev)
{
int ret = 0;
struct sunxi_hci_hcd *sunxi_ehci = NULL;
if (pdev == NULL) {
DMSG_PANIC("ERR: %s, Argment is invalid\n", __func__);
return -1;
}
/* if usb is disabled, can not probe */
if (usb_disabled()) {
DMSG_PANIC("ERR: usb hcd is disabled\n");
return -ENODEV;
}
ret = init_sunxi_hci(pdev, SUNXI_USB_EHCI);
if (ret != 0) {
dev_err(&pdev->dev, "init_sunxi_hci is fail\n");
return -1;
}
sunxi_insmod_ehci(pdev);
sunxi_ehci = pdev->dev.platform_data;
if (sunxi_ehci == NULL) {
DMSG_PANIC("ERR: %s, sunxi_ehci is null\n", __func__);
return -1;
}
if (ehci_enable[sunxi_ehci->usbc_no]) {
device_create_file(&pdev->dev, &dev_attr_ehci_enable);
ehci_enable[sunxi_ehci->usbc_no] = 0;
}
return 0;
}
static int sunxi_ehci_hcd_remove(struct platform_device *pdev)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
if (pdev == NULL) {
DMSG_PANIC("ERR: %s, Argment is invalid\n", __func__);
return -1;
}
sunxi_ehci = pdev->dev.platform_data;
if (sunxi_ehci == NULL) {
DMSG_PANIC("ERR: %s, sunxi_ehci is null\n", __func__);
return -1;
}
if (ehci_enable[sunxi_ehci->usbc_no] == 0) {
device_remove_file(&pdev->dev, &dev_attr_ehci_enable);
ehci_enable[sunxi_ehci->usbc_no] = 1;
}
if (sunxi_ehci->probe == 1)
return sunxi_rmmod_ehci(pdev);
else
return 0;
}
static void sunxi_ehci_hcd_shutdown(struct platform_device *pdev)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
if (pdev == NULL) {
DMSG_PANIC("ERR: %s, Argment is invalid\n", __func__);
return;
}
sunxi_ehci = pdev->dev.platform_data;
if (sunxi_ehci == NULL) {
DMSG_PANIC("ERR: %s, is null\n", __func__);
return;
}
if (sunxi_ehci->probe == 0) {
DMSG_INFO("%s, %s is disable, need not shutdown\n",
__func__, sunxi_ehci->hci_name);
return;
}
pr_debug("[%s]: ehci shutdown start\n", sunxi_ehci->hci_name);
usb_hcd_platform_shutdown(pdev);
/**
* disable usb otg INTUSBE, to solve usb0 device mode
* catch audio udev on reboot system is fail.
*/
if (sunxi_ehci->usbc_no == 0)
if (sunxi_ehci->otg_vbase) {
writel(0, (sunxi_ehci->otg_vbase
+ SUNXI_USBC_REG_INTUSBE));
}
pr_debug("[%s]: ehci shutdown end\n", sunxi_ehci->hci_name);
}
#ifdef CONFIG_PM
static int sunxi_ehci_hcd_suspend(struct device *dev)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
struct usb_hcd *hcd = NULL;
struct ehci_hcd *ehci = NULL;
int val = 0;
if (dev == NULL) {
DMSG_PANIC("ERR: %s, Argment is invalid\n", __func__);
return 0;
}
hcd = dev_get_drvdata(dev);
if (hcd == NULL) {
DMSG_PANIC("ERR: hcd is null\n");
return 0;
}
sunxi_ehci = dev->platform_data;
if (sunxi_ehci == NULL) {
DMSG_PANIC("ERR: sunxi_ehci is null\n");
return 0;
}
if (sunxi_ehci->probe == 0) {
DMSG_INFO("[%s]: is disable, can not suspend\n",
sunxi_ehci->hci_name);
return 0;
}
ehci = hcd_to_ehci(hcd);
if (ehci == NULL) {
DMSG_PANIC("ERR: ehci is null\n");
return 0;
}
if (sunxi_ehci->wakeup_suspend) {
DMSG_INFO("[%s]: not suspend\n", sunxi_ehci->hci_name);
val = ehci_readl(ehci, &ehci->regs->intr_enable);
val |= (0x7 << 0);
ehci_writel(ehci, val, &ehci->regs->intr_enable);
#ifdef SUNXI_USB_STANDBY_LOW_POW_MODE
val = ehci_readl(ehci, &ehci->regs->command);
val &= ~(0x30);
ehci_writel(ehci, val, &ehci->regs->command);
sunxi_hci_set_wakeup_ctrl(sunxi_ehci);
sunxi_hci_set_siddq(sunxi_ehci);
#endif
} else {
DMSG_INFO("[%s]: sunxi_ehci_hcd_suspend\n",
sunxi_ehci->hci_name);
atomic_add(1, &g_sunxi_usb_super_standby);
ehci_suspend(hcd, device_may_wakeup(dev));
sunxi_stop_ehci(sunxi_ehci);
cancel_work_sync(&sunxi_ehci->resume_work);
}
return 0;
}
static void sunxi_ehci_resume_work(struct work_struct *work)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
sunxi_ehci = container_of(work, struct sunxi_hci_hcd, resume_work);
/* Waiting hci to resume. */
msleep(5000);
sunxi_hcd_board_set_vbus(sunxi_ehci, 1);
atomic_sub(1, &g_sunxi_usb_super_standby);
}
static int sunxi_ehci_hcd_resume(struct device *dev)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
struct usb_hcd *hcd = NULL;
struct ehci_hcd *ehci = NULL;
#ifdef SUNXI_USB_STANDBY_LOW_POW_MODE
int val = 0;
#endif
if (dev == NULL) {
DMSG_PANIC("ERR: Argment is invalid\n");
return 0;
}
hcd = dev_get_drvdata(dev);
if (hcd == NULL) {
DMSG_PANIC("ERR: hcd is null\n");
return 0;
}
sunxi_ehci = dev->platform_data;
if (sunxi_ehci == NULL) {
DMSG_PANIC("ERR: sunxi_ehci is null\n");
return 0;
}
if (sunxi_ehci->probe == 0) {
DMSG_INFO("[%s]: is disable, can not resume\n",
sunxi_ehci->hci_name);
return 0;
}
ehci = hcd_to_ehci(hcd);
if (ehci == NULL) {
DMSG_PANIC("ERR: ehci is null\n");
return 0;
}
if (sunxi_ehci->wakeup_suspend) {
DMSG_INFO("[%s]: controller not suspend, need not resume\n",
sunxi_ehci->hci_name);
#ifdef SUNXI_USB_STANDBY_LOW_POW_MODE
val = ehci_readl(ehci, &ehci->regs->command);
val |= 0x30;
ehci_writel(ehci, val, &ehci->regs->command);
#endif
} else {
DMSG_INFO("[%s]: sunxi_ehci_hcd_resume\n",
sunxi_ehci->hci_name);
open_ehci_clock(sunxi_ehci);
sunxi_hcd_board_set_passby(sunxi_ehci, 1);
ehci_resume(hcd, false);
schedule_work(&sunxi_ehci->resume_work);
}
return 0;
}
static const struct dev_pm_ops aw_ehci_pmops = {
.suspend = sunxi_ehci_hcd_suspend,
.resume = sunxi_ehci_hcd_resume,
};
#define SUNXI_EHCI_PMOPS (&aw_ehci_pmops)
#else
#define SUNXI_EHCI_PMOPS NULL
#endif
static const struct of_device_id sunxi_ehci_match[] = {
{.compatible = SUNXI_EHCI0_OF_MATCH, },
{.compatible = SUNXI_EHCI1_OF_MATCH, },
{.compatible = SUNXI_EHCI2_OF_MATCH, },
{.compatible = SUNXI_EHCI3_OF_MATCH, },
{},
};
MODULE_DEVICE_TABLE(of, sunxi_ehci_match);
static struct platform_driver sunxi_ehci_hcd_driver = {
.probe = sunxi_ehci_hcd_probe,
.remove = sunxi_ehci_hcd_remove,
.shutdown = sunxi_ehci_hcd_shutdown,
.driver = {
.name = ehci_name,
.pm = SUNXI_EHCI_PMOPS,
.of_match_table = sunxi_ehci_match,
}
};
int sunxi_usb_disable_ehci(__u32 usbc_no)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
sunxi_ehci = g_sunxi_ehci[usbc_no];
if (sunxi_ehci == NULL) {
DMSG_PANIC("ERR: sunxi_ehci is null\n");
return -1;
}
if (sunxi_ehci->probe == 0) {
DMSG_PANIC("ERR: sunxi_ehci is disable, can not disable again\n");
return -1;
}
sunxi_ehci->probe = 0;
DMSG_INFO("[%s]: sunxi_usb_disable_ehci\n", sunxi_ehci->hci_name);
sunxi_rmmod_ehci(sunxi_ehci->pdev);
return 0;
}
EXPORT_SYMBOL(sunxi_usb_disable_ehci);
int sunxi_usb_enable_ehci(__u32 usbc_no)
{
struct sunxi_hci_hcd *sunxi_ehci = NULL;
sunxi_ehci = g_sunxi_ehci[usbc_no];
if (sunxi_ehci == NULL) {
DMSG_PANIC("ERR: sunxi_ehci is null\n");
return -1;
}
if (sunxi_ehci->probe == 1) {
DMSG_PANIC("ERR: sunxi_ehci is already enable, can not enable again\n");
return -1;
}
sunxi_ehci->probe = 1;
DMSG_INFO("[%s]: sunxi_usb_enable_ehci\n", sunxi_ehci->hci_name);
sunxi_insmod_ehci(sunxi_ehci->pdev);
return 0;
}
EXPORT_SYMBOL(sunxi_usb_enable_ehci);
Reference in New Issue View Git Blame Copy Permalink