| lists.openwall.net | lists / announce owl-users owl-dev john-users john-dev passwdqc-users yescrypt popa3d-users / oss-security kernel-hardening musl sabotage tlsify passwords / crypt-dev xvendor / Bugtraq Full-Disclosure linux-kernel linux-netdev linux-ext4 linux-hardening linux-cve-announce PHC | |
|
Open Source and information security mailing list archives
| ||
|
Message-ID: <20140703152528.GB23309@earth.universe>
Date: Thu, 3 Jul 2014 17:25:29 +0200
From: Sebastian Reichel <sre@...nel.org>
To: Jenny TC <jenny.tc@...el.com>
Cc: linux-kernel@...r.kernel.org,
Dmitry Eremin-Solenikov <dbaryshkov@...il.com>,
Pavel Machek <pavel@....cz>,
Stephen Rothwell <sfr@...b.auug.org.au>,
Anton Vorontsov <anton.vorontsov@...aro.org>,
David Woodhouse <dwmw2@...radead.org>,
David Cohen <david.a.cohen@...ux.intel.com>,
Pallala Ramakrishna <ramakrishna.pallala@...el.com>
Subject: Re: [PATCH 4/4] power_supply: bq24261 charger driver
Hi,
On Mon, Jun 30, 2014 at 03:25:55PM +0530, Jenny TC wrote:
> This patch introduces BQ24261 charger driver. The driver makes use of power
> supply charging driver to setup charging. So the driver does hardware
> abstraction and handles h/w specific corner cases. The charging logic resides
> with power supply charging driver
I just found one thing. See below:
> Signed-off-by: Jenny TC <jenny.tc@...el.com>
> ---
> drivers/power/Kconfig | 10 +
> drivers/power/Makefile | 1 +
> drivers/power/bq24261_charger.c | 1351 +++++++++++++++++++++++++++++++++
> include/linux/power/bq24261-charger.h | 25 +
> 4 files changed, 1387 insertions(+)
> create mode 100644 drivers/power/bq24261_charger.c
> create mode 100644 include/linux/power/bq24261-charger.h
>
> diff --git a/drivers/power/Kconfig b/drivers/power/Kconfig
> index 54a0321..4ff080c 100644
> --- a/drivers/power/Kconfig
> +++ b/drivers/power/Kconfig
> @@ -411,6 +411,16 @@ config BATTERY_GOLDFISH
> Say Y to enable support for the battery and AC power in the
> Goldfish emulator.
>
> +config CHARGER_BQ24261
> + tristate "BQ24261 charger driver"
> + select POWER_SUPPLY_CHARGER
> + depends on I2C
> + help
> + Say Y to include support for BQ24261 Charger driver. This driver
> + makes use of power supply charging driver. So the driver gives
> + the charger hardware abstraction only. Charging logic is abstracted
> + in the power supply charging driver.
> +
> source "drivers/power/reset/Kconfig"
>
> endif # POWER_SUPPLY
> diff --git a/drivers/power/Makefile b/drivers/power/Makefile
> index 77535fd..a6e9897 100644
> --- a/drivers/power/Makefile
> +++ b/drivers/power/Makefile
> @@ -59,4 +59,5 @@ obj-$(CONFIG_CHARGER_BQ24735) += bq24735-charger.o
> obj-$(CONFIG_POWER_AVS) += avs/
> obj-$(CONFIG_CHARGER_SMB347) += smb347-charger.o
> obj-$(CONFIG_CHARGER_TPS65090) += tps65090-charger.o
> +obj-$(CONFIG_CHARGER_BQ24261) += bq24261_charger.o
> obj-$(CONFIG_POWER_RESET) += reset/
> diff --git a/drivers/power/bq24261_charger.c b/drivers/power/bq24261_charger.c
> new file mode 100644
> index 0000000..c21ea04
> --- /dev/null
> +++ b/drivers/power/bq24261_charger.c
> @@ -0,0 +1,1351 @@
> +/*
> + * bq24261-charger.c - BQ24261 Charger I2C client driver
> + *
> + * Copyright (C) 2011 Intel Corporation
> + *
> + * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
> + *
> + * 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; version 2 of the License.
> + *
> + * 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.
> + *
> + * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
> + * Author: Jenny TC <jenny.tc@...el.com>
> + */
> +
> +#include <linux/delay.h>
> +#include <linux/device.h>
> +#include <linux/err.h>
> +#include <linux/i2c.h>
> +#include <linux/init.h>
> +#include <linux/interrupt.h>
> +#include <linux/io.h>
> +#include <linux/kernel.h>
> +#include <linux/module.h>
> +#include <linux/pm_runtime.h>
> +#include <linux/power_supply.h>
> +#include <linux/power/power_supply_charger.h>
> +#include <linux/power/bq24261-charger.h>
> +#include <linux/sched.h>
> +#include <linux/seq_file.h>
> +#include <linux/slab.h>
> +#include <linux/usb/otg.h>
> +#include <linux/version.h>
> +
> +
> +#define DEV_NAME "bq24261_charger"
> +#define MODEL_NAME_SIZE 8
> +
> +#define EXCEPTION_MONITOR_DELAY (60 * HZ)
> +#define WDT_RESET_DELAY (15 * HZ)
> +
> +/* BQ24261 registers */
> +#define BQ24261_STAT_CTRL0_ADDR 0x00
> +#define BQ24261_CTRL_ADDR 0x01
> +#define BQ24261_BATT_VOL_CTRL_ADDR 0x02
> +#define BQ24261_VENDOR_REV_ADDR 0x03
> +#define BQ24261_TERM_FCC_ADDR 0x04
> +#define BQ24261_VINDPM_STAT_ADDR 0x05
> +#define BQ24261_ST_NTC_MON_ADDR 0x06
> +
> +#define BQ24261_RESET_MASK (0x01 << 7)
> +#define BQ24261_RESET_ENABLE (0x01 << 7)
> +
> +#define BQ24261_FAULT_MASK 0x07
> +#define BQ24261_STAT_MASK (0x03 << 4)
> +#define BQ24261_BOOST_MASK (0x01 << 6)
> +#define BQ24261_TMR_RST_MASK (0x01 << 7)
> +#define BQ24261_TMR_RST (0x01 << 7)
> +
> +#define BQ24261_ENABLE_BOOST (0x01 << 6)
> +
> +#define BQ24261_VOVP 0x01
> +#define BQ24261_LOW_SUPPLY 0x02
> +#define BQ24261_THERMAL_SHUTDOWN 0x03
> +#define BQ24261_BATT_TEMP_FAULT 0x04
> +#define BQ24261_TIMER_FAULT 0x05
> +#define BQ24261_BATT_OVP 0x06
> +#define BQ24261_NO_BATTERY 0x07
> +#define BQ24261_STAT_READY 0x00
> +
> +#define BQ24261_STAT_CHRG_PRGRSS (0x01 << 4)
> +#define BQ24261_STAT_CHRG_DONE (0x02 << 4)
> +#define BQ24261_STAT_FAULT (0x03 << 4)
> +
> +#define BQ24261_CE_MASK (0x01 << 1)
> +#define BQ24261_CE_DISABLE (0x01 << 1)
> +
> +#define BQ24261_HZ_MASK (0x01)
> +#define BQ24261_HZ_ENABLE (0x01)
> +
> +#define BQ24261_ICHRG_MASK (0x1F << 3)
> +#define BQ24261_MIN_CC 500 /* 500mA */
> +#define BQ24261_MAX_CC 3000 /* 3A */
> +
> +#define BQ24261_ITERM_MASK (0x03)
> +#define BQ24261_MIN_ITERM 50 /* 50 mA */
> +#define BQ24261_MAX_ITERM 300 /* 300mA */
> +
> +#define BQ24261_VBREG_MASK (0x3F << 2)
> +
> +#define BQ24261_INLMT_MASK (0x03 << 4)
> +#define BQ24261_INLMT_100 0x00
> +#define BQ24261_INLMT_150 (0x01 << 4)
> +#define BQ24261_INLMT_500 (0x02 << 4)
> +#define BQ24261_INLMT_900 (0x03 << 4)
> +#define BQ24261_INLMT_1500 (0x04 << 4)
> +#define BQ24261_INLMT_2500 (0x06 << 4)
> +
> +#define BQ24261_TE_MASK (0x01 << 2)
> +#define BQ24261_TE_ENABLE (0x01 << 2)
> +#define BQ24261_STAT_ENABLE_MASK (0x01 << 3)
> +#define BQ24261_STAT_ENABLE (0x01 << 3)
> +
> +#define BQ24261_VENDOR_MASK (0x07 << 5)
> +#define BQ24261_VENDOR (0x02 << 5)
> +#define BQ24261_REV_MASK (0x07)
> +#define BQ24261_REV (0x02)
> +#define BQ24261_PG2_3_REV (0x06)
> +#define BQ24260_REV (0x01)
> +
> +#define BQ24261_TS_MASK (0x01 << 3)
> +#define BQ24261_TS_ENABLED (0x01 << 3)
> +#define BQ24261_BOOST_ILIM_MASK (0x01 << 4)
> +#define BQ24261_BOOST_ILIM_500ma (0x0)
> +#define BQ24261_BOOST_ILIM_1A (0x01 << 4)
> +
> +#define BQ24261_SAFETY_TIMER_MASK (0x03 << 5)
> +#define BQ24261_SAFETY_TIMER_40MIN 0x00
> +#define BQ24261_SAFETY_TIMER_6HR (0x01 << 5)
> +#define BQ24261_SAFETY_TIMER_9HR (0x02 << 5)
> +#define BQ24261_SAFETY_TIMER_DISABLED (0x03 << 5)
> +
> +/* 1% above voltage max design to report over voltage */
> +#define BQ24261_OVP_MULTIPLIER 1010
> +#define BQ24261_OVP_RECOVER_MULTIPLIER 990
> +#define BQ24261_DEF_BAT_VOLT_MAX_DESIGN 4200000
> +
> +/* Settings for Voltage / DPPM Register (05) */
> +#define BQ24261_VBATT_LEVEL1 3700000
> +#define BQ24261_VBATT_LEVEL2 3960000
> +#define BQ24261_VINDPM_MASK (0x07)
> +#define BQ24261_VINDPM_320MV (0x01 << 2)
> +#define BQ24261_VINDPM_160MV (0x01 << 1)
> +#define BQ24261_VINDPM_80MV (0x01 << 0)
> +#define BQ24261_CD_STATUS_MASK (0x01 << 3)
> +#define BQ24261_DPM_EN_MASK (0x01 << 4)
> +#define BQ24261_DPM_EN_FORCE (0x01 << 4)
> +#define BQ24261_LOW_CHG_MASK (0x01 << 5)
> +#define BQ24261_LOW_CHG_EN (0x01 << 5)
> +#define BQ24261_LOW_CHG_DIS (~BQ24261_LOW_CHG_EN)
> +#define BQ24261_DPM_STAT_MASK (0x01 << 6)
> +#define BQ24261_MINSYS_STAT_MASK (0x01 << 7)
> +
> +#define BQ24261_MIN_CC 500
> +
> +static u16 bq24261_sfty_tmr[][2] = {
> + {0, BQ24261_SAFETY_TIMER_DISABLED}
> + ,
> + {40, BQ24261_SAFETY_TIMER_40MIN}
> + ,
> + {360, BQ24261_SAFETY_TIMER_6HR}
> + ,
> + {540, BQ24261_SAFETY_TIMER_9HR}
> + ,
> +};
> +
> +
> +static u16 bq24261_inlmt[][2] = {
> + {100, BQ24261_INLMT_100}
> + ,
> + {150, BQ24261_INLMT_150}
> + ,
> + {500, BQ24261_INLMT_500}
> + ,
> + {900, BQ24261_INLMT_900}
> + ,
> + {1500, BQ24261_INLMT_1500}
> + ,
> + {2500, BQ24261_INLMT_2500}
> + ,
> +};
> +
> +#define BQ24261_MIN_CV_mV 3500
> +#define BQ24261_MAX_CV_mV 4440
> +
> +static enum power_supply_property bq24261_usb_props[] = {
> + POWER_SUPPLY_PROP_PRESENT,
> + POWER_SUPPLY_PROP_ONLINE,
> + POWER_SUPPLY_PROP_TYPE,
> + POWER_SUPPLY_PROP_HEALTH,
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX,
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX,
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT,
> + POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE,
> + POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT,
> + POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT,
> + POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT,
> + POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT_MAX,
> + POWER_SUPPLY_PROP_MODEL_NAME,
> + POWER_SUPPLY_PROP_MANUFACTURER,
> + POWER_SUPPLY_PROP_TEMP_MAX,
> + POWER_SUPPLY_PROP_TEMP_MIN,
> +};
> +
> +enum bq24261_chrgr_stat {
> + BQ24261_CHRGR_STAT_UNKNOWN,
> + BQ24261_CHRGR_STAT_READY,
> + BQ24261_CHRGR_STAT_CHARGING,
> + BQ24261_CHRGR_STAT_BAT_FULL,
> + BQ24261_CHRGR_STAT_FAULT,
> +};
> +
> +struct bq24261_charger {
> +
> + struct mutex lock;
> + struct i2c_client *client;
> + struct bq24261_plat_data *pdata;
> + struct power_supply psy_usb;
> + struct power_supply_charger psyc_usb;
> + struct delayed_work notify_work;
> + struct delayed_work low_supply_fault_work;
> + struct delayed_work exception_mon_work;
> + struct list_head irq_queue;
> + wait_queue_head_t wait_ready;
> +
> + int chrgr_health;
> + int bat_health;
> + int cc;
> + int cv;
> + int inlmt;
> + int max_cc;
> + int max_cv;
> + int iterm;
> + int cable_type;
> + int cntl_state;
> + int max_temp;
> + int min_temp;
> + enum bq24261_chrgr_stat chrgr_stat;
> + bool online;
> + bool present;
> + bool is_charging_enabled;
> + bool is_charger_enabled;
> + bool is_vsys_on;
> + bool is_hw_chrg_term;
> + char model_name[MODEL_NAME_SIZE];
> +};
> +
> +enum bq2426x_model_num {
> + BQ24260 = 0,
> + BQ24261,
> +};
> +
> +struct bq2426x_model {
> + char model_name[MODEL_NAME_SIZE];
> + enum bq2426x_model_num model;
> +};
> +
> +static struct bq2426x_model bq24261_model_name[] = {
> + { "bq24260", BQ24260 },
> + { "bq24261", BQ24261 },
> +};
> +
> +struct i2c_client *bq24261_client;
> +static inline int get_battery_voltage(int *volt);
> +static int bq24261_handle_irq(struct bq24261_charger *chip, u8 stat_reg);
> +static inline int bq24261_set_iterm(struct bq24261_charger *chip, int iterm);
> +static inline int bq24261_enable_hw_charge_term(struct bq24261_charger *chip,
> + bool val);
> +
> +enum power_supply_type get_power_supply_type(
> + unsigned long cable)
> +{
> + switch (cable) {
> +
> + case PSY_CHARGER_CABLE_TYPE_USB_DCP:
> + return POWER_SUPPLY_TYPE_USB_DCP;
> + case PSY_CHARGER_CABLE_TYPE_USB_CDP:
> + return POWER_SUPPLY_TYPE_USB_CDP;
> + case PSY_CHARGER_CABLE_TYPE_USB_ACA:
> + case PSY_CHARGER_CABLE_TYPE_ACA_DOCK:
> + return POWER_SUPPLY_TYPE_USB_ACA;
> + case PSY_CHARGER_CABLE_TYPE_AC:
> + return POWER_SUPPLY_TYPE_MAINS;
> + case PSY_CHARGER_CABLE_TYPE_NONE:
> + case PSY_CHARGER_CABLE_TYPE_USB_SDP:
> + return POWER_SUPPLY_TYPE_USB;
> + default:
> + return POWER_SUPPLY_TYPE_UNKNOWN;
> + }
> +
> + return POWER_SUPPLY_TYPE_USB;
> +}
> +
> +static u8 lookup_regval(u16 tbl[][2], size_t size, u16 in_val)
> +{
> + int i;
> +
> + for (i = 1; i < size; ++i)
> + if (in_val < tbl[i][0])
> + break;
> +
> + return tbl[i - 1][1];
> +}
> +
> +static u8 bq24261_cc_to_reg(int cc)
> +{
> + cc = clamp_t(int, cc, BQ24261_MIN_CC, BQ24261_MAX_CC);
> + cc = cc - BQ24261_MIN_CC;
> + return (cc / 100) << 3;
> +}
> +
> +static u8 bq24261_cv_to_reg(int cv)
> +{
> + cv = clamp_t(int, cv, BQ24261_MIN_CV_mV, BQ24261_MAX_CV_mV);
> + cv = cv - BQ24261_MIN_CV_mV;
> + return (cv / 20) << 2;
> +}
> +
> +static u8 bq24261_inlmt_to_reg(int inlmt)
> +{
> + return lookup_regval(bq24261_inlmt, ARRAY_SIZE(bq24261_inlmt), inlmt);
> +}
> +
> +static u8 bq24261_iterm_to_reg(int iterm)
> +{
> + iterm = clamp_t(int, iterm, BQ24261_MIN_ITERM, BQ24261_MAX_ITERM);
> + iterm = iterm - BQ24261_MIN_ITERM;
> +
> + return iterm/50;
> +}
> +
> +static u8 bq24261_sfty_tmr_to_reg(int tmr)
> +{
> + return lookup_regval(bq24261_sfty_tmr,
> + ARRAY_SIZE(bq24261_sfty_tmr), tmr);
> +}
> +
> +static inline int bq24261_read_reg(struct i2c_client *client, u8 reg)
> +{
> + int ret;
> +
> + ret = i2c_smbus_read_byte_data(client, reg);
> + if (ret < 0)
> + dev_err(&client->dev, "Error(%d) in reading reg %d\n", ret,
> + reg);
> +
> + return ret;
> +}
> +
> +static inline int bq24261_write_reg(struct i2c_client *client, u8 reg, u8 data)
> +{
> + int ret;
> +
> + ret = i2c_smbus_write_byte_data(client, reg, data);
> + if (ret < 0)
> + dev_err(&client->dev, "Error(%d) in writing %d to reg %d\n",
> + ret, data, reg);
> +
> + return ret;
> +}
> +
> +static inline int bq24261_read_modify_reg(struct i2c_client *client, u8 reg,
> + u8 mask, u8 val)
> +{
> + int ret;
> +
> + ret = bq24261_read_reg(client, reg);
> + if (ret < 0)
> + return ret;
> + ret = (ret & ~mask) | (mask & val);
> + return bq24261_write_reg(client, reg, ret);
> +}
> +
> +static inline int bq24261_tmr_ntc_init(struct bq24261_charger *chip)
> +{
> + u8 reg_val;
> + int ret;
> +
> + reg_val = bq24261_sfty_tmr_to_reg(chip->pdata->safety_timer);
> +
> + if (chip->pdata->is_ts_enabled)
> + reg_val |= BQ24261_TS_ENABLED;
> +
> + ret = bq24261_read_modify_reg(chip->client, BQ24261_ST_NTC_MON_ADDR,
> + BQ24261_TS_MASK|BQ24261_SAFETY_TIMER_MASK|
> + BQ24261_BOOST_ILIM_MASK, reg_val);
> +
> + return ret;
> +}
> +
> +static inline int bq24261_enable_charging(
> + struct bq24261_charger *chip, bool val)
> +{
> + int ret;
> + u8 reg_val;
> + bool is_ready;
> +
> + ret = bq24261_read_reg(chip->client,
> + BQ24261_STAT_CTRL0_ADDR);
> + if (ret < 0) {
> + dev_err(&chip->client->dev,
> + "Error(%d) in reading BQ24261_STAT_CTRL0_ADDR\n", ret);
> + }
> +
> + is_ready = (ret & BQ24261_STAT_MASK) != BQ24261_STAT_FAULT;
> +
> + /* If status is fault, wait for READY before enabling the charging */
> +
> + if (!is_ready && val) {
> + ret = wait_event_timeout(chip->wait_ready,
> + (chip->chrgr_stat == BQ24261_CHRGR_STAT_READY),
> + HZ);
> + dev_info(&chip->client->dev,
> + "chrgr_stat=%x\n", chip->chrgr_stat);
> + if (ret == 0) {
> + dev_err(&chip->client->dev,
> + "Waiting for Charger Ready Failed. Enabling charging anyway\n");
> + }
> + }
> +
> + if (val) {
> + reg_val = (~BQ24261_CE_DISABLE & BQ24261_CE_MASK);
> + if (chip->is_hw_chrg_term)
> + reg_val |= BQ24261_TE_ENABLE;
> + } else {
> + reg_val = BQ24261_CE_DISABLE;
> + }
> +
> + reg_val |= BQ24261_STAT_ENABLE;
> +
> + ret = bq24261_read_modify_reg(chip->client, BQ24261_CTRL_ADDR,
> + BQ24261_STAT_ENABLE_MASK|BQ24261_RESET_MASK|
> + BQ24261_CE_MASK|BQ24261_TE_MASK,
> + reg_val);
> + if (ret || !val) {
> + cancel_delayed_work_sync(&chip->notify_work);
> + return ret;
> + }
> +
> + bq24261_set_iterm(chip, chip->iterm);
> + schedule_delayed_work(&chip->notify_work, 0);
> + bq24261_enable_hw_charge_term(chip, true);
> + return bq24261_tmr_ntc_init(chip);
> +}
> +
> +static inline int bq24261_reset_timer(struct bq24261_charger *chip)
> +{
> + return bq24261_read_modify_reg(chip->client, BQ24261_STAT_CTRL0_ADDR,
> + BQ24261_TMR_RST_MASK, BQ24261_TMR_RST);
> +}
> +
> +static inline int bq24261_enable_charger(
> + struct bq24261_charger *chip, int val)
> +{
> +
> + u8 reg_val;
> + int ret;
> +
> + reg_val = val ? (~BQ24261_HZ_ENABLE & BQ24261_HZ_MASK) :
> + BQ24261_HZ_ENABLE;
> +
> + ret = bq24261_read_modify_reg(chip->client, BQ24261_CTRL_ADDR,
> + BQ24261_HZ_MASK|BQ24261_RESET_MASK, reg_val);
> + if (ret)
> + return ret;
> +
> + return bq24261_reset_timer(chip);
> +}
> +
> +static inline int bq24261_set_cc(struct bq24261_charger *chip, int cc)
> +{
> + u8 reg_val;
> + int ret;
> +
> + dev_dbg(&chip->client->dev, "cc=%d\n", cc);
> +
> + if (cc && (cc < BQ24261_MIN_CC)) {
> + dev_dbg(&chip->client->dev, "Set LOW_CHG bit\n");
> + reg_val = BQ24261_LOW_CHG_EN;
> + ret = bq24261_read_modify_reg(chip->client,
> + BQ24261_VINDPM_STAT_ADDR,
> + BQ24261_LOW_CHG_MASK, reg_val);
> + } else {
> + dev_dbg(&chip->client->dev, "Clear LOW_CHG bit\n");
> + reg_val = BQ24261_LOW_CHG_DIS;
> + ret = bq24261_read_modify_reg(chip->client,
> + BQ24261_VINDPM_STAT_ADDR,
> + BQ24261_LOW_CHG_MASK, reg_val);
> + }
> +
> + reg_val = bq24261_cc_to_reg(cc);
> +
> + return bq24261_read_modify_reg(chip->client, BQ24261_TERM_FCC_ADDR,
> + BQ24261_ICHRG_MASK, reg_val);
> +}
> +
> +static inline int bq24261_set_cv(struct bq24261_charger *chip, int cv)
> +{
> + int bat_volt;
> + int ret;
> + u8 reg_val;
> + u8 vindpm_val = 0x0;
> +
> + /*
> + * Setting VINDPM value as per the battery voltage
> + * VBatt Vindpm Register Setting
> + * < 3.7v 4.2v 0x0 (default)
> + * 3.71v - 3.96v 4.36v 0x2
> + * > 3.96v 4.6v 0x5
> + */
> + ret = get_battery_voltage(&bat_volt);
> + if (ret) {
> + dev_err(&chip->client->dev,
> + "Error getting battery voltage!!\n");
> + } else {
> + if (bat_volt > BQ24261_VBATT_LEVEL2)
> + vindpm_val =
> + (BQ24261_VINDPM_320MV | BQ24261_VINDPM_80MV);
> + else if (bat_volt > BQ24261_VBATT_LEVEL1)
> + vindpm_val = BQ24261_VINDPM_160MV;
> + }
> +
> + ret = bq24261_read_modify_reg(chip->client,
> + BQ24261_VINDPM_STAT_ADDR,
> + BQ24261_VINDPM_MASK,
> + vindpm_val);
> + if (ret) {
> + dev_err(&chip->client->dev,
> + "Error setting VINDPM setting!!\n");
> + return ret;
> + }
> +
> +
> + reg_val = bq24261_cv_to_reg(cv);
> +
> + return bq24261_read_modify_reg(chip->client, BQ24261_BATT_VOL_CTRL_ADDR,
> + BQ24261_VBREG_MASK, reg_val);
> +}
> +
> +static inline int bq24261_set_inlmt(struct bq24261_charger *chip, int inlmt)
> +{
> + u8 reg_val;
> +
> + reg_val = bq24261_inlmt_to_reg(inlmt);
> +
> + return bq24261_read_modify_reg(chip->client, BQ24261_CTRL_ADDR,
> + BQ24261_RESET_MASK|BQ24261_INLMT_MASK, reg_val);
> +
> +}
> +
> +static inline void resume_charging(struct bq24261_charger *chip)
> +{
> + int ret = 0;
> +
> + if (chip->is_charger_enabled)
> + ret = bq24261_enable_charger(chip, true);
> + if (!ret && chip->inlmt)
> + ret = bq24261_set_inlmt(chip, chip->inlmt);
> + if (!ret && chip->cc)
> + ret = bq24261_set_cc(chip, chip->cc);
> + if (!ret && chip->cv)
> + ret = bq24261_set_cv(chip, chip->cv);
> + if (!ret && chip->is_charging_enabled)
> + ret = bq24261_enable_charging(chip, true);
> +
> + if (ret)
> + dev_err(&bq24261_client->dev,
> + "Error(%d) in resume charging\n", ret);
> +}
> +
> +static inline int bq24261_set_iterm(struct bq24261_charger *chip, int iterm)
> +{
> + u8 reg_val;
> +
> + reg_val = bq24261_iterm_to_reg(iterm);
> +
> + return bq24261_read_modify_reg(chip->client, BQ24261_TERM_FCC_ADDR,
> + BQ24261_ITERM_MASK, reg_val);
> +}
> +
> +static inline int bq24261_enable_hw_charge_term(
> + struct bq24261_charger *chip, bool val)
> +{
> + u8 data;
> + int ret;
> +
> + data = val ? BQ24261_TE_ENABLE : (~BQ24261_TE_ENABLE & BQ24261_TE_MASK);
> +
> + ret = bq24261_read_modify_reg(chip->client, BQ24261_CTRL_ADDR,
> + BQ24261_RESET_MASK|BQ24261_TE_MASK, data);
> +
> + if (ret)
> + return ret;
> +
> + chip->is_hw_chrg_term = val ? true : false;
> +
> + return ret;
> +}
> +
> +static inline bool bq24261_is_vsys_on(struct bq24261_charger *chip)
> +{
> + int ret;
> + struct i2c_client *client = chip->client;
> +
> + ret = bq24261_read_reg(client, BQ24261_CTRL_ADDR);
> + if (ret < 0) {
> + dev_err(&client->dev,
> + "Error(%d) in reading BQ24261_CTRL_ADDR\n", ret);
> + return false;
> + }
> +
> + if (((ret & BQ24261_HZ_MASK) == BQ24261_HZ_ENABLE) &&
> + chip->is_charger_enabled) {
> + dev_err(&client->dev, "Charger in Hi Z Mode\n");
> + return false;
> + }
> +
> + ret = bq24261_read_reg(client, BQ24261_VINDPM_STAT_ADDR);
> + if (ret < 0) {
> + dev_err(&client->dev,
> + "Error(%d) in reading BQ24261_VINDPM_STAT_ADDR\n", ret);
> + return false;
> + }
> +
> + if (ret & BQ24261_CD_STATUS_MASK) {
> + dev_err(&client->dev, "CD line asserted\n");
> + return false;
> + }
> +
> + return true;
> +}
> +
> +static inline bool is_bq24261_enabled(struct bq24261_charger *chip)
> +{
> + if (chip->cable_type == PSY_CHARGER_CABLE_TYPE_NONE)
> + return false;
> + else if (!chip->is_charger_enabled)
> + return false;
> + /*
> + * BQ24261 gives interrupt only on stop/resume charging.
> + * If charging is already stopped, we need to query the hardware
> + * to see charger is still active and can supply vsys or not.
> + */
> + if ((chip->chrgr_stat == BQ24261_CHRGR_STAT_FAULT) ||
> + (!chip->is_charging_enabled))
> + return bq24261_is_vsys_on(chip);
> +
> + return chip->is_vsys_on;
> +}
> +
> +static int bq24261_usb_psyc_set_property(struct power_supply_charger *psyc,
> + enum power_supply_charger_property pscp,
> + const union power_supply_propval *val)
> +{
> + struct bq24261_charger *chip;
> + int ret = 0;
> +
> + chip = container_of(psyc, struct bq24261_charger, psyc_usb);
> +
> + mutex_lock(&chip->lock);
> + dev_dbg(&chip->client->dev, "%s: prop=%d, val=%d\n",
> + __func__, pscp, val->intval);
> +
> + switch (pscp) {
> +
> + case POWER_SUPPLY_CHARGER_PROP_ENABLE_CHARGING:
> + ret = bq24261_enable_charging(chip, val->intval);
> +
> + if (ret)
> + dev_err(&chip->client->dev,
> + "Error(%d) in %s charging", ret,
> + (val->intval ? "enable" : "disable"));
> + else
> + chip->is_charging_enabled = val->intval;
> +
> + break;
> + case POWER_SUPPLY_CHARGER_PROP_ENABLE_CHARGER:
> + /* Don't enable the charger unless over voltage is recovered */
> +
> + if (chip->bat_health != POWER_SUPPLY_HEALTH_OVERVOLTAGE) {
> + ret = bq24261_enable_charger(chip, val->intval);
> +
> + if (ret)
> + dev_err(&chip->client->dev,
> + "Error(%d) in %s charger", ret,
> + (val->intval ? "enable" : "disable"));
> + else
> + chip->is_charger_enabled = val->intval;
> + } else {
> + dev_info(&chip->client->dev, "Battery Over Voltage. Charger will be disabled\n");
> + }
> + break;
> + case POWER_SUPPLY_CHARGER_PROP_CABLE_TYPE:
> + chip->cable_type = val->intval;
> + chip->psy_usb.type = get_power_supply_type(chip->cable_type);
> + if (chip->cable_type != PSY_CHARGER_CABLE_TYPE_NONE) {
> + chip->chrgr_health = POWER_SUPPLY_HEALTH_GOOD;
> + chip->chrgr_stat = BQ24261_CHRGR_STAT_UNKNOWN;
> +
> + /*
> + * Adding this processing in order to check
> + * for any faults during connect
> + */
> +
> + ret = bq24261_read_reg(chip->client,
> + BQ24261_STAT_CTRL0_ADDR);
> + if (ret < 0)
> + dev_err(&chip->client->dev, "Error (%d) in reading status register(0x00)\n",
> + ret);
> + else
> + bq24261_handle_irq(chip, ret);
> + } else {
> + chip->chrgr_stat = BQ24261_CHRGR_STAT_UNKNOWN;
> + chip->chrgr_health = POWER_SUPPLY_HEALTH_UNKNOWN;
> + cancel_delayed_work_sync(&chip->low_supply_fault_work);
> + }
> + break;
> + case POWER_SUPPLY_CHARGER_PROP_RESET_WDT:
> + bq24261_reset_timer(chip);
> + break;
> + default:
> + ret = -ENODATA;
> + }
> +
> + mutex_unlock(&chip->lock);
> + return ret;
> +}
> +
> +static int bq24261_usb_set_property(struct power_supply *psy,
> + enum power_supply_property psp,
> + const union power_supply_propval *val)
> +{
> + struct bq24261_charger *chip;
> + int ret = 0;
> +
> + chip = container_of(psy, struct bq24261_charger, psy_usb);
> +
> + mutex_lock(&chip->lock);
> +
> + switch (psp) {
> +
> + case POWER_SUPPLY_PROP_PRESENT:
> + chip->present = val->intval;
> + break;
> + case POWER_SUPPLY_PROP_ONLINE:
> + chip->online = val->intval;
> + break;
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
> + ret = bq24261_set_cc(chip, val->intval);
> + if (!ret)
> + chip->cc = val->intval;
> + break;
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
> + ret = bq24261_set_cv(chip, val->intval);
> + if (!ret)
> + chip->cv = val->intval;
> + break;
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX:
> + chip->max_cc = val->intval;
> + break;
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX:
> + chip->max_cv = val->intval;
> + break;
> + case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
> + ret = bq24261_set_iterm(chip, val->intval);
> + if (!ret)
> + chip->iterm = val->intval;
> + break;
> + case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
> + ret = bq24261_set_inlmt(chip, val->intval);
> + if (!ret)
> + chip->inlmt = val->intval;
> + break;
> + case POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT:
> + chip->cntl_state = val->intval;
> + break;
> + case POWER_SUPPLY_PROP_TEMP_MAX:
> + chip->max_temp = val->intval;
> + break;
> + case POWER_SUPPLY_PROP_TEMP_MIN:
> + chip->min_temp = val->intval;
> + break;
> + default:
> + ret = -ENODATA;
> + }
> +
> + mutex_unlock(&chip->lock);
> + return ret;
> +}
> +
> +static int bq24261_usb_psyc_get_property(struct power_supply_charger *psyc,
> + enum power_supply_charger_property pscp,
> + union power_supply_propval *val)
> +{
> + struct bq24261_charger *chip;
> +
> + chip = container_of(psyc, struct bq24261_charger, psyc_usb);
> +
> + mutex_lock(&chip->lock);
> +
> + switch (pscp) {
> + case POWER_SUPPLY_CHARGER_PROP_CABLE_TYPE:
> + val->intval = chip->cable_type;
> + break;
> + case POWER_SUPPLY_CHARGER_PROP_ENABLE_CHARGING:
> + val->intval = (chip->is_charging_enabled &&
> + (chip->chrgr_stat == BQ24261_CHRGR_STAT_CHARGING));
> +
> + break;
> + case POWER_SUPPLY_CHARGER_PROP_ENABLE_CHARGER:
> + val->intval = is_bq24261_enabled(chip);
> + break;
> + default:
> + mutex_unlock(&chip->lock);
> + return -EINVAL;
> + }
> +
> + mutex_unlock(&chip->lock);
> + return 0;
> +}
> +
> +static int bq24261_usb_get_property(struct power_supply *psy,
> + enum power_supply_property psp,
> + union power_supply_propval *val)
> +{
> + struct bq24261_charger *chip;
> +
> + chip = container_of(psy, struct bq24261_charger, psy_usb);
> +
> + mutex_lock(&chip->lock);
> +
> + switch (psp) {
> + case POWER_SUPPLY_PROP_PRESENT:
> + val->intval = chip->present;
> + break;
> + case POWER_SUPPLY_PROP_ONLINE:
> + val->intval = chip->online;
> + break;
> + case POWER_SUPPLY_PROP_HEALTH:
> + val->intval = chip->chrgr_health;
> + break;
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT_MAX:
> + val->intval = chip->max_cc;
> + break;
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE_MAX:
> + val->intval = chip->max_cv;
> + break;
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_CURRENT:
> + val->intval = chip->cc;
> + break;
> + case POWER_SUPPLY_PROP_CONSTANT_CHARGE_VOLTAGE:
> + val->intval = chip->cv;
> + break;
> + case POWER_SUPPLY_PROP_INPUT_CURRENT_LIMIT:
> + val->intval = chip->inlmt;
> + break;
> + case POWER_SUPPLY_PROP_CHARGE_TERM_CURRENT:
> + val->intval = chip->iterm;
> + break;
> + case POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT:
> + val->intval = chip->cntl_state;
> + break;
> + case POWER_SUPPLY_PROP_CHARGE_CONTROL_LIMIT_MAX:
> + val->intval = chip->pdata->num_throttle_states;
> + break;
> + case POWER_SUPPLY_PROP_MODEL_NAME:
> + val->strval = chip->model_name;
> + break;
> + case POWER_SUPPLY_PROP_MANUFACTURER:
> + val->strval = "TI";
> + break;
> + case POWER_SUPPLY_PROP_TEMP_MAX:
> + val->intval = chip->max_temp;
> + break;
> + case POWER_SUPPLY_PROP_TEMP_MIN:
> + val->intval = chip->min_temp;
> + break;
> + default:
> + mutex_unlock(&chip->lock);
> + return -EINVAL;
> + }
> +
> + mutex_unlock(&chip->lock);
> + return 0;
> +}
> +
> +static inline struct power_supply *get_psy_battery(void)
> +{
> + static struct power_supply *psy;
> + struct bq24261_charger *chip;
> + int i;
> +
> + if (!bq24261_client)
> + return NULL;
> +
> + chip = i2c_get_clientdata(bq24261_client);
> +
> + for (i = 0; i < chip->psy_usb.num_supplicants; ++i) {
> + psy = power_supply_get_by_name(chip->psy_usb.supplied_to[i]);
> + if (psy)
> + return psy;
> + }
> +
> + return NULL;
> +}
> +
> +static inline int get_battery_voltage(int *volt)
> +{
> + struct power_supply *psy;
> + union power_supply_propval val;
> + int ret;
> +
> + psy = get_psy_battery();
> + if (!psy)
> + return -EINVAL;
> +
> + ret = psy->get_property(psy, POWER_SUPPLY_PROP_VOLTAGE_NOW, &val);
> + if (!ret)
> + *volt = val.intval;
> +
> + return ret;
> +}
> +
> +static inline int get_battery_property
> + (enum power_supply_property prop, int *prop_val)
> +{
> + struct power_supply *psy;
> +
> + psy = get_psy_battery();
> + if (!psy)
> + return -EINVAL;
> +
> + *prop_val = psy_get_ps_int_property(psy, prop);
> +
> + return 0;
> +}
> +
> +static inline int get_battery_volt_max_design(int *volt)
> +{
> + return get_battery_property(POWER_SUPPLY_PROP_VOLTAGE_MAX_DESIGN, volt);
> +
> +}
> +
> +static void notify_worker(struct work_struct *work)
> +{
> +
> + struct bq24261_charger *chip = container_of(work,
> + struct bq24261_charger,
> + notify_work.work);
> +
> + atomic_notifier_call_chain(&power_supply_notifier,
> + PSY_EVENT_PROP_CHANGED, &chip->psy_usb);
> + schedule_delayed_work(&chip->notify_work, WDT_RESET_DELAY);
> +}
> +
> +int bq24261_get_bat_health(void)
> +{
> +
> + struct bq24261_charger *chip;
> +
> + if (!bq24261_client)
> + return -ENODEV;
> +
> + chip = i2c_get_clientdata(bq24261_client);
> +
> + return chip->bat_health;
> +}
> +
> +
> +static void bq24261_low_supply_fault_work(struct work_struct *work)
> +{
> + struct bq24261_charger *chip = container_of(work,
> + struct bq24261_charger,
> + low_supply_fault_work.work);
> +
> + if (chip->chrgr_stat == BQ24261_CHRGR_STAT_FAULT) {
> + dev_err(&chip->client->dev, "Low Supply Fault detected!!\n");
> + chip->chrgr_health = POWER_SUPPLY_HEALTH_DEAD;
> + power_supply_changed(&chip->psy_usb);
> + }
> + return;
> +}
> +
> +
> +/* is_bat_over_voltage: check battery is over voltage or not
> +* @chip: bq24261_charger context
> +*
> +* This function is used to verify the over voltage condition.
> +* In some scenarios, HW generates Over Voltage exceptions when
> +* battery voltage is normal. This function uses the over voltage
> +* condition (voltage_max_design * 1.01) to verify battery is really
> +* over charged or not.
> +*/
> +
> +static bool is_bat_over_voltage(struct bq24261_charger *chip)
> +{
> + int bat_volt, bat_volt_max_des, ret;
> +
> + ret = get_battery_voltage(&bat_volt);
> + if (ret)
> + return true;
> +
> + ret = get_battery_volt_max_design(&bat_volt_max_des);
> +
> + if (ret)
> + bat_volt_max_des = BQ24261_DEF_BAT_VOLT_MAX_DESIGN;
> +
> + dev_info(&chip->client->dev, "bat_volt=%d Voltage Max Design=%d OVP_VOLT=%d\n",
> + bat_volt, bat_volt_max_des,
> + (bat_volt_max_des/1000 * BQ24261_OVP_MULTIPLIER));
> +
> + if ((bat_volt) >= (bat_volt_max_des / 1000 *
> + BQ24261_OVP_MULTIPLIER))
> + return true;
> +
> + return false;
> +}
> +
> +#define IS_BATTERY_OVER_VOLTAGE_RECOVERED(chip) \
> + (!is_bat_over_voltage(chip))
> +
> +static void handle_battery_over_voltage(struct bq24261_charger *chip)
> +{
> + /*
> + * Set Health to Over Voltage. Disable charger to discharge
> + * battery to reduce the battery voltage.
> + */
> + chip->bat_health = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
> + bq24261_enable_charger(chip, false);
> + chip->is_charger_enabled = false;
> + cancel_delayed_work_sync(&chip->exception_mon_work);
> + schedule_delayed_work(&chip->exception_mon_work,
> + EXCEPTION_MONITOR_DELAY);
> +}
> +
> +static void bq24261_exception_mon_work(struct work_struct *work)
> +{
> + struct bq24261_charger *chip = container_of(work,
> + struct bq24261_charger,
> + exception_mon_work.work);
> + /* Only over voltage exception need to monitor.*/
> + if (IS_BATTERY_OVER_VOLTAGE_RECOVERED(chip)) {
> + dev_info(&chip->client->dev, "Over Voltage Exception Recovered\n");
> + chip->bat_health = POWER_SUPPLY_HEALTH_GOOD;
> + bq24261_enable_charger(chip, true);
> + chip->is_charger_enabled = true;
> + resume_charging(chip);
> + } else {
> + schedule_delayed_work(&chip->exception_mon_work,
> + EXCEPTION_MONITOR_DELAY);
> + }
> +}
> +
> +static int bq24261_handle_irq(struct bq24261_charger *chip, u8 stat_reg)
> +{
> + struct i2c_client *client = chip->client;
> + bool notify = true;
> +
> + dev_info(&client->dev, "%s:%d stat=0x%x\n",
> + __func__, __LINE__, stat_reg);
> +
> + switch (stat_reg & BQ24261_STAT_MASK) {
> + case BQ24261_STAT_READY:
> + chip->chrgr_stat = BQ24261_CHRGR_STAT_READY;
> + chip->chrgr_health = POWER_SUPPLY_HEALTH_GOOD;
> + chip->bat_health = POWER_SUPPLY_HEALTH_GOOD;
> + dev_info(&client->dev, "Charger Status: Ready\n");
> + notify = false;
> + break;
> + case BQ24261_STAT_CHRG_PRGRSS:
> + chip->chrgr_stat = BQ24261_CHRGR_STAT_CHARGING;
> + chip->chrgr_health = POWER_SUPPLY_HEALTH_GOOD;
> + chip->bat_health = POWER_SUPPLY_HEALTH_GOOD;
> + dev_info(&client->dev, "Charger Status: Charge Progress\n");
> + break;
> + case BQ24261_STAT_CHRG_DONE:
> + chip->chrgr_health = POWER_SUPPLY_HEALTH_GOOD;
> + chip->bat_health = POWER_SUPPLY_HEALTH_GOOD;
> + dev_info(&client->dev, "Charger Status: Charge Done\n");
> +
> + /*
> + * HW reports charge termination. Stop h/w charge termination
> + * and resume charging. Let power supply charging driver decide
> + * on charge termination
> + */
> +
> + bq24261_enable_hw_charge_term(chip, false);
> + resume_charging(chip);
> + break;
> +
> + case BQ24261_STAT_FAULT:
> + break;
> + }
> +
> + if (stat_reg & BQ24261_BOOST_MASK)
> + dev_info(&client->dev, "Boost Mode\n");
> +
> + if ((stat_reg & BQ24261_STAT_MASK) == BQ24261_STAT_FAULT) {
> + chip->chrgr_stat = BQ24261_CHRGR_STAT_FAULT;
> +
> + switch (stat_reg & BQ24261_FAULT_MASK) {
> + case BQ24261_VOVP:
> + chip->chrgr_health = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
> + dev_err(&client->dev, "Charger OVP Fault\n");
> + break;
> +
> + case BQ24261_LOW_SUPPLY:
> + notify = false;
> +
> + if (chip->cable_type !=
> + PSY_CHARGER_CABLE_TYPE_NONE) {
> + schedule_delayed_work
> + (&chip->low_supply_fault_work,
> + 5*HZ);
> + dev_dbg(&client->dev,
> + "Schedule Low Supply Fault work!!\n");
> + }
> + break;
> +
> + case BQ24261_THERMAL_SHUTDOWN:
> + chip->chrgr_health = POWER_SUPPLY_HEALTH_OVERHEAT;
> + dev_err(&client->dev, "Charger Thermal Fault\n");
> + break;
> +
> + case BQ24261_BATT_TEMP_FAULT:
> + chip->bat_health = POWER_SUPPLY_HEALTH_OVERHEAT;
> + dev_err(&client->dev, "Battery Temperature Fault\n");
> + break;
> +
> + case BQ24261_TIMER_FAULT:
> + chip->bat_health = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
> + chip->chrgr_health = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
> + dev_err(&client->dev, "Charger Timer Fault\n");
> + break;
> +
> + case BQ24261_BATT_OVP:
> + notify = false;
> + if (chip->bat_health !=
> + POWER_SUPPLY_HEALTH_OVERVOLTAGE) {
> + if (!is_bat_over_voltage(chip)) {
> + chip->chrgr_stat =
> + BQ24261_CHRGR_STAT_UNKNOWN;
> + resume_charging(chip);
> + } else {
> + dev_err(&client->dev, "Battery Over Voltage Fault\n");
> + handle_battery_over_voltage(chip);
> + notify = true;
> + }
> + }
> + break;
> + case BQ24261_NO_BATTERY:
> + dev_err(&client->dev, "No Battery Connected\n");
> + break;
> +
> + }
> +
> + }
> +
> + wake_up(&chip->wait_ready);
> +
> + chip->is_vsys_on = bq24261_is_vsys_on(chip);
> + if (notify)
> + power_supply_changed(&chip->psy_usb);
> +
> + return 0;
> +}
> +
> +static irqreturn_t bq24261_thread_handler(int id, void *data)
> +{
> + struct bq24261_charger *chip = (struct bq24261_charger *)data;
> + int ret;
> +
> + mutex_lock(&chip->lock);
> +
> + ret = bq24261_read_reg(chip->client, BQ24261_STAT_CTRL0_ADDR);
> + if (ret < 0)
> + dev_err(&chip->client->dev,
> + "Error (%d) in reading BQ24261_STAT_CTRL0_ADDR\n", ret);
> + else
> + bq24261_handle_irq(chip, ret);
> +
> + mutex_unlock(&chip->lock);
> +
> + return IRQ_HANDLED;
> +}
> +
> +static enum bq2426x_model_num bq24261_get_model(int bq24261_rev_reg)
> +{
> + switch (bq24261_rev_reg & BQ24261_REV_MASK) {
> + case BQ24260_REV:
> + return BQ24260;
> + case BQ24261_REV:
> + case BQ24261_PG2_3_REV:
> + return BQ24261;
> + default:
> + return -EINVAL;
> + }
> +}
> +
> +static int bq24261_probe(struct i2c_client *client,
> + const struct i2c_device_id *id)
> +{
> + struct i2c_adapter *adapter;
> + struct bq24261_charger *chip;
> + int ret;
> + enum bq2426x_model_num bq24261_rev;
> +
> + adapter = to_i2c_adapter(client->dev.parent);
> +
> + if (!client->dev.platform_data) {
> + dev_err(&client->dev, "platform data is null");
> + return -EFAULT;
> + }
> +
> + if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA)) {
> + dev_err(&client->dev,
> + "I2C adapter %s doesn't support BYTE DATA transfer\n",
> + adapter->name);
> + return -EIO;
> + }
> +
> + ret = bq24261_read_reg(client, BQ24261_VENDOR_REV_ADDR);
> + if (ret < 0) {
> + dev_err(&client->dev,
> + "Error (%d) in reading BQ24261_VENDOR_REV_ADDR\n", ret);
> + return ret;
> + }
> +
> + bq24261_rev = bq24261_get_model(ret);
> + if (((ret & BQ24261_VENDOR_MASK) != BQ24261_VENDOR) ||
> + (bq24261_rev < 0)) {
> + dev_err(&client->dev,
> + "Invalid Vendor/Revision number in BQ24261_VENDOR_REV_ADDR: %d",
> + ret);
> + return -ENODEV;
> + }
> +
> + chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL);
> + if (!chip) {
> + dev_err(&client->dev, "mem alloc failed\n");
> + return -ENOMEM;
> + }
> +
> + init_waitqueue_head(&chip->wait_ready);
> + i2c_set_clientdata(client, chip);
> + chip->pdata = client->dev.platform_data;
> +
> +
> + chip->client = client;
> + chip->pdata = client->dev.platform_data;
why do you set platform_data two times?
> + chip->psy_usb.name = DEV_NAME;
> + chip->psy_usb.type = POWER_SUPPLY_TYPE_USB;
> + chip->psy_usb.properties = bq24261_usb_props;
> + chip->psy_usb.num_properties = ARRAY_SIZE(bq24261_usb_props);
> + chip->psy_usb.get_property = bq24261_usb_get_property;
> + chip->psy_usb.set_property = bq24261_usb_set_property;
> + chip->psy_usb.supplied_to = chip->pdata->supplied_to;
> + chip->psy_usb.num_supplicants = chip->pdata->num_supplicants;
> + /* Limit charge current */
> + chip->max_cc = 1500;
> + chip->chrgr_stat = BQ24261_CHRGR_STAT_UNKNOWN;
> + chip->chrgr_health = POWER_SUPPLY_HEALTH_UNKNOWN;
> +
> + chip->psyc_usb.get_property = bq24261_usb_psyc_get_property;
> + chip->psyc_usb.set_property = bq24261_usb_psyc_set_property;
> + chip->psyc_usb.throttle_states = chip->pdata->throttle_states;
> + chip->psyc_usb.num_throttle_states = chip->pdata->num_throttle_states;
> + chip->psyc_usb.supported_cables = PSY_CHARGER_CABLE_TYPE_USB;
> +
> + strncpy(chip->model_name,
> + bq24261_model_name[bq24261_rev].model_name,
> + MODEL_NAME_SIZE);
> +
> + mutex_init(&chip->lock);
> + ret = power_supply_register(&client->dev, &chip->psy_usb);
> + if (ret) {
> + dev_err(&client->dev, "Failed: power supply register (%d)\n",
> + ret);
> + return ret;
> + }
> +
> + ret = power_supply_register_charger(&chip->psy_usb, &chip->psyc_usb);
> + if (ret) {
> + dev_err(&client->dev, "Failed: power supply register (%d)\n",
> + ret);
> + power_supply_unregister(&chip->psy_usb);
> + return ret;
> + }
> +
> + INIT_DELAYED_WORK(&chip->notify_work, notify_worker);
> + INIT_DELAYED_WORK(&chip->low_supply_fault_work,
> + bq24261_low_supply_fault_work);
> + INIT_DELAYED_WORK(&chip->exception_mon_work,
> + bq24261_exception_mon_work);
> + bq24261_client = client;
> +
> + if (chip->client->irq) {
> + ret = request_threaded_irq(chip->client->irq,
> + NULL,
> + bq24261_thread_handler,
> + IRQF_SHARED|IRQF_NO_SUSPEND,
> + DEV_NAME, chip);
> + if (ret) {
> + dev_err(&client->dev, "Failed: request_irq (%d)\n",
> + ret);
> + power_supply_unregister(&chip->psy_usb);
> + power_supply_unregister_charger(&chip->psyc_usb);
> + bq24261_client = NULL;
> + return ret;
> + }
> + }
> +
> + if (is_bat_over_voltage(chip))
> + handle_battery_over_voltage(chip);
> + else
> + chip->bat_health = POWER_SUPPLY_HEALTH_GOOD;
> +
> +
> + return 0;
> +}
> +
> +static int bq24261_remove(struct i2c_client *client)
> +{
> + struct bq24261_charger *chip = i2c_get_clientdata(client);
> +
> + if (client->irq)
> + free_irq(client->irq, chip);
> +
> + flush_scheduled_work();
> +
> + power_supply_unregister(&chip->psy_usb);
> + return 0;
> +}
> +
> +static const struct i2c_device_id bq24261_id[] = {
> + {DEV_NAME, 0},
> + {},
> +};
> +
> +MODULE_DEVICE_TABLE(i2c, bq24261_id);
> +
> +static struct i2c_driver bq24261_driver = {
> + .driver = {
> + .name = DEV_NAME,
> + },
> + .probe = bq24261_probe,
> + .remove = bq24261_remove,
> + .id_table = bq24261_id,
> +};
> +
> +module_i2c_driver(bq24261_driver);
> +
> +MODULE_AUTHOR("Jenny TC <jenny.tc@...el.com>");
> +MODULE_DESCRIPTION("BQ24261 Charger Driver");
> +MODULE_LICENSE("GPL");
> diff --git a/include/linux/power/bq24261-charger.h b/include/linux/power/bq24261-charger.h
> new file mode 100644
> index 0000000..4ff02af
> --- /dev/null
> +++ b/include/linux/power/bq24261-charger.h
> @@ -0,0 +1,25 @@
> +/*
> + * bq24261_charger.h: platform data structure for bq24261 driver
> + *
> + * (C) Copyright 2012 Intel Corporation
> + *
> + * 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; version 2
> + * of the License.
> + */
> +
> +#ifndef __BQ24261_CHARGER_H__
> +#define __BQ24261_CHARGER_H__
> +
> +struct bq24261_plat_data {
> + char **supplied_to;
> + size_t num_supplicants;
> + struct psy_throttle_state *throttle_states;
> + size_t num_throttle_states;
> + int safety_timer;
> + bool is_ts_enabled;
> +
> +};
> +
> +#endif
> --
> 1.7.9.5
>
Download attachment "signature.asc" of type "application/pgp-signature" (820 bytes)
Powered by blists - more mailing lists