static void __exit usb_notify_exit(void)
{
pr_debug("Stopping USB Notify Subscriber\n");
usb_unregister_notify(&usb_notify_dev_nb);
usb_unregister_notify(&usb_notify_bus_nb);
}
static void xhci_ush_pci_remove(struct pci_dev *dev)
{
struct xhci_hcd *xhci;
xhci = hcd_to_xhci(pci_get_drvdata(dev));
if (xhci->shared_hcd) {
usb_remove_hcd(xhci->shared_hcd);
usb_put_hcd(xhci->shared_hcd);
}
if (!pci_dev_run_wake(dev))
pm_runtime_get_noresume(&dev->dev);
pm_runtime_forbid(&dev->dev);
usb_hcd_pci_remove(dev);
/* Free the aux irq */
hsic_aux_irq_free();
hsic_wakeup_irq_free();
gpio_free(hsic.aux_gpio);
gpio_free(hsic.wakeup_gpio);
hsic.port_disconnect = 1;
hsic_enable = 0;
wake_lock_destroy(&(hsic.resume_wake_lock));
wake_lock_destroy(&hsic.s3_wake_lock);
usb_unregister_notify(&hsic.hsic_pm_nb);
unregister_pm_notifier(&hsic.hsic_s3_entry_nb);
kfree(xhci);
}
static int msm_otg_set_host(struct otg_transceiver *xceiv, struct usb_bus *host)
{
struct msm_otg *dev = container_of(xceiv, struct msm_otg, otg);
if (!dev || (dev != the_msm_otg))
return -ENODEV;
/* Id pin is not routed to PMIC. Host mode can not be
* supported with pmic notification support.
*/
if (!dev->start_host || dev->pmic_notif_supp)
return -ENODEV;
if (!host) {
msm_otg_start_host(xceiv, REQUEST_STOP);
usb_unregister_notify(&dev->usbdev_nb);
dev->otg.host = 0;
dev->start_host = 0;
disable_idgnd(dev);
return 0;
}
dev->usbdev_nb.notifier_call = usbdev_notify;
usb_register_notify(&dev->usbdev_nb);
dev->otg.host = host;
enable_idgnd(dev);
pr_info("host driver registered w/ tranceiver\n");
#ifdef CONFIG_USB_OTG
host->otg_port = 1;
#else
wake_lock(&dev->wlock);
queue_work(dev->wq, &dev->sm_work);
#endif
return 0;
}
static int baseband_xmm_power_driver_remove(struct platform_device *device)
{
int i;
struct baseband_power_platform_data *data
= (struct baseband_power_platform_data *)
device->dev.platform_data;
struct device *dev = &device->dev;
pr_debug("%s\n", __func__);
/* check for platform data */
if (!data)
return 0;
usb_unregister_notify(&usb_xmm_nb);
/* free work structure */
kfree(baseband_xmm_power_work);
baseband_xmm_power_work = (struct baseband_xmm_power_work_t *) 0;
/* free baseband irq(s) */
if (modem_flash && modem_pm) {
free_irq(gpio_to_irq(baseband_power_driver_data
->modem.xmm.ipc_ap_wake), NULL);
}
/* free baseband gpio(s) */
gpio_free_array(tegra_baseband_gpios,
ARRAY_SIZE(tegra_baseband_gpios));
/* disable regulator LDO7 for hsic power*/
regulator_disable(reg_grouper_hsic);
regulator_put(reg_grouper_hsic);
reg_grouper_hsic = NULL;
/* destroy wake lock */
wake_lock_destroy(&wakelock);
wake_lock_destroy(&modem_recovery_wakelock);
/* delete device file */
/*
device_remove_file(dev, &dev_attr_xmm_onoff);
*/
for (i = 0; i < (ARRAY_SIZE(xmm_device_attr) - 1); i++) {
device_remove_file(dev, &xmm_device_attr[i]);
}
/* unregister usb host controller */
if (data->hsic_unregister && (!register_hsic_device)) {
register_hsic_device = true;
data->hsic_unregister(data->modem.xmm.hsic_device);
}else
pr_err("%s: hsic_unregister is missing\n", __func__);
return 0;
}
static void __exit wusbcore_exit(void)
{
clear_bit(0, wusb_cluster_id_table);
if (!bitmap_empty(wusb_cluster_id_table, CLUSTER_IDS)) {
printk(KERN_ERR "BUG: WUSB Cluster IDs not released on exit: %*pb\n",
CLUSTER_IDS, wusb_cluster_id_table);
WARN_ON(1);
}
usb_unregister_notify(&wusb_usb_notifier);
destroy_workqueue(wusbd);
wusb_crypto_exit();
}
void hif_unregister_driver(void)
{
if (is_usb_driver_register) {
long timeleft = 0;
if (usb_sc != NULL) {
/* wait __hdd_wlan_exit until finished and no more than
* 4 seconds
*/
while(usb_sc->hdd_removed_processing == 1 &&
usb_sc->hdd_removed_wait_cnt < 20) {
set_current_state(TASK_INTERRUPTIBLE);
schedule_timeout(msecs_to_jiffies(
DELAY_INT_FOR_HDD_REMOVE));
set_current_state(TASK_RUNNING);
usb_sc->hdd_removed_wait_cnt ++;
}
if (usb_sc->local_state.event != 0) {
hif_usb_resume(usb_sc->interface);
usb_sc->local_state.event = 0;
}
if (usb_sc->hdd_removed == 0) {
usb_sc->hdd_removed_processing = 1;
#ifndef REMOVE_PKT_LOG
if (vos_get_conparam() != VOS_FTM_MODE &&
!WLAN_IS_EPPING_ENABLED(vos_get_conparam()))
pktlogmod_exit(usb_sc->ol_sc);
#endif
__hdd_wlan_exit();
usb_sc->hdd_removed_processing = 0;
usb_sc->hdd_removed = 1;
}
}
is_usb_driver_register = 0;
atomic_set(&hif_usb_unload_state,
HIF_USB_UNLOAD_STATE_DRV_DEREG);
usb_deregister(&hif_usb_drv_id);
if (atomic_read(&hif_usb_unload_state) !=
HIF_USB_UNLOAD_STATE_TARGET_RESET)
goto finish;
timeleft = wait_event_interruptible_timeout(
hif_usb_unload_event_wq,
atomic_read(&hif_usb_unload_state) ==
HIF_USB_UNLOAD_STATE_DEV_DISCONNECTED,
HIF_USB_UNLOAD_TIMEOUT);
if (timeleft <= 0)
pr_err("Fail to wait from DRV_DEREG to DISCONNECT,"
"timeleft = %ld \n\r",
timeleft);
finish:
usb_unregister_notify(&hif_usb_dev_nb);
}
}
static void __exit wusbcore_exit(void)
{
clear_bit(0, wusb_cluster_id_table);
if (!bitmap_empty(wusb_cluster_id_table, CLUSTER_IDS)) {
char buf[256];
bitmap_scnprintf(buf, sizeof(buf), wusb_cluster_id_table,
CLUSTER_IDS);
printk(KERN_ERR "BUG: WUSB Cluster IDs not released "
"on exit: %s\n", buf);
WARN_ON(1);
}
usb_unregister_notify(&wusb_usb_notifier);
destroy_workqueue(wusbd);
wusb_crypto_exit();
}
static int baseband_xmm_power_driver_remove(struct platform_device *device)
{
struct baseband_power_platform_data *data
= (struct baseband_power_platform_data *)
device->dev.platform_data;
struct device *dev = &device->dev;
pr_debug("%s\n", __func__);
/* check for platform data */
if (!data)
return 0;
usb_unregister_notify(&usb_xmm_nb);
/* free work structure */
kfree(baseband_xmm_power_work);
baseband_xmm_power_work = (struct baseband_xmm_power_work_t *) 0;
/* free baseband irq(s) */
if (modem_flash && modem_pm) {
free_irq(gpio_to_irq(baseband_power_driver_data
->modem.xmm.ipc_ap_wake), NULL);
}
/* free baseband gpio(s) */
gpio_free_array(tegra_baseband_gpios,
ARRAY_SIZE(tegra_baseband_gpios));
/* destroy wake lock */
wake_lock_destroy(&wakelock);
/* delete device file */
device_remove_file(dev, &dev_attr_xmm_onoff);
/* unregister usb host controller */
if (data->hsic_unregister)
data->hsic_unregister(data->modem.xmm.hsic_device);
else
pr_err("%s: hsic_unregister is missing\n", __func__);
return 0;
}
static void usbdev_trig_deactivate(struct led_classdev *led_cdev)
{
struct usbdev_trig_data *td = led_cdev->trigger_data;
if (td) {
usb_unregister_notify(&td->notifier);
device_remove_file(led_cdev->dev, &dev_attr_device_name);
device_remove_file(led_cdev->dev, &dev_attr_activity_interval);
write_lock(&td->lock);
if (td->usb_dev) {
usb_put_dev(td->usb_dev);
td->usb_dev = NULL;
}
write_unlock(&td->lock);
del_timer_sync(&td->timer);
kfree(td);
}
}
static void ehci_hsic_remove(struct pci_dev *pdev)
{
struct usb_hcd *hcd = pci_get_drvdata(pdev);
struct ehci_hcd *ehci = hcd_to_ehci(hcd);
if (!hcd)
return;
hsic.hsic_stopped = 1;
hsic_enable = 0;
if (pci_dev_run_wake(pdev))
pm_runtime_get_noresume(&pdev->dev);
if (!enabling_disabling) {
if (!pci_dev_run_wake(pdev))
pm_runtime_get_noresume(&pdev->dev);
pm_runtime_forbid(&pdev->dev);
}
/* Free the aux irq */
hsic_aux_irq_free();
hsic_wakeup_irq_free();
/* Fake an interrupt request in order to give the driver a chance
* to test whether the controller hardware has been removed (e.g.,
* cardbus physical eject).
*/
local_irq_disable();
usb_hcd_irq(0, hcd);
local_irq_enable();
usb_remove_hcd(hcd);
#if 0
ehci_hsic_port_power(ehci, 0);
#endif
/* Set phy low power mode, disable phy clock */
ehci_hsic_phy_power(ehci, 1);
if (hcd->driver->flags & HCD_MEMORY) {
iounmap(hcd->regs);
release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
} else {
release_region(hcd->rsrc_start, hcd->rsrc_len);
}
usb_put_hcd(hcd);
gpio_free(hsic.aux_gpio);
gpio_free(hsic.wakeup_gpio);
pci_disable_device(pdev);
cancel_delayed_work_sync(&hsic.wakeup_work);
destroy_workqueue(hsic.work_queue);
wake_lock_destroy(&(hsic.resume_wake_lock));
wake_lock_destroy(&hsic.s3_wake_lock);
usb_unregister_notify(&hsic.hsic_pm_nb);
unregister_pm_notifier(&hsic.hsic_s3_entry_nb);
hsic_debugfs_cleanup();
}
static void __exit my_exit (void)
{
usb_unregister_notify (&my_nh_block);
printk (KERN_INFO "USB Notifier module successfully unloaded\n");
}
static ssize_t usbdev_trig_name_store(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t size)
{
struct led_classdev *led_cdev = dev_get_drvdata(dev);
struct usbdev_trig_data *td = led_cdev->trigger_data;
if (size < 0 || size >= DEV_BUS_ID_SIZE)
return -EINVAL;
write_lock(&td->lock);
strcpy(td->device_name, buf);
if (size > 0 && td->device_name[size - 1] == '\n')
td->device_name[size - 1] = 0;
if (td->device_name[0] != 0) {
struct usbdev_trig_match match = {
.device_name = td->device_name,
};
/* check for existing device to update from */
usb_for_each_dev(&match, usbdev_trig_find_usb_dev);
if (match.usb_dev) {
if (td->usb_dev)
usb_put_dev(td->usb_dev);
td->usb_dev = match.usb_dev;
td->last_urbnum = atomic_read(&match.usb_dev->urbnum);
}
/* updates LEDs, may start timers */
usbdev_trig_update_state(td);
}
write_unlock(&td->lock);
return size;
}
static DEVICE_ATTR(device_name, 0644, usbdev_trig_name_show,
usbdev_trig_name_store);
static ssize_t usbdev_trig_interval_show(struct device *dev,
struct device_attribute *attr,
char *buf)
{
struct led_classdev *led_cdev = dev_get_drvdata(dev);
struct usbdev_trig_data *td = led_cdev->trigger_data;
read_lock(&td->lock);
sprintf(buf, "%u\n", jiffies_to_msecs(td->interval));
read_unlock(&td->lock);
return strlen(buf) + 1;
}
static ssize_t usbdev_trig_interval_store(struct device *dev,
struct device_attribute *attr,
const char *buf,
size_t size)
{
struct led_classdev *led_cdev = dev_get_drvdata(dev);
struct usbdev_trig_data *td = led_cdev->trigger_data;
int ret = -EINVAL;
char *after;
unsigned long value = simple_strtoul(buf, &after, 10);
size_t count = after - buf;
if (*after && isspace(*after))
count++;
if (count == size && value <= 10000) {
write_lock(&td->lock);
td->interval = msecs_to_jiffies(value);
usbdev_trig_update_state(td); /* resets timer */
write_unlock(&td->lock);
ret = count;
}
return ret;
}
static DEVICE_ATTR(activity_interval, 0644, usbdev_trig_interval_show,
usbdev_trig_interval_store);
static int usbdev_trig_notify(struct notifier_block *nb,
unsigned long evt,
void *data)
{
struct usb_device *usb_dev;
struct usbdev_trig_data *td;
if (evt != USB_DEVICE_ADD && evt != USB_DEVICE_REMOVE)
return NOTIFY_DONE;
usb_dev = data;
td = container_of(nb, struct usbdev_trig_data, notifier);
write_lock(&td->lock);
if (strcmp(dev_name(&usb_dev->dev), td->device_name))
goto done;
if (evt == USB_DEVICE_ADD) {
usb_get_dev(usb_dev);
if (td->usb_dev != NULL)
usb_put_dev(td->usb_dev);
td->usb_dev = usb_dev;
td->last_urbnum = atomic_read(&usb_dev->urbnum);
} else if (evt == USB_DEVICE_REMOVE) {
if (td->usb_dev != NULL) {
usb_put_dev(td->usb_dev);
td->usb_dev = NULL;
}
}
usbdev_trig_update_state(td);
done:
write_unlock(&td->lock);
return NOTIFY_DONE;
}
/* here's the real work! */
static void usbdev_trig_timer(unsigned long arg)
{
struct usbdev_trig_data *td = (struct usbdev_trig_data *)arg;
int new_urbnum;
write_lock(&td->lock);
if (!td->usb_dev || td->interval == 0) {
/*
* we don't need to do timer work, just reflect device presence
*/
if (td->usb_dev)
led_set_brightness(td->led_cdev, LED_FULL);
else
led_set_brightness(td->led_cdev, LED_OFF);
goto no_restart;
}
if (td->interval)
new_urbnum = atomic_read(&td->usb_dev->urbnum);
else
new_urbnum = 0;
if (td->usb_dev) {
/*
* Base state is ON (device is present). If there's no device,
* we don't get this far and the LED is off.
* OFF -> ON always
* ON -> OFF on activity
*/
if (td->led_cdev->brightness == LED_OFF)
led_set_brightness(td->led_cdev, LED_FULL);
else if (td->last_urbnum != new_urbnum)
led_set_brightness(td->led_cdev, LED_OFF);
} else {
/*
* base state is OFF
* ON -> OFF always
* OFF -> ON on activity
*/
if (td->led_cdev->brightness == LED_FULL)
led_set_brightness(td->led_cdev, LED_OFF);
else if (td->last_urbnum != new_urbnum)
led_set_brightness(td->led_cdev, LED_FULL);
}
td->last_urbnum = new_urbnum;
mod_timer(&td->timer, jiffies + td->interval);
no_restart:
write_unlock(&td->lock);
}
static void usbdev_trig_activate(struct led_classdev *led_cdev)
{
struct usbdev_trig_data *td;
int rc;
td = kzalloc(sizeof(struct usbdev_trig_data), GFP_KERNEL);
if (!td)
return;
rwlock_init(&td->lock);
td->notifier.notifier_call = usbdev_trig_notify;
td->notifier.priority = 10;
setup_timer(&td->timer, usbdev_trig_timer, (unsigned long) td);
td->led_cdev = led_cdev;
td->interval = msecs_to_jiffies(50);
led_cdev->trigger_data = td;
rc = device_create_file(led_cdev->dev, &dev_attr_device_name);
if (rc)
goto err_out;
rc = device_create_file(led_cdev->dev, &dev_attr_activity_interval);
if (rc)
goto err_out_device_name;
usb_register_notify(&td->notifier);
return;
err_out_device_name:
device_remove_file(led_cdev->dev, &dev_attr_device_name);
err_out:
led_cdev->trigger_data = NULL;
kfree(td);
}
static void usbdev_trig_deactivate(struct led_classdev *led_cdev)
{
struct usbdev_trig_data *td = led_cdev->trigger_data;
if (td) {
usb_unregister_notify(&td->notifier);
device_remove_file(led_cdev->dev, &dev_attr_device_name);
device_remove_file(led_cdev->dev, &dev_attr_activity_interval);
write_lock(&td->lock);
if (td->usb_dev) {
usb_put_dev(td->usb_dev);
td->usb_dev = NULL;
}
write_unlock(&td->lock);
del_timer_sync(&td->timer);
kfree(td);
}
}
static struct led_trigger usbdev_led_trigger = {
.name = "usbdev",
.activate = usbdev_trig_activate,
.deactivate = usbdev_trig_deactivate,
};
static int __init usbdev_trig_init(void)
{
return led_trigger_register(&usbdev_led_trigger);
}
static void __exit usbdev_trig_exit(void)
{
led_trigger_unregister(&usbdev_led_trigger);
}
module_init(usbdev_trig_init);
module_exit(usbdev_trig_exit);
MODULE_AUTHOR("Gabor Juhos <*****@*****.**>");
MODULE_DESCRIPTION("USB device LED trigger");
MODULE_LICENSE("GPL v2");
/**
* dwc3_otg_start_host - helper function for starting/stoping the host controller driver.
*
* @otg: Pointer to the otg_transceiver structure.
* @on: start / stop the host controller driver.
*
* Returns 0 on success otherwise negative errno.
*/
static int dwc3_otg_start_host(struct usb_otg *otg, int on)
{
struct dwc3_otg *dotg = container_of(otg, struct dwc3_otg, otg);
struct dwc3_ext_xceiv *ext_xceiv = dotg->ext_xceiv;
struct dwc3 *dwc = dotg->dwc;
struct usb_hcd *hcd;
int ret = 0;
if (!dwc->xhci)
return -EINVAL;
if (!dotg->vbus_otg) {
dotg->vbus_otg = devm_regulator_get(dwc->dev->parent,
"vbus_dwc3");
if (IS_ERR(dotg->vbus_otg)) {
dev_err(dwc->dev, "Failed to get vbus regulator\n");
ret = PTR_ERR(dotg->vbus_otg);
dotg->vbus_otg = 0;
return ret;
}
}
if (on) {
dev_dbg(otg->phy->dev, "%s: turn on host\n", __func__);
dwc3_otg_notify_host_mode(otg, on);
usb_phy_notify_connect(dotg->dwc->usb2_phy, USB_SPEED_HIGH);
/* register ocp notification */
if (ext_xceiv && ext_xceiv->ext_ocp_notification.notify) {
ret = regulator_register_ocp_notification(
dotg->vbus_otg,
&ext_xceiv->ext_ocp_notification);
if (ret)
dev_err(otg->phy->dev,
"unable to register ocp\n");
}
ret = regulator_enable(dotg->vbus_otg);
if (ret) {
dev_err(otg->phy->dev, "unable to enable vbus_otg\n");
dwc3_otg_notify_host_mode(otg, 0);
return ret;
}
/* The delay between enabling regulator and adding the
platform device is needed to succeed in the enumeration
for certain devices. */
usleep(10000);
dwc3_set_mode(dwc, DWC3_GCTL_PRTCAP_HOST);
/*
* FIXME If micro A cable is disconnected during system suspend,
* xhci platform device will be removed before runtime pm is
* enabled for xhci device. Due to this, disable_depth becomes
* greater than one and runtimepm is not enabled for next microA
* connect. Fix this by calling pm_runtime_init for xhci device.
*/
pm_runtime_init(&dwc->xhci->dev);
ret = platform_device_add(dwc->xhci);
if (ret) {
dev_err(otg->phy->dev,
"%s: failed to add XHCI pdev ret=%d\n",
__func__, ret);
regulator_disable(dotg->vbus_otg);
dwc3_otg_notify_host_mode(otg, 0);
return ret;
}
/*
* WORKAROUND: avoids entering a suspend state, because PMIC
* is damaged by known issue when attempt to suspend.
*/
wake_lock(&dotg->host_wakelock);
/*
* WORKAROUND: currently host mode suspend isn't working well.
* Disable xHCI's runtime PM for now.
*/
pm_runtime_disable(&dwc->xhci->dev);
if (no_device_timeout_enable) {
dotg->no_device_timeout_enabled = 1;
dotg->device_count = 0;
dotg->retry_count = 0;
dotg->usbdev_nb.notifier_call = dwc3_usbdev_notify;
usb_register_notify(&dotg->usbdev_nb);
dwc3_otg_start_no_device_work(dotg, true);
}
hcd = platform_get_drvdata(dwc->xhci);
otg->host = &hcd->self;
dwc3_gadget_usb3_phy_suspend(dwc, true);
} else {
dev_dbg(otg->phy->dev, "%s: turn off host\n", __func__);
ret = regulator_disable(dotg->vbus_otg);
if (ret) {
dev_err(otg->phy->dev, "unable to disable vbus_otg\n");
return ret;
}
dbg_event(0xFF, "StHost get", 0);
/* unregister ocp notification */
if (ext_xceiv && ext_xceiv->ext_ocp_notification.notify) {
ret = regulator_register_ocp_notification(
dotg->vbus_otg, NULL);
if (ret)
dev_err(otg->phy->dev,
"unable to unregister ocp\n");
}
pm_runtime_get(dwc->dev);
usb_phy_notify_disconnect(dotg->dwc->usb2_phy, USB_SPEED_HIGH);
dwc3_otg_notify_host_mode(otg, on);
otg->host = NULL;
if (dotg->no_device_timeout_enabled) {
dotg->no_device_timeout_enabled = 0;
dwc3_otg_start_no_device_work(dotg, false);
usb_unregister_notify(&dotg->usbdev_nb);
}
platform_device_del(dwc->xhci);
/* WORKAROUND: delays execution of the block-reset because it
* causes HWWD if ext_xceive access the HW during block reset.
*/
usleep(10000);
if (wake_lock_active(&dotg->host_wakelock))
wake_unlock(&dotg->host_wakelock);
/*
* Perform USB hardware RESET (both core reset and DBM reset)
* when moving from host to peripheral. This is required for
* peripheral mode to work.
*/
if (ext_xceiv && ext_xceiv->ext_block_reset)
ext_xceiv->ext_block_reset(ext_xceiv, true);
dwc3_gadget_usb3_phy_suspend(dwc, false);
dwc3_set_mode(dwc, DWC3_GCTL_PRTCAP_DEVICE);
/* re-init core and OTG registers as block reset clears these */
dwc3_post_host_reset_core_init(dwc);
dbg_event(0xFF, "StHost put", 0);
pm_runtime_put(dwc->dev);
}
return 0;
}
