508 lines
12 KiB
C
508 lines
12 KiB
C
|
/*
|
||
|
* power_supply_extcon: Power supply detection through extcon.
|
||
|
*
|
||
|
* Copyright (c) 2012-2018, NVIDIA CORPORATION. All rights reserved.
|
||
|
* Laxman Dewangan <ldewangan@nvidia.com>
|
||
|
*
|
||
|
* 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.
|
||
|
*
|
||
|
* This program is distributed in the hope that it will be useful,
|
||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
* GNU General Public License for more details.
|
||
|
*
|
||
|
* You should have received a copy of the GNU General Public License
|
||
|
* along with this program; if not, write to the Free Software
|
||
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
||
|
*/
|
||
|
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/err.h>
|
||
|
#include <linux/err.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/of.h>
|
||
|
#include <linux/of_device.h>
|
||
|
#include <linux/platform_device.h>
|
||
|
#include <linux/power_supply.h>
|
||
|
#include <linux/power/power_supply_extcon.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <linux/extcon.h>
|
||
|
#include <linux/spinlock.h>
|
||
|
|
||
|
#define CHARGER_TYPE_DETECTION_DEFAULT_DEBOUNCE_TIME_MS 500
|
||
|
#define CABLE_NAME_MAX 30
|
||
|
|
||
|
struct power_supply_cables;
|
||
|
|
||
|
struct power_supply_extcon {
|
||
|
struct device *dev;
|
||
|
struct power_supply *ac;
|
||
|
struct power_supply *usb;
|
||
|
uint8_t ac_online;
|
||
|
uint8_t usb_online;
|
||
|
struct power_supply_extcon_plat_data *pdata;
|
||
|
spinlock_t lock;
|
||
|
struct power_supply_cables *psy_cables;
|
||
|
int max_psy_cables;
|
||
|
};
|
||
|
|
||
|
struct power_supply_cables {
|
||
|
const char *name;
|
||
|
const char *dt_cable_name;
|
||
|
const char *print_str;
|
||
|
unsigned int extcon_id;
|
||
|
int usb_online;
|
||
|
int ac_online;
|
||
|
struct power_supply_extcon *psy_extcon;
|
||
|
struct notifier_block nb;
|
||
|
struct extcon_specific_cable_nb ec_cable_nb;
|
||
|
struct extcon_dev *ec_dev;
|
||
|
};
|
||
|
|
||
|
static struct power_supply_cables psy_cables[] = {
|
||
|
{
|
||
|
.name = "USB",
|
||
|
.dt_cable_name = "usb-charger",
|
||
|
.print_str = "USB charger",
|
||
|
.extcon_id = EXTCON_USB,
|
||
|
.usb_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "TA",
|
||
|
.dt_cable_name = "ta-charger",
|
||
|
.print_str = "USB TA",
|
||
|
.extcon_id = EXTCON_CHG_USB_DCP,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "QC2",
|
||
|
.dt_cable_name = "qc2-charger",
|
||
|
.print_str = "USB QC2-charger",
|
||
|
.extcon_id = EXTCON_USB_QC2,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "MAXIM",
|
||
|
.dt_cable_name = "maxim-charger",
|
||
|
.print_str = "USB Maxim-charger",
|
||
|
.extcon_id = EXTCON_USB_MAXIM,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "Fast-charger",
|
||
|
.dt_cable_name = "fast-charger",
|
||
|
.print_str = "USB Fast-charger",
|
||
|
.extcon_id = EXTCON_CHG_USB_FAST,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "Slow-charger",
|
||
|
.dt_cable_name = "slow-charger",
|
||
|
.print_str = "USB Slow-charger",
|
||
|
.extcon_id = EXTCON_CHG_USB_SLOW,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "Charge-downstream",
|
||
|
.dt_cable_name = "downstream-charger",
|
||
|
.print_str = "USB charger downstream",
|
||
|
.extcon_id = EXTCON_CHG_USB_CDP,
|
||
|
.usb_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "Apple 500mA-charger",
|
||
|
.dt_cable_name = "apple-500ma",
|
||
|
.print_str = "USB Apple 500mA-charger",
|
||
|
.extcon_id = EXTCON_USB_APPLE_500mA,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "Apple 1A-charger",
|
||
|
.dt_cable_name = "apple-1a",
|
||
|
.print_str = "USB Apple 1A charger",
|
||
|
.extcon_id = EXTCON_USB_APPLE_1A,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "Apple 2A-charger",
|
||
|
.dt_cable_name = "apple-2a",
|
||
|
.print_str = "USB Apple 2A charger",
|
||
|
.extcon_id = EXTCON_USB_APPLE_2A,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "ACA NV-Charger",
|
||
|
.dt_cable_name = "ACA NV-Charger",
|
||
|
.print_str = "USB ACA NV-Charger",
|
||
|
.extcon_id = EXTCON_USB_ACA_NV,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "ACA RID-B",
|
||
|
.dt_cable_name = "ACA RID-B",
|
||
|
.print_str = "USB ACA RID-B Charger",
|
||
|
.extcon_id = EXTCON_USB_ACA_RIDB,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "ACA RID-C",
|
||
|
.dt_cable_name = "ACA RID-C",
|
||
|
.print_str = "USB ACA RID-C Charger",
|
||
|
.extcon_id = EXTCON_USB_ACA_RIDC,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "Y-cable",
|
||
|
.dt_cable_name = "y-cable",
|
||
|
.print_str = "Y cable",
|
||
|
.extcon_id = EXTCON_USB_Y_CABLE,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "ACA RID-A",
|
||
|
.dt_cable_name = "ACA RID-A",
|
||
|
.print_str = "ACA RID-A cable",
|
||
|
.extcon_id = EXTCON_USB_ACA_RIDA,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "USB-PD",
|
||
|
.dt_cable_name = "usb-pd",
|
||
|
.print_str = "USB Power Delivery",
|
||
|
.extcon_id = EXTCON_USB_PD,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
{
|
||
|
.name = "AC-ADAPTOR",
|
||
|
.dt_cable_name = "ac-adaptor",
|
||
|
.print_str = "ac/dc power adaptor",
|
||
|
.extcon_id = EXTCON_AC_ADAPTOR,
|
||
|
.ac_online = 1,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
static enum power_supply_property power_supply_extcon_props[] = {
|
||
|
POWER_SUPPLY_PROP_ONLINE,
|
||
|
POWER_SUPPLY_PROP_CHARGER_TYPE,
|
||
|
};
|
||
|
|
||
|
static bool psy_get_cable_state(struct power_supply_extcon *psy_extcon,
|
||
|
const char *cable_name)
|
||
|
{
|
||
|
int i;
|
||
|
bool found = false;
|
||
|
int ret;
|
||
|
|
||
|
for (i = 0; i < psy_extcon->max_psy_cables; ++i) {
|
||
|
if (!strncmp(psy_extcon->psy_cables[i].name,
|
||
|
cable_name, CABLE_NAME_MAX)) {
|
||
|
found = true;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (!found)
|
||
|
return 0;
|
||
|
|
||
|
if (!psy_extcon->psy_cables[i].ec_dev)
|
||
|
return 0;
|
||
|
|
||
|
ret = extcon_get_cable_state_(psy_extcon->psy_cables[i].ec_dev,
|
||
|
psy_extcon->psy_cables[i].extcon_id);
|
||
|
if (ret >= 1)
|
||
|
return true;
|
||
|
return false;
|
||
|
}
|
||
|
|
||
|
static int power_supply_extcon_get_property(struct power_supply *psy,
|
||
|
enum power_supply_property psp, union power_supply_propval *val)
|
||
|
{
|
||
|
int online;
|
||
|
int ret = 0;
|
||
|
int i = 0;
|
||
|
bool state = false;
|
||
|
struct power_supply_extcon *psy_extcon = power_supply_get_drvdata(psy);
|
||
|
struct power_supply_cables *psy_cable;
|
||
|
|
||
|
if (psy->desc->type == POWER_SUPPLY_TYPE_MAINS) {
|
||
|
online = psy_extcon->ac_online;
|
||
|
} else if (psy->desc->type == POWER_SUPPLY_TYPE_USB) {
|
||
|
online = psy_extcon->usb_online;
|
||
|
} else {
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
switch (psp) {
|
||
|
case POWER_SUPPLY_PROP_ONLINE:
|
||
|
val->intval = online;
|
||
|
break;
|
||
|
case POWER_SUPPLY_PROP_CHARGER_TYPE:
|
||
|
val->strval = "no cable";
|
||
|
for (i = 0; i < psy_extcon->max_psy_cables; ++i) {
|
||
|
psy_cable = &psy_extcon->psy_cables[i];
|
||
|
if (IS_ERR(psy_cable->ec_dev) || !psy_cable->ec_dev) {
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
state = psy_get_cable_state(psy_extcon, psy_cable->name);
|
||
|
if (state) {
|
||
|
val->strval = psy_cable->name;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
break;
|
||
|
default:
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int power_supply_extcon_attach_cable(
|
||
|
struct power_supply_extcon *psy_extcon)
|
||
|
{
|
||
|
struct power_supply_cables *psy_cable;
|
||
|
bool state = false;
|
||
|
int i;
|
||
|
|
||
|
psy_extcon->usb_online = 0;
|
||
|
psy_extcon->ac_online = 0;
|
||
|
|
||
|
for (i = 0; i < psy_extcon->max_psy_cables; ++i) {
|
||
|
psy_cable = &psy_extcon->psy_cables[i];
|
||
|
if (!psy_cable->ec_dev)
|
||
|
continue;
|
||
|
|
||
|
state = psy_get_cable_state(psy_extcon, psy_cable->name);
|
||
|
if (state) {
|
||
|
dev_info(psy_extcon->dev, "%s cable detected\n",
|
||
|
psy_cable->print_str);
|
||
|
psy_extcon->ac_online = psy_cable->ac_online;
|
||
|
psy_extcon->usb_online = psy_cable->usb_online;
|
||
|
break;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (!state)
|
||
|
dev_info(psy_extcon->dev, "No cable detected\n");
|
||
|
|
||
|
power_supply_changed(psy_extcon->usb);
|
||
|
power_supply_changed(psy_extcon->ac);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int psy_extcon_extcon_notifier(struct notifier_block *self,
|
||
|
unsigned long event, void *ptr)
|
||
|
{
|
||
|
struct power_supply_cables *cable = container_of(self,
|
||
|
struct power_supply_cables, nb);
|
||
|
struct power_supply_extcon *psy_extcon = cable->psy_extcon;
|
||
|
|
||
|
spin_lock(&psy_extcon->lock);
|
||
|
if (event == 0) {
|
||
|
dev_info(psy_extcon->dev, "Charging cable removed\n");
|
||
|
psy_extcon->ac_online = 0;
|
||
|
psy_extcon->usb_online = 0;
|
||
|
} else if (event == 1) {
|
||
|
dev_info(psy_extcon->dev, "%s cable detected\n",
|
||
|
cable->print_str);
|
||
|
psy_extcon->ac_online = cable->ac_online;
|
||
|
psy_extcon->usb_online = cable->usb_online;
|
||
|
}
|
||
|
|
||
|
power_supply_changed(psy_extcon->usb);
|
||
|
power_supply_changed(psy_extcon->ac);
|
||
|
spin_unlock(&psy_extcon->lock);
|
||
|
|
||
|
return NOTIFY_DONE;
|
||
|
}
|
||
|
|
||
|
static struct power_supply_extcon_plat_data *psy_extcon_get_dt_pdata(
|
||
|
struct platform_device *pdev)
|
||
|
{
|
||
|
struct device_node *np = pdev->dev.of_node;
|
||
|
struct power_supply_extcon_plat_data *pdata;
|
||
|
char const *pstr;
|
||
|
int ret;
|
||
|
|
||
|
pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
|
||
|
if (!pdata)
|
||
|
return ERR_PTR(-ENOMEM);
|
||
|
|
||
|
ret = of_property_read_string(np, "power-supply,extcon-dev", &pstr);
|
||
|
if (!ret)
|
||
|
pdata->extcon_name = pstr;
|
||
|
|
||
|
ret = of_property_read_string(np, "power-supply,y-cable-extcon-dev",
|
||
|
&pstr);
|
||
|
if (!ret)
|
||
|
pdata->y_cable_extcon_name = pstr;
|
||
|
|
||
|
return pdata;
|
||
|
}
|
||
|
|
||
|
static const struct power_supply_desc psy_extcon_ac = {
|
||
|
.name = "ac",
|
||
|
.type = POWER_SUPPLY_TYPE_MAINS,
|
||
|
.get_property = power_supply_extcon_get_property,
|
||
|
.properties = power_supply_extcon_props,
|
||
|
.num_properties = ARRAY_SIZE(power_supply_extcon_props),
|
||
|
};
|
||
|
|
||
|
static const struct power_supply_desc psy_extcon_usb = {
|
||
|
.name = "usb",
|
||
|
.type = POWER_SUPPLY_TYPE_USB,
|
||
|
.get_property = power_supply_extcon_get_property,
|
||
|
.properties = power_supply_extcon_props,
|
||
|
.num_properties = ARRAY_SIZE(power_supply_extcon_props),
|
||
|
};
|
||
|
|
||
|
static int psy_extcon_probe(struct platform_device *pdev)
|
||
|
{
|
||
|
int ret = 0;
|
||
|
uint8_t j;
|
||
|
struct power_supply_extcon *psy_extcon;
|
||
|
struct power_supply_config psy_cfg = {};
|
||
|
struct power_supply_extcon_plat_data *pdata = pdev->dev.platform_data;
|
||
|
|
||
|
if (!pdata && pdev->dev.of_node) {
|
||
|
pdata = psy_extcon_get_dt_pdata(pdev);
|
||
|
if (IS_ERR(pdata)) {
|
||
|
ret = PTR_ERR(pdata);
|
||
|
pdata = NULL;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (!pdata) {
|
||
|
dev_err(&pdev->dev, "No platform data, exiting..\n");
|
||
|
return -ENODEV;
|
||
|
}
|
||
|
|
||
|
psy_extcon = devm_kzalloc(&pdev->dev, sizeof(*psy_extcon), GFP_KERNEL);
|
||
|
if (!psy_extcon) {
|
||
|
dev_err(&pdev->dev, "failed to allocate memory status\n");
|
||
|
return -ENOMEM;
|
||
|
}
|
||
|
|
||
|
psy_extcon->dev = &pdev->dev;
|
||
|
dev_set_drvdata(&pdev->dev, psy_extcon);
|
||
|
spin_lock_init(&psy_extcon->lock);
|
||
|
|
||
|
dev_info(psy_extcon->dev, "Extcon name %s\n", pdata->extcon_name);
|
||
|
|
||
|
psy_cfg.drv_data = psy_extcon;
|
||
|
|
||
|
psy_extcon->ac = devm_power_supply_register(psy_extcon->dev,
|
||
|
&psy_extcon_ac, &psy_cfg);
|
||
|
if (IS_ERR(psy_extcon->ac)) {
|
||
|
dev_err(psy_extcon->dev, "failed: ac power supply register\n");
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
psy_extcon->usb = devm_power_supply_register(psy_extcon->dev,
|
||
|
&psy_extcon_usb, &psy_cfg);
|
||
|
if (IS_ERR(psy_extcon->usb)) {
|
||
|
dev_err(psy_extcon->dev, "failed: usb power supply register\n");
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
for (j = 0; j < ARRAY_SIZE(psy_cables); j++) {
|
||
|
struct power_supply_cables *psy_cable = &psy_cables[j];
|
||
|
const char *ext_name;
|
||
|
|
||
|
ext_name = pdata->extcon_name;
|
||
|
psy_cable->psy_extcon = psy_extcon;
|
||
|
psy_cable->nb.notifier_call = psy_extcon_extcon_notifier;
|
||
|
|
||
|
psy_cable->ec_dev = extcon_get_extcon_dev_by_cable(psy_extcon->dev,
|
||
|
psy_cable->dt_cable_name);
|
||
|
if (!IS_ERR(psy_cable->ec_dev))
|
||
|
goto register_cable;
|
||
|
|
||
|
psy_cable->ec_dev = NULL;
|
||
|
if (!strcmp(psy_cable->name, "Y-cable") ||
|
||
|
!strcmp(psy_cable->name, "ACA RID-A"))
|
||
|
ext_name = pdata->y_cable_extcon_name;
|
||
|
if (!ext_name) {
|
||
|
dev_dbg(psy_extcon->dev, "No extname for cable %s\n",
|
||
|
psy_cable->name);
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
psy_cable->ec_dev = extcon_get_extcon_dev_by_cable(psy_extcon->dev,
|
||
|
psy_cable->dt_cable_name);
|
||
|
if (IS_ERR(psy_cable->ec_dev)) {
|
||
|
dev_err(psy_extcon->dev,
|
||
|
"Cable %s not found on ext_name %s\n",
|
||
|
psy_cable->name, ext_name);
|
||
|
psy_cable->ec_dev = NULL;
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
register_cable:
|
||
|
ret = extcon_register_notifier(psy_cable->ec_dev,
|
||
|
psy_cable->extcon_id, &psy_cable->nb);
|
||
|
if (ret < 0) {
|
||
|
dev_err(psy_extcon->dev,
|
||
|
"Cable %s registration failed: %d\n",
|
||
|
psy_cable->name, ret);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
psy_extcon->psy_cables = psy_cables;
|
||
|
barrier();
|
||
|
psy_extcon->max_psy_cables = ARRAY_SIZE(psy_cables);
|
||
|
|
||
|
spin_lock(&psy_extcon->lock);
|
||
|
power_supply_extcon_attach_cable(psy_extcon);
|
||
|
spin_unlock(&psy_extcon->lock);
|
||
|
|
||
|
dev_info(&pdev->dev, "%s() get success\n", __func__);
|
||
|
return 0;
|
||
|
|
||
|
}
|
||
|
|
||
|
static int psy_extcon_remove(struct platform_device *pdev)
|
||
|
{
|
||
|
struct power_supply_extcon *psy_extcon = platform_get_drvdata(pdev);
|
||
|
|
||
|
power_supply_unregister(psy_extcon->ac);
|
||
|
power_supply_unregister(psy_extcon->usb);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static struct of_device_id power_supply_extcon_of_match[] = {
|
||
|
{ .compatible = "power-supply-extcon", },
|
||
|
{},
|
||
|
};
|
||
|
MODULE_DEVICE_TABLE(of, power_supply_extcon_of_match);
|
||
|
|
||
|
static struct platform_driver power_supply_extcon_driver = {
|
||
|
.driver = {
|
||
|
.name = "power-supply-extcon",
|
||
|
.owner = THIS_MODULE,
|
||
|
.of_match_table = power_supply_extcon_of_match,
|
||
|
},
|
||
|
.probe = psy_extcon_probe,
|
||
|
.remove = psy_extcon_remove,
|
||
|
};
|
||
|
|
||
|
static int __init psy_extcon_init(void)
|
||
|
{
|
||
|
return platform_driver_register(&power_supply_extcon_driver);
|
||
|
}
|
||
|
|
||
|
static void __exit psy_extcon_exit(void)
|
||
|
{
|
||
|
platform_driver_unregister(&power_supply_extcon_driver);
|
||
|
}
|
||
|
|
||
|
late_initcall(psy_extcon_init);
|
||
|
module_exit(psy_extcon_exit);
|
||
|
|
||
|
MODULE_DESCRIPTION("Power supply detection through extcon driver");
|
||
|
MODULE_AUTHOR("Laxman Dewangan <ldewangan@nvidia.com>");
|
||
|
MODULE_LICENSE("GPL v2");
|