extcon: qcom-spmi: Add support for VBUS detection
VBUS can be detected via a dedicated PMIC pin. Add support for reporting the VBUS status. Signed-off-by: Anirudh Ghayal <aghayal@codeaurora.org> Signed-off-by: Kavya Nunna <knunna@codeaurora.org> Signed-off-by: Guru Das Srinagesh <gurus@codeaurora.org> Signed-off-by: Chanwoo Choi <cw00.choi@samsung.com>
This commit is contained in:
parent
4fcdd677c4
commit
7b1222b224
|
@ -1,7 +1,7 @@
|
|||
// SPDX-License-Identifier: GPL-2.0-only
|
||||
/**
|
||||
* extcon-qcom-spmi-misc.c - Qualcomm USB extcon driver to support USB ID
|
||||
* detection based on extcon-usb-gpio.c.
|
||||
* and VBUS detection based on extcon-usb-gpio.c.
|
||||
*
|
||||
* Copyright (C) 2016 Linaro, Ltd.
|
||||
* Stephen Boyd <stephen.boyd@linaro.org>
|
||||
|
@ -21,30 +21,56 @@
|
|||
|
||||
struct qcom_usb_extcon_info {
|
||||
struct extcon_dev *edev;
|
||||
int irq;
|
||||
int id_irq;
|
||||
int vbus_irq;
|
||||
struct delayed_work wq_detcable;
|
||||
unsigned long debounce_jiffies;
|
||||
};
|
||||
|
||||
static const unsigned int qcom_usb_extcon_cable[] = {
|
||||
EXTCON_USB,
|
||||
EXTCON_USB_HOST,
|
||||
EXTCON_NONE,
|
||||
};
|
||||
|
||||
static void qcom_usb_extcon_detect_cable(struct work_struct *work)
|
||||
{
|
||||
bool id;
|
||||
bool state = false;
|
||||
int ret;
|
||||
union extcon_property_value val;
|
||||
struct qcom_usb_extcon_info *info = container_of(to_delayed_work(work),
|
||||
struct qcom_usb_extcon_info,
|
||||
wq_detcable);
|
||||
|
||||
/* check ID and update cable state */
|
||||
ret = irq_get_irqchip_state(info->irq, IRQCHIP_STATE_LINE_LEVEL, &id);
|
||||
if (ret)
|
||||
return;
|
||||
if (info->id_irq > 0) {
|
||||
/* check ID and update cable state */
|
||||
ret = irq_get_irqchip_state(info->id_irq,
|
||||
IRQCHIP_STATE_LINE_LEVEL, &state);
|
||||
if (ret)
|
||||
return;
|
||||
|
||||
extcon_set_state_sync(info->edev, EXTCON_USB_HOST, !id);
|
||||
if (!state) {
|
||||
val.intval = true;
|
||||
extcon_set_property(info->edev, EXTCON_USB_HOST,
|
||||
EXTCON_PROP_USB_SS, val);
|
||||
}
|
||||
extcon_set_state_sync(info->edev, EXTCON_USB_HOST, !state);
|
||||
}
|
||||
|
||||
if (info->vbus_irq > 0) {
|
||||
/* check VBUS and update cable state */
|
||||
ret = irq_get_irqchip_state(info->vbus_irq,
|
||||
IRQCHIP_STATE_LINE_LEVEL, &state);
|
||||
if (ret)
|
||||
return;
|
||||
|
||||
if (state) {
|
||||
val.intval = true;
|
||||
extcon_set_property(info->edev, EXTCON_USB,
|
||||
EXTCON_PROP_USB_SS, val);
|
||||
}
|
||||
extcon_set_state_sync(info->edev, EXTCON_USB, state);
|
||||
}
|
||||
}
|
||||
|
||||
static irqreturn_t qcom_usb_irq_handler(int irq, void *dev_id)
|
||||
|
@ -79,21 +105,48 @@ static int qcom_usb_extcon_probe(struct platform_device *pdev)
|
|||
return ret;
|
||||
}
|
||||
|
||||
ret = extcon_set_property_capability(info->edev,
|
||||
EXTCON_USB, EXTCON_PROP_USB_SS);
|
||||
ret |= extcon_set_property_capability(info->edev,
|
||||
EXTCON_USB_HOST, EXTCON_PROP_USB_SS);
|
||||
if (ret) {
|
||||
dev_err(dev, "failed to register extcon props rc=%d\n",
|
||||
ret);
|
||||
return ret;
|
||||
}
|
||||
|
||||
info->debounce_jiffies = msecs_to_jiffies(USB_ID_DEBOUNCE_MS);
|
||||
INIT_DELAYED_WORK(&info->wq_detcable, qcom_usb_extcon_detect_cable);
|
||||
|
||||
info->irq = platform_get_irq_byname(pdev, "usb_id");
|
||||
if (info->irq < 0)
|
||||
return info->irq;
|
||||
|
||||
ret = devm_request_threaded_irq(dev, info->irq, NULL,
|
||||
info->id_irq = platform_get_irq_byname(pdev, "usb_id");
|
||||
if (info->id_irq > 0) {
|
||||
ret = devm_request_threaded_irq(dev, info->id_irq, NULL,
|
||||
qcom_usb_irq_handler,
|
||||
IRQF_TRIGGER_RISING |
|
||||
IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
|
||||
pdev->name, info);
|
||||
if (ret < 0) {
|
||||
dev_err(dev, "failed to request handler for ID IRQ\n");
|
||||
return ret;
|
||||
if (ret < 0) {
|
||||
dev_err(dev, "failed to request handler for ID IRQ\n");
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
info->vbus_irq = platform_get_irq_byname(pdev, "usb_vbus");
|
||||
if (info->vbus_irq > 0) {
|
||||
ret = devm_request_threaded_irq(dev, info->vbus_irq, NULL,
|
||||
qcom_usb_irq_handler,
|
||||
IRQF_TRIGGER_RISING |
|
||||
IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
|
||||
pdev->name, info);
|
||||
if (ret < 0) {
|
||||
dev_err(dev, "failed to request handler for VBUS IRQ\n");
|
||||
return ret;
|
||||
}
|
||||
}
|
||||
|
||||
if (info->id_irq < 0 && info->vbus_irq < 0) {
|
||||
dev_err(dev, "ID and VBUS IRQ not found\n");
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
platform_set_drvdata(pdev, info);
|
||||
|
@ -120,8 +173,12 @@ static int qcom_usb_extcon_suspend(struct device *dev)
|
|||
struct qcom_usb_extcon_info *info = dev_get_drvdata(dev);
|
||||
int ret = 0;
|
||||
|
||||
if (device_may_wakeup(dev))
|
||||
ret = enable_irq_wake(info->irq);
|
||||
if (device_may_wakeup(dev)) {
|
||||
if (info->id_irq > 0)
|
||||
ret = enable_irq_wake(info->id_irq);
|
||||
if (info->vbus_irq > 0)
|
||||
ret = enable_irq_wake(info->vbus_irq);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
@ -131,8 +188,12 @@ static int qcom_usb_extcon_resume(struct device *dev)
|
|||
struct qcom_usb_extcon_info *info = dev_get_drvdata(dev);
|
||||
int ret = 0;
|
||||
|
||||
if (device_may_wakeup(dev))
|
||||
ret = disable_irq_wake(info->irq);
|
||||
if (device_may_wakeup(dev)) {
|
||||
if (info->id_irq > 0)
|
||||
ret = disable_irq_wake(info->id_irq);
|
||||
if (info->vbus_irq > 0)
|
||||
ret = disable_irq_wake(info->vbus_irq);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
|
Loading…
Reference in New Issue