cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

ucs1002_power.c (18009B)


      1// SPDX-License-Identifier: GPL-2.0+
      2/*
      3 * Driver for UCS1002 Programmable USB Port Power Controller
      4 *
      5 * Copyright (C) 2019 Zodiac Inflight Innovations
      6 */
      7#include <linux/bits.h>
      8#include <linux/freezer.h>
      9#include <linux/gpio/consumer.h>
     10#include <linux/i2c.h>
     11#include <linux/interrupt.h>
     12#include <linux/kernel.h>
     13#include <linux/kthread.h>
     14#include <linux/device.h>
     15#include <linux/module.h>
     16#include <linux/of.h>
     17#include <linux/of_irq.h>
     18#include <linux/power_supply.h>
     19#include <linux/regmap.h>
     20#include <linux/regulator/driver.h>
     21#include <linux/regulator/of_regulator.h>
     22
     23/* UCS1002 Registers */
     24#define UCS1002_REG_CURRENT_MEASUREMENT	0x00
     25
     26/*
     27 * The Total Accumulated Charge registers store the total accumulated
     28 * charge delivered from the VS source to a portable device. The total
     29 * value is calculated using four registers, from 01h to 04h. The bit
     30 * weighting of the registers is given in mA/hrs.
     31 */
     32#define UCS1002_REG_TOTAL_ACC_CHARGE	0x01
     33
     34/* Other Status Register */
     35#define UCS1002_REG_OTHER_STATUS	0x0f
     36#  define F_ADET_PIN			BIT(4)
     37#  define F_CHG_ACT			BIT(3)
     38
     39/* Interrupt Status */
     40#define UCS1002_REG_INTERRUPT_STATUS	0x10
     41#  define F_ERR				BIT(7)
     42#  define F_DISCHARGE_ERR		BIT(6)
     43#  define F_RESET			BIT(5)
     44#  define F_MIN_KEEP_OUT		BIT(4)
     45#  define F_TSD				BIT(3)
     46#  define F_OVER_VOLT			BIT(2)
     47#  define F_BACK_VOLT			BIT(1)
     48#  define F_OVER_ILIM			BIT(0)
     49
     50/* Pin Status Register */
     51#define UCS1002_REG_PIN_STATUS		0x14
     52#  define UCS1002_PWR_STATE_MASK	0x03
     53#  define F_PWR_EN_PIN			BIT(6)
     54#  define F_M2_PIN			BIT(5)
     55#  define F_M1_PIN			BIT(4)
     56#  define F_EM_EN_PIN			BIT(3)
     57#  define F_SEL_PIN			BIT(2)
     58#  define F_ACTIVE_MODE_MASK		GENMASK(5, 3)
     59#  define F_ACTIVE_MODE_PASSTHROUGH	F_M2_PIN
     60#  define F_ACTIVE_MODE_DEDICATED	F_EM_EN_PIN
     61#  define F_ACTIVE_MODE_BC12_DCP	(F_M2_PIN | F_EM_EN_PIN)
     62#  define F_ACTIVE_MODE_BC12_SDP	F_M1_PIN
     63#  define F_ACTIVE_MODE_BC12_CDP	(F_M1_PIN | F_M2_PIN | F_EM_EN_PIN)
     64
     65/* General Configuration Register */
     66#define UCS1002_REG_GENERAL_CFG		0x15
     67#  define F_RATION_EN			BIT(3)
     68
     69/* Emulation Configuration Register */
     70#define UCS1002_REG_EMU_CFG		0x16
     71
     72/* Switch Configuration Register */
     73#define UCS1002_REG_SWITCH_CFG		0x17
     74#  define F_PIN_IGNORE			BIT(7)
     75#  define F_EM_EN_SET			BIT(5)
     76#  define F_M2_SET			BIT(4)
     77#  define F_M1_SET			BIT(3)
     78#  define F_S0_SET			BIT(2)
     79#  define F_PWR_EN_SET			BIT(1)
     80#  define F_LATCH_SET			BIT(0)
     81#  define V_SET_ACTIVE_MODE_MASK	GENMASK(5, 3)
     82#  define V_SET_ACTIVE_MODE_PASSTHROUGH	F_M2_SET
     83#  define V_SET_ACTIVE_MODE_DEDICATED	F_EM_EN_SET
     84#  define V_SET_ACTIVE_MODE_BC12_DCP	(F_M2_SET | F_EM_EN_SET)
     85#  define V_SET_ACTIVE_MODE_BC12_SDP	F_M1_SET
     86#  define V_SET_ACTIVE_MODE_BC12_CDP	(F_M1_SET | F_M2_SET | F_EM_EN_SET)
     87
     88/* Current Limit Register */
     89#define UCS1002_REG_ILIMIT		0x19
     90#  define UCS1002_ILIM_SW_MASK		GENMASK(3, 0)
     91
     92/* Product ID */
     93#define UCS1002_REG_PRODUCT_ID		0xfd
     94#  define UCS1002_PRODUCT_ID		0x4e
     95
     96/* Manufacture name */
     97#define UCS1002_MANUFACTURER		"SMSC"
     98
     99struct ucs1002_info {
    100	struct power_supply *charger;
    101	struct i2c_client *client;
    102	struct regmap *regmap;
    103	struct regulator_desc *regulator_descriptor;
    104	struct regulator_dev *rdev;
    105	bool present;
    106	bool output_disable;
    107	struct delayed_work health_poll;
    108	int health;
    109
    110};
    111
    112static enum power_supply_property ucs1002_props[] = {
    113	POWER_SUPPLY_PROP_ONLINE,
    114	POWER_SUPPLY_PROP_CHARGE_NOW,
    115	POWER_SUPPLY_PROP_CURRENT_NOW,
    116	POWER_SUPPLY_PROP_CURRENT_MAX,
    117	POWER_SUPPLY_PROP_PRESENT, /* the presence of PED */
    118	POWER_SUPPLY_PROP_MANUFACTURER,
    119	POWER_SUPPLY_PROP_USB_TYPE,
    120	POWER_SUPPLY_PROP_HEALTH,
    121};
    122
    123static int ucs1002_get_online(struct ucs1002_info *info,
    124			      union power_supply_propval *val)
    125{
    126	unsigned int reg;
    127	int ret;
    128
    129	ret = regmap_read(info->regmap, UCS1002_REG_OTHER_STATUS, &reg);
    130	if (ret)
    131		return ret;
    132
    133	val->intval = !!(reg & F_CHG_ACT);
    134
    135	return 0;
    136}
    137
    138static int ucs1002_get_charge(struct ucs1002_info *info,
    139			      union power_supply_propval *val)
    140{
    141	/*
    142	 * To fit within 32 bits some values are rounded (uA/h)
    143	 *
    144	 * For Total Accumulated Charge Middle Low Byte register, addr
    145	 * 03h, byte 2
    146	 *
    147	 *   B0: 0.01084 mA/h rounded to 11 uA/h
    148	 *   B1: 0.02169 mA/h rounded to 22 uA/h
    149	 *   B2: 0.04340 mA/h rounded to 43 uA/h
    150	 *   B3: 0.08676 mA/h rounded to 87 uA/h
    151	 *   B4: 0.17350 mA/h rounded to 173 uÁ/h
    152	 *
    153	 * For Total Accumulated Charge Low Byte register, addr 04h,
    154	 * byte 3
    155	 *
    156	 *   B6: 0.00271 mA/h rounded to 3 uA/h
    157	 *   B7: 0.005422 mA/h rounded to 5 uA/h
    158	 */
    159	static const int bit_weights_uAh[BITS_PER_TYPE(u32)] = {
    160		/*
    161		 * Bit corresponding to low byte (offset 0x04)
    162		 * B0 B1 B2 B3 B4 B5 B6 B7
    163		 */
    164		0, 0, 0, 0, 0, 0, 3, 5,
    165		/*
    166		 * Bit corresponding to middle low byte (offset 0x03)
    167		 * B0 B1 B2 B3 B4 B5 B6 B7
    168		 */
    169		11, 22, 43, 87, 173, 347, 694, 1388,
    170		/*
    171		 * Bit corresponding to middle high byte (offset 0x02)
    172		 * B0 B1 B2 B3 B4 B5 B6 B7
    173		 */
    174		2776, 5552, 11105, 22210, 44420, 88840, 177700, 355400,
    175		/*
    176		 * Bit corresponding to high byte (offset 0x01)
    177		 * B0 B1 B2 B3 B4 B5 B6 B7
    178		 */
    179		710700, 1421000, 2843000, 5685000, 11371000, 22742000,
    180		45484000, 90968000,
    181	};
    182	unsigned long total_acc_charger;
    183	unsigned int reg;
    184	int i, ret;
    185
    186	ret = regmap_bulk_read(info->regmap, UCS1002_REG_TOTAL_ACC_CHARGE,
    187			       &reg, sizeof(u32));
    188	if (ret)
    189		return ret;
    190
    191	total_acc_charger = be32_to_cpu(reg); /* BE as per offsets above */
    192	val->intval = 0;
    193
    194	for_each_set_bit(i, &total_acc_charger, ARRAY_SIZE(bit_weights_uAh))
    195		val->intval += bit_weights_uAh[i];
    196
    197	return 0;
    198}
    199
    200static int ucs1002_get_current(struct ucs1002_info *info,
    201			       union power_supply_propval *val)
    202{
    203	/*
    204	 * The Current Measurement register stores the measured
    205	 * current value delivered to the portable device. The range
    206	 * is from 9.76 mA to 2.5 A.
    207	 */
    208	static const int bit_weights_uA[BITS_PER_TYPE(u8)] = {
    209		9760, 19500, 39000, 78100, 156200, 312300, 624600, 1249300,
    210	};
    211	unsigned long current_measurement;
    212	unsigned int reg;
    213	int i, ret;
    214
    215	ret = regmap_read(info->regmap, UCS1002_REG_CURRENT_MEASUREMENT, &reg);
    216	if (ret)
    217		return ret;
    218
    219	current_measurement = reg;
    220	val->intval = 0;
    221
    222	for_each_set_bit(i, &current_measurement, ARRAY_SIZE(bit_weights_uA))
    223		val->intval += bit_weights_uA[i];
    224
    225	return 0;
    226}
    227
    228/*
    229 * The Current Limit register stores the maximum current used by the
    230 * port switch. The range is from 500mA to 2.5 A.
    231 */
    232static const u32 ucs1002_current_limit_uA[] = {
    233	500000, 900000, 1000000, 1200000, 1500000, 1800000, 2000000, 2500000,
    234};
    235
    236static int ucs1002_get_max_current(struct ucs1002_info *info,
    237				   union power_supply_propval *val)
    238{
    239	unsigned int reg;
    240	int ret;
    241
    242	if (info->output_disable) {
    243		val->intval = 0;
    244		return 0;
    245	}
    246
    247	ret = regmap_read(info->regmap, UCS1002_REG_ILIMIT, &reg);
    248	if (ret)
    249		return ret;
    250
    251	val->intval = ucs1002_current_limit_uA[reg & UCS1002_ILIM_SW_MASK];
    252
    253	return 0;
    254}
    255
    256static int ucs1002_set_max_current(struct ucs1002_info *info, u32 val)
    257{
    258	unsigned int reg;
    259	int ret, idx;
    260
    261	if (val == 0) {
    262		info->output_disable = true;
    263		regulator_disable_regmap(info->rdev);
    264		return 0;
    265	}
    266
    267	for (idx = 0; idx < ARRAY_SIZE(ucs1002_current_limit_uA); idx++) {
    268		if (val == ucs1002_current_limit_uA[idx])
    269			break;
    270	}
    271
    272	if (idx == ARRAY_SIZE(ucs1002_current_limit_uA))
    273		return -EINVAL;
    274
    275	ret = regmap_write(info->regmap, UCS1002_REG_ILIMIT, idx);
    276	if (ret)
    277		return ret;
    278	/*
    279	 * Any current limit setting exceeding the one set via ILIM
    280	 * pin will be rejected, so we read out freshly changed limit
    281	 * to make sure that it took effect.
    282	 */
    283	ret = regmap_read(info->regmap, UCS1002_REG_ILIMIT, &reg);
    284	if (ret)
    285		return ret;
    286
    287	if (reg != idx)
    288		return -EINVAL;
    289
    290	info->output_disable = false;
    291
    292	if (info->rdev && info->rdev->use_count &&
    293	    !regulator_is_enabled_regmap(info->rdev))
    294		regulator_enable_regmap(info->rdev);
    295
    296	return 0;
    297}
    298
    299static enum power_supply_usb_type ucs1002_usb_types[] = {
    300	POWER_SUPPLY_USB_TYPE_PD,
    301	POWER_SUPPLY_USB_TYPE_SDP,
    302	POWER_SUPPLY_USB_TYPE_DCP,
    303	POWER_SUPPLY_USB_TYPE_CDP,
    304	POWER_SUPPLY_USB_TYPE_UNKNOWN,
    305};
    306
    307static int ucs1002_set_usb_type(struct ucs1002_info *info, int val)
    308{
    309	unsigned int mode;
    310
    311	if (val < 0 || val >= ARRAY_SIZE(ucs1002_usb_types))
    312		return -EINVAL;
    313
    314	switch (ucs1002_usb_types[val]) {
    315	case POWER_SUPPLY_USB_TYPE_PD:
    316		mode = V_SET_ACTIVE_MODE_DEDICATED;
    317		break;
    318	case POWER_SUPPLY_USB_TYPE_SDP:
    319		mode = V_SET_ACTIVE_MODE_BC12_SDP;
    320		break;
    321	case POWER_SUPPLY_USB_TYPE_DCP:
    322		mode = V_SET_ACTIVE_MODE_BC12_DCP;
    323		break;
    324	case POWER_SUPPLY_USB_TYPE_CDP:
    325		mode = V_SET_ACTIVE_MODE_BC12_CDP;
    326		break;
    327	default:
    328		return -EINVAL;
    329	}
    330
    331	return regmap_update_bits(info->regmap, UCS1002_REG_SWITCH_CFG,
    332				  V_SET_ACTIVE_MODE_MASK, mode);
    333}
    334
    335static int ucs1002_get_usb_type(struct ucs1002_info *info,
    336				union power_supply_propval *val)
    337{
    338	enum power_supply_usb_type type;
    339	unsigned int reg;
    340	int ret;
    341
    342	ret = regmap_read(info->regmap, UCS1002_REG_PIN_STATUS, &reg);
    343	if (ret)
    344		return ret;
    345
    346	switch (reg & F_ACTIVE_MODE_MASK) {
    347	default:
    348		type = POWER_SUPPLY_USB_TYPE_UNKNOWN;
    349		break;
    350	case F_ACTIVE_MODE_DEDICATED:
    351		type = POWER_SUPPLY_USB_TYPE_PD;
    352		break;
    353	case F_ACTIVE_MODE_BC12_SDP:
    354		type = POWER_SUPPLY_USB_TYPE_SDP;
    355		break;
    356	case F_ACTIVE_MODE_BC12_DCP:
    357		type = POWER_SUPPLY_USB_TYPE_DCP;
    358		break;
    359	case F_ACTIVE_MODE_BC12_CDP:
    360		type = POWER_SUPPLY_USB_TYPE_CDP;
    361		break;
    362	}
    363
    364	val->intval = type;
    365
    366	return 0;
    367}
    368
    369static int ucs1002_get_property(struct power_supply *psy,
    370				enum power_supply_property psp,
    371				union power_supply_propval *val)
    372{
    373	struct ucs1002_info *info = power_supply_get_drvdata(psy);
    374
    375	switch (psp) {
    376	case POWER_SUPPLY_PROP_ONLINE:
    377		return ucs1002_get_online(info, val);
    378	case POWER_SUPPLY_PROP_CHARGE_NOW:
    379		return ucs1002_get_charge(info, val);
    380	case POWER_SUPPLY_PROP_CURRENT_NOW:
    381		return ucs1002_get_current(info, val);
    382	case POWER_SUPPLY_PROP_CURRENT_MAX:
    383		return ucs1002_get_max_current(info, val);
    384	case POWER_SUPPLY_PROP_USB_TYPE:
    385		return ucs1002_get_usb_type(info, val);
    386	case POWER_SUPPLY_PROP_HEALTH:
    387		return val->intval = info->health;
    388	case POWER_SUPPLY_PROP_PRESENT:
    389		val->intval = info->present;
    390		return 0;
    391	case POWER_SUPPLY_PROP_MANUFACTURER:
    392		val->strval = UCS1002_MANUFACTURER;
    393		return 0;
    394	default:
    395		return -EINVAL;
    396	}
    397}
    398
    399static int ucs1002_set_property(struct power_supply *psy,
    400				enum power_supply_property psp,
    401				const union power_supply_propval *val)
    402{
    403	struct ucs1002_info *info = power_supply_get_drvdata(psy);
    404
    405	switch (psp) {
    406	case POWER_SUPPLY_PROP_CURRENT_MAX:
    407		return ucs1002_set_max_current(info, val->intval);
    408	case POWER_SUPPLY_PROP_USB_TYPE:
    409		return ucs1002_set_usb_type(info, val->intval);
    410	default:
    411		return -EINVAL;
    412	}
    413}
    414
    415static int ucs1002_property_is_writeable(struct power_supply *psy,
    416					 enum power_supply_property psp)
    417{
    418	switch (psp) {
    419	case POWER_SUPPLY_PROP_CURRENT_MAX:
    420	case POWER_SUPPLY_PROP_USB_TYPE:
    421		return true;
    422	default:
    423		return false;
    424	}
    425}
    426
    427static const struct power_supply_desc ucs1002_charger_desc = {
    428	.name			= "ucs1002",
    429	.type			= POWER_SUPPLY_TYPE_USB,
    430	.usb_types		= ucs1002_usb_types,
    431	.num_usb_types		= ARRAY_SIZE(ucs1002_usb_types),
    432	.get_property		= ucs1002_get_property,
    433	.set_property		= ucs1002_set_property,
    434	.property_is_writeable	= ucs1002_property_is_writeable,
    435	.properties		= ucs1002_props,
    436	.num_properties		= ARRAY_SIZE(ucs1002_props),
    437};
    438
    439static void ucs1002_health_poll(struct work_struct *work)
    440{
    441	struct ucs1002_info *info = container_of(work, struct ucs1002_info,
    442						 health_poll.work);
    443	int ret;
    444	u32 reg;
    445
    446	ret = regmap_read(info->regmap, UCS1002_REG_INTERRUPT_STATUS, &reg);
    447	if (ret)
    448		return;
    449
    450	/* bad health and no status change, just schedule us again in a while */
    451	if ((reg & F_ERR) && info->health != POWER_SUPPLY_HEALTH_GOOD) {
    452		schedule_delayed_work(&info->health_poll,
    453				      msecs_to_jiffies(2000));
    454		return;
    455	}
    456
    457	if (reg & F_TSD)
    458		info->health = POWER_SUPPLY_HEALTH_OVERHEAT;
    459	else if (reg & (F_OVER_VOLT | F_BACK_VOLT))
    460		info->health = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
    461	else if (reg & F_OVER_ILIM)
    462		info->health = POWER_SUPPLY_HEALTH_OVERCURRENT;
    463	else if (reg & (F_DISCHARGE_ERR | F_MIN_KEEP_OUT))
    464		info->health = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
    465	else
    466		info->health = POWER_SUPPLY_HEALTH_GOOD;
    467
    468	sysfs_notify(&info->charger->dev.kobj, NULL, "health");
    469}
    470
    471static irqreturn_t ucs1002_charger_irq(int irq, void *data)
    472{
    473	int ret, regval;
    474	bool present;
    475	struct ucs1002_info *info = data;
    476
    477	present = info->present;
    478
    479	ret = regmap_read(info->regmap, UCS1002_REG_OTHER_STATUS, &regval);
    480	if (ret)
    481		return IRQ_HANDLED;
    482
    483	/* update attached status */
    484	info->present = regval & F_ADET_PIN;
    485
    486	/* notify the change */
    487	if (present != info->present)
    488		power_supply_changed(info->charger);
    489
    490	return IRQ_HANDLED;
    491}
    492
    493static irqreturn_t ucs1002_alert_irq(int irq, void *data)
    494{
    495	struct ucs1002_info *info = data;
    496
    497	mod_delayed_work(system_wq, &info->health_poll, 0);
    498
    499	return IRQ_HANDLED;
    500}
    501
    502static int ucs1002_regulator_enable(struct regulator_dev *rdev)
    503{
    504	struct ucs1002_info *info = rdev_get_drvdata(rdev);
    505
    506	/*
    507	 * If the output is disabled due to 0 maximum current, just pretend the
    508	 * enable did work. The regulator will be enabled as soon as we get a
    509	 * a non-zero maximum current budget.
    510	 */
    511	if (info->output_disable)
    512		return 0;
    513
    514	return regulator_enable_regmap(rdev);
    515}
    516
    517static const struct regulator_ops ucs1002_regulator_ops = {
    518	.is_enabled	= regulator_is_enabled_regmap,
    519	.enable		= ucs1002_regulator_enable,
    520	.disable	= regulator_disable_regmap,
    521};
    522
    523static const struct regulator_desc ucs1002_regulator_descriptor = {
    524	.name		= "ucs1002-vbus",
    525	.ops		= &ucs1002_regulator_ops,
    526	.type		= REGULATOR_VOLTAGE,
    527	.owner		= THIS_MODULE,
    528	.enable_reg	= UCS1002_REG_SWITCH_CFG,
    529	.enable_mask	= F_PWR_EN_SET,
    530	.enable_val	= F_PWR_EN_SET,
    531	.fixed_uV	= 5000000,
    532	.n_voltages	= 1,
    533};
    534
    535static int ucs1002_probe(struct i2c_client *client,
    536			 const struct i2c_device_id *dev_id)
    537{
    538	struct device *dev = &client->dev;
    539	struct power_supply_config charger_config = {};
    540	const struct regmap_config regmap_config = {
    541		.reg_bits = 8,
    542		.val_bits = 8,
    543	};
    544	struct regulator_config regulator_config = {};
    545	int irq_a_det, irq_alert, ret;
    546	struct ucs1002_info *info;
    547	unsigned int regval;
    548
    549	info = devm_kzalloc(dev, sizeof(*info), GFP_KERNEL);
    550	if (!info)
    551		return -ENOMEM;
    552
    553	info->regmap = devm_regmap_init_i2c(client, &regmap_config);
    554	ret = PTR_ERR_OR_ZERO(info->regmap);
    555	if (ret) {
    556		dev_err(dev, "Regmap initialization failed: %d\n", ret);
    557		return ret;
    558	}
    559
    560	info->client = client;
    561
    562	irq_a_det = of_irq_get_byname(dev->of_node, "a_det");
    563	irq_alert = of_irq_get_byname(dev->of_node, "alert");
    564
    565	charger_config.of_node = dev->of_node;
    566	charger_config.drv_data = info;
    567
    568	ret = regmap_read(info->regmap, UCS1002_REG_PRODUCT_ID, &regval);
    569	if (ret) {
    570		dev_err(dev, "Failed to read product ID: %d\n", ret);
    571		return ret;
    572	}
    573
    574	if (regval != UCS1002_PRODUCT_ID) {
    575		dev_err(dev,
    576			"Product ID does not match (0x%02x != 0x%02x)\n",
    577			regval, UCS1002_PRODUCT_ID);
    578		return -ENODEV;
    579	}
    580
    581	/* Enable charge rationing by default */
    582	ret = regmap_update_bits(info->regmap, UCS1002_REG_GENERAL_CFG,
    583				 F_RATION_EN, F_RATION_EN);
    584	if (ret) {
    585		dev_err(dev, "Failed to read general config: %d\n", ret);
    586		return ret;
    587	}
    588
    589	/*
    590	 * Ignore the M1, M2, PWR_EN, and EM_EN pin states. Set active
    591	 * mode selection to BC1.2 CDP.
    592	 */
    593	ret = regmap_update_bits(info->regmap, UCS1002_REG_SWITCH_CFG,
    594				 V_SET_ACTIVE_MODE_MASK | F_PIN_IGNORE,
    595				 V_SET_ACTIVE_MODE_BC12_CDP | F_PIN_IGNORE);
    596	if (ret) {
    597		dev_err(dev, "Failed to configure default mode: %d\n", ret);
    598		return ret;
    599	}
    600	/*
    601	 * Be safe and set initial current limit to 500mA
    602	 */
    603	ret = ucs1002_set_max_current(info, 500000);
    604	if (ret) {
    605		dev_err(dev, "Failed to set max current default: %d\n", ret);
    606		return ret;
    607	}
    608
    609	info->charger = devm_power_supply_register(dev, &ucs1002_charger_desc,
    610						   &charger_config);
    611	ret = PTR_ERR_OR_ZERO(info->charger);
    612	if (ret) {
    613		dev_err(dev, "Failed to register power supply: %d\n", ret);
    614		return ret;
    615	}
    616
    617	ret = regmap_read(info->regmap, UCS1002_REG_PIN_STATUS, &regval);
    618	if (ret) {
    619		dev_err(dev, "Failed to read pin status: %d\n", ret);
    620		return ret;
    621	}
    622
    623	info->regulator_descriptor =
    624		devm_kmemdup(dev, &ucs1002_regulator_descriptor,
    625			     sizeof(ucs1002_regulator_descriptor),
    626			     GFP_KERNEL);
    627	if (!info->regulator_descriptor)
    628		return -ENOMEM;
    629
    630	info->regulator_descriptor->enable_is_inverted = !(regval & F_SEL_PIN);
    631
    632	regulator_config.dev = dev;
    633	regulator_config.of_node = dev->of_node;
    634	regulator_config.regmap = info->regmap;
    635	regulator_config.driver_data = info;
    636
    637	info->rdev = devm_regulator_register(dev, info->regulator_descriptor,
    638				       &regulator_config);
    639	ret = PTR_ERR_OR_ZERO(info->rdev);
    640	if (ret) {
    641		dev_err(dev, "Failed to register VBUS regulator: %d\n", ret);
    642		return ret;
    643	}
    644
    645	info->health = POWER_SUPPLY_HEALTH_GOOD;
    646	INIT_DELAYED_WORK(&info->health_poll, ucs1002_health_poll);
    647
    648	if (irq_a_det > 0) {
    649		ret = devm_request_threaded_irq(dev, irq_a_det, NULL,
    650						ucs1002_charger_irq,
    651						IRQF_ONESHOT,
    652						"ucs1002-a_det", info);
    653		if (ret) {
    654			dev_err(dev, "Failed to request A_DET threaded irq: %d\n",
    655				ret);
    656			return ret;
    657		}
    658	}
    659
    660	if (irq_alert > 0) {
    661		ret = devm_request_irq(dev, irq_alert, ucs1002_alert_irq,
    662				       0,"ucs1002-alert", info);
    663		if (ret) {
    664			dev_err(dev, "Failed to request ALERT threaded irq: %d\n",
    665				ret);
    666			return ret;
    667		}
    668	}
    669
    670	return 0;
    671}
    672
    673static const struct of_device_id ucs1002_of_match[] = {
    674	{ .compatible = "microchip,ucs1002", },
    675	{ /* sentinel */ },
    676};
    677MODULE_DEVICE_TABLE(of, ucs1002_of_match);
    678
    679static struct i2c_driver ucs1002_driver = {
    680	.driver = {
    681		   .name = "ucs1002",
    682		   .of_match_table = ucs1002_of_match,
    683	},
    684	.probe = ucs1002_probe,
    685};
    686module_i2c_driver(ucs1002_driver);
    687
    688MODULE_DESCRIPTION("Microchip UCS1002 Programmable USB Port Power Controller");
    689MODULE_AUTHOR("Enric Balletbo Serra <enric.balletbo@collabora.com>");
    690MODULE_AUTHOR("Andrey Smirnov <andrew.smirnov@gmail.com>");
    691MODULE_LICENSE("GPL");