static irqreturn_t palmas_vbus_irq_handler(int irq, void *_palmas_usb) { struct palmas_usb *palmas_usb = _palmas_usb; unsigned int vbus_line_state; palmas_read(palmas_usb->palmas, PALMAS_INTERRUPT_BASE, PALMAS_INT3_LINE_STATE, &vbus_line_state); dev_info(palmas_usb->dev, "vbus-irq() INT3_LINE_STATE 0x%02x\n", vbus_line_state); if (vbus_line_state & PALMAS_INT3_LINE_STATE_VBUS) { if (palmas_usb->vbus_linkstat != PALMAS_USB_STATE_VBUS) { palmas_usb->vbus_linkstat = PALMAS_USB_STATE_VBUS; extcon_set_cable_state(&palmas_usb->edev, "USB", true); dev_info(palmas_usb->dev, "USB cable is attached\n"); } else { dev_info(palmas_usb->dev, "Spurious connect event detected\n"); } } else if (!(vbus_line_state & PALMAS_INT3_LINE_STATE_VBUS)) { if (palmas_usb->vbus_linkstat == PALMAS_USB_STATE_VBUS) { palmas_usb->vbus_linkstat = PALMAS_USB_STATE_DISCONNECT; extcon_set_cable_state(&palmas_usb->edev, "USB", false); dev_info(palmas_usb->dev, "USB cable is detached\n"); } else { dev_info(palmas_usb->dev, "Spurious disconnect event detected\n"); } } return IRQ_HANDLED; }
static irqreturn_t palmas_id_irq_handler(int irq, void *_palmas_usb) { unsigned int set, id_src; struct palmas_usb *palmas_usb = _palmas_usb; palmas_read(palmas_usb->palmas, PALMAS_USB_OTG_BASE, PALMAS_USB_ID_INT_LATCH_SET, &set); palmas_read(palmas_usb->palmas, PALMAS_USB_OTG_BASE, PALMAS_USB_ID_INT_SRC, &id_src); if ((set & PALMAS_USB_ID_INT_SRC_ID_GND) && (id_src & PALMAS_USB_ID_INT_SRC_ID_GND)) { palmas_write(palmas_usb->palmas, PALMAS_USB_OTG_BASE, PALMAS_USB_ID_INT_LATCH_CLR, PALMAS_USB_ID_INT_EN_HI_CLR_ID_GND); palmas_usb->linkstat = PALMAS_USB_STATE_ID; extcon_set_cable_state(&palmas_usb->edev, "USB-HOST", true); dev_info(palmas_usb->dev, "USB-HOST cable is attached\n"); } else if ((set & PALMAS_USB_ID_INT_SRC_ID_FLOAT) && (id_src & PALMAS_USB_ID_INT_SRC_ID_FLOAT)) { palmas_write(palmas_usb->palmas, PALMAS_USB_OTG_BASE, PALMAS_USB_ID_INT_LATCH_CLR, PALMAS_USB_ID_INT_EN_HI_CLR_ID_FLOAT); palmas_usb->linkstat = PALMAS_USB_STATE_DISCONNECT; extcon_set_cable_state(&palmas_usb->edev, "USB-HOST", false); dev_info(palmas_usb->dev, "USB-HOST cable is detached\n"); } else if ((palmas_usb->linkstat == PALMAS_USB_STATE_ID) && (!(set & PALMAS_USB_ID_INT_SRC_ID_GND))) { palmas_usb->linkstat = PALMAS_USB_STATE_DISCONNECT; extcon_set_cable_state(&palmas_usb->edev, "USB-HOST", false); dev_info(palmas_usb->dev, "USB-HOST cable is detached\n"); } else if ((palmas_usb->linkstat == PALMAS_USB_STATE_DISCONNECT) && (id_src & PALMAS_USB_ID_INT_SRC_ID_GND)) { palmas_usb->linkstat = PALMAS_USB_STATE_ID; extcon_set_cable_state(&palmas_usb->edev, "USB-HOST", true); dev_info(palmas_usb->dev, " USB-HOST cable is attached\n"); } return IRQ_HANDLED; }
static void tahvo_usb_become_peripheral(struct tahvo_usb *tu) { struct retu_dev *rdev = dev_get_drvdata(tu->pt_dev->dev.parent); extcon_set_cable_state(&tu->extcon, "USB-HOST", false); /* Power up transceiver and set it in USB peripheral mode */ retu_write(rdev, TAHVO_REG_USBR, USBR_SLAVE_CONTROL | USBR_REGOUT | USBR_NSUSPEND | USBR_SLAVE_SW); tu->phy.state = OTG_STATE_B_IDLE; check_vbus_state(tu); }
static void tahvo_usb_become_host(struct tahvo_usb *tu) { struct retu_dev *rdev = dev_get_drvdata(tu->pt_dev->dev.parent); extcon_set_cable_state(&tu->extcon, "USB-HOST", true); /* Power up the transceiver in USB host mode */ retu_write(rdev, TAHVO_REG_USBR, USBR_REGOUT | USBR_NSUSPEND | USBR_MASTER_SW2 | USBR_MASTER_SW1); tu->phy.state = OTG_STATE_A_IDLE; check_vbus_state(tu); }
static void check_vbus_state(struct tahvo_usb *tu) { struct retu_dev *rdev = dev_get_drvdata(tu->pt_dev->dev.parent); int reg, prev_state; reg = retu_read(rdev, TAHVO_REG_IDSR); if (reg & TAHVO_STAT_VBUS) { switch (tu->phy.state) { case OTG_STATE_B_IDLE: /* Enable the gadget driver */ if (tu->phy.otg->gadget) usb_gadget_vbus_connect(tu->phy.otg->gadget); tu->phy.state = OTG_STATE_B_PERIPHERAL; break; case OTG_STATE_A_IDLE: /* * Session is now valid assuming the USB hub is driving * Vbus. */ tu->phy.state = OTG_STATE_A_HOST; break; default: break; } dev_info(&tu->pt_dev->dev, "USB cable connected\n"); } else { switch (tu->phy.state) { case OTG_STATE_B_PERIPHERAL: if (tu->phy.otg->gadget) usb_gadget_vbus_disconnect(tu->phy.otg->gadget); tu->phy.state = OTG_STATE_B_IDLE; break; case OTG_STATE_A_HOST: tu->phy.state = OTG_STATE_A_IDLE; break; default: break; } dev_info(&tu->pt_dev->dev, "USB cable disconnected\n"); } prev_state = tu->vbus_state; tu->vbus_state = reg & TAHVO_STAT_VBUS; if (prev_state != tu->vbus_state) { extcon_set_cable_state(&tu->extcon, "USB", tu->vbus_state); sysfs_notify(&tu->pt_dev->dev.kobj, NULL, "vbus_state"); } }
static int tahvo_usb_probe(struct platform_device *pdev) { struct retu_dev *rdev = dev_get_drvdata(pdev->dev.parent); struct tahvo_usb *tu; int ret; tu = devm_kzalloc(&pdev->dev, sizeof(*tu), GFP_KERNEL); if (!tu) return -ENOMEM; tu->phy.otg = devm_kzalloc(&pdev->dev, sizeof(*tu->phy.otg), GFP_KERNEL); if (!tu->phy.otg) return -ENOMEM; tu->pt_dev = pdev; /* Default mode */ #ifdef CONFIG_TAHVO_USB_HOST_BY_DEFAULT tu->tahvo_mode = TAHVO_MODE_HOST; #else tu->tahvo_mode = TAHVO_MODE_PERIPHERAL; #endif mutex_init(&tu->serialize); tu->ick = devm_clk_get(&pdev->dev, "usb_l4_ick"); if (!IS_ERR(tu->ick)) clk_enable(tu->ick); /* * Set initial state, so that we generate kevents only on state changes. */ tu->vbus_state = retu_read(rdev, TAHVO_REG_IDSR) & TAHVO_STAT_VBUS; tu->extcon.name = DRIVER_NAME; tu->extcon.supported_cable = tahvo_cable; tu->extcon.dev.parent = &pdev->dev; ret = extcon_dev_register(&tu->extcon); if (ret) { dev_err(&pdev->dev, "could not register extcon device: %d\n", ret); goto err_disable_clk; } /* Set the initial cable state. */ extcon_set_cable_state(&tu->extcon, "USB-HOST", tu->tahvo_mode == TAHVO_MODE_HOST); extcon_set_cable_state(&tu->extcon, "USB", tu->vbus_state); /* Create OTG interface */ tahvo_usb_power_off(tu); tu->phy.dev = &pdev->dev; tu->phy.state = OTG_STATE_UNDEFINED; tu->phy.label = DRIVER_NAME; tu->phy.set_suspend = tahvo_usb_set_suspend; tu->phy.otg->phy = &tu->phy; tu->phy.otg->set_host = tahvo_usb_set_host; tu->phy.otg->set_peripheral = tahvo_usb_set_peripheral; ret = usb_add_phy(&tu->phy, USB_PHY_TYPE_USB2); if (ret < 0) { dev_err(&pdev->dev, "cannot register USB transceiver: %d\n", ret); goto err_extcon_unreg; } dev_set_drvdata(&pdev->dev, tu); tu->irq = platform_get_irq(pdev, 0); ret = request_threaded_irq(tu->irq, NULL, tahvo_usb_vbus_interrupt, 0, "tahvo-vbus", tu); if (ret) { dev_err(&pdev->dev, "could not register tahvo-vbus irq: %d\n", ret); goto err_remove_phy; } /* Attributes */ ret = sysfs_create_group(&pdev->dev.kobj, &tahvo_attr_group); if (ret) { dev_err(&pdev->dev, "cannot create sysfs group: %d\n", ret); goto err_free_irq; } return 0; err_free_irq: free_irq(tu->irq, tu); err_remove_phy: usb_remove_phy(&tu->phy); err_extcon_unreg: extcon_dev_unregister(&tu->extcon); err_disable_clk: if (!IS_ERR(tu->ick)) clk_disable(tu->ick); return ret; }
static int palmas_usb_id_state_update(struct palmas_usb *palmas_usb) { unsigned int id_src; int ret; int new_state; int new_cable_index; int retry = 5; src_again: ret = palmas_read(palmas_usb->palmas, PALMAS_USB_OTG_BASE, PALMAS_USB_ID_INT_SRC, &id_src); if (ret < 0) { dev_err(palmas_usb->dev, "ID_INT_SRC read failed: %d\n", ret); return ret; } dev_info(palmas_usb->dev, "id-state: 0x%02x\n", id_src); if (!id_src) { dev_err(palmas_usb->dev, "Improper ID state found\n"); if (retry--) { msleep(200); goto src_again; } return -EAGAIN; } /* If two ID states show sign then allow debouncing to settle */ if (id_src & (id_src - 1)) { dev_info(palmas_usb->dev, "ID states are not settled, try later\n"); return -EAGAIN; } if (id_src & PALMAS_USB_ID_INT_SRC_ID_GND) { new_state = PALMAS_USB_STATE_ID_GND; new_cable_index = 1; } else if (id_src & PALMAS_USB_ID_INT_SRC_ID_A) { new_state = PALMAS_USB_STATE_ID_A; new_cable_index = 2; } else if (id_src & PALMAS_USB_ID_INT_SRC_ID_B) { new_state = PALMAS_USB_STATE_ID_B; new_cable_index = 3; } else if (id_src & PALMAS_USB_ID_INT_SRC_ID_C) { new_state = PALMAS_USB_STATE_ID_C; new_cable_index = 4; } else if (id_src & PALMAS_USB_ID_INT_SRC_ID_FLOAT) { new_state = PALMAS_USB_STATE_ID_FLOAT; new_cable_index = -1; } else { dev_info(palmas_usb->dev, "ID_SRC is not valid\n"); new_state = PALMAS_USB_STATE_ID_FLOAT; new_cable_index = 0; } if (palmas_usb->id_linkstat == new_state) { dev_info(palmas_usb->dev, "No change in ID state: Old %d and New %d\n", palmas_usb->id_linkstat, new_state); palmas_usb_id_int_set(palmas_usb); return 0; } if (palmas_usb->cur_cable_index > 0) { dev_info(palmas_usb->dev, "Cable %s detached\n", palmas_extcon_cable[palmas_usb->cur_cable_index]); extcon_set_cable_state(&palmas_usb->edev, palmas_extcon_cable[palmas_usb->cur_cable_index], false); } if ((new_cable_index < 0) && (!palmas_usb->cur_cable_index)) { dev_info(palmas_usb->dev, "All cable detached\n"); extcon_set_cable_state(&palmas_usb->edev, palmas_extcon_cable[1], false); extcon_set_cable_state(&palmas_usb->edev, palmas_extcon_cable[2], false); extcon_set_cable_state(&palmas_usb->edev, palmas_extcon_cable[3], false); extcon_set_cable_state(&palmas_usb->edev, palmas_extcon_cable[4], false); } palmas_usb->cur_cable_index = new_cable_index; palmas_usb->id_linkstat = new_state; if (palmas_usb->cur_cable_index <= 0) goto end; dev_info(palmas_usb->dev, "Cable %s attached\n", palmas_extcon_cable[palmas_usb->cur_cable_index]); extcon_set_cable_state(&palmas_usb->edev, palmas_extcon_cable[palmas_usb->cur_cable_index], true); end: palmas_usb_id_int_set(palmas_usb); return 0; }