| /* |
| * bq2415x charger driver |
| * |
| * Copyright (C) 2011-2013 Pali Rohár <pali.rohar@gmail.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. |
| * |
| * Datasheets: |
| * http://www.ti.com/product/bq24150 |
| * http://www.ti.com/product/bq24150a |
| * http://www.ti.com/product/bq24152 |
| * http://www.ti.com/product/bq24153 |
| * http://www.ti.com/product/bq24153a |
| * http://www.ti.com/product/bq24155 |
| * http://www.ti.com/product/bq24157s |
| * http://www.ti.com/product/bq24158 |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/module.h> |
| #include <linux/param.h> |
| #include <linux/err.h> |
| #include <linux/workqueue.h> |
| #include <linux/sysfs.h> |
| #include <linux/platform_device.h> |
| #include <linux/power_supply.h> |
| #include <linux/idr.h> |
| #include <linux/i2c.h> |
| #include <linux/slab.h> |
| |
| #include <linux/power/bq2415x_charger.h> |
| |
| /* timeout for resetting chip timer */ |
| #define BQ2415X_TIMER_TIMEOUT 10 |
| |
| #define BQ2415X_REG_STATUS 0x00 |
| #define BQ2415X_REG_CONTROL 0x01 |
| #define BQ2415X_REG_VOLTAGE 0x02 |
| #define BQ2415X_REG_VENDER 0x03 |
| #define BQ2415X_REG_CURRENT 0x04 |
| |
| /* reset state for all registers */ |
| #define BQ2415X_RESET_STATUS BIT(6) |
| #define BQ2415X_RESET_CONTROL (BIT(4)|BIT(5)) |
| #define BQ2415X_RESET_VOLTAGE (BIT(1)|BIT(3)) |
| #define BQ2415X_RESET_CURRENT (BIT(0)|BIT(3)|BIT(7)) |
| |
| /* status register */ |
| #define BQ2415X_BIT_TMR_RST 7 |
| #define BQ2415X_BIT_OTG 7 |
| #define BQ2415X_BIT_EN_STAT 6 |
| #define BQ2415X_MASK_STAT (BIT(4)|BIT(5)) |
| #define BQ2415X_SHIFT_STAT 4 |
| #define BQ2415X_BIT_BOOST 3 |
| #define BQ2415X_MASK_FAULT (BIT(0)|BIT(1)|BIT(2)) |
| #define BQ2415X_SHIFT_FAULT 0 |
| |
| /* control register */ |
| #define BQ2415X_MASK_LIMIT (BIT(6)|BIT(7)) |
| #define BQ2415X_SHIFT_LIMIT 6 |
| #define BQ2415X_MASK_VLOWV (BIT(4)|BIT(5)) |
| #define BQ2415X_SHIFT_VLOWV 4 |
| #define BQ2415X_BIT_TE 3 |
| #define BQ2415X_BIT_CE 2 |
| #define BQ2415X_BIT_HZ_MODE 1 |
| #define BQ2415X_BIT_OPA_MODE 0 |
| |
| /* voltage register */ |
| #define BQ2415X_MASK_VO (BIT(2)|BIT(3)|BIT(4)|BIT(5)|BIT(6)|BIT(7)) |
| #define BQ2415X_SHIFT_VO 2 |
| #define BQ2415X_BIT_OTG_PL 1 |
| #define BQ2415X_BIT_OTG_EN 0 |
| |
| /* vender register */ |
| #define BQ2415X_MASK_VENDER (BIT(5)|BIT(6)|BIT(7)) |
| #define BQ2415X_SHIFT_VENDER 5 |
| #define BQ2415X_MASK_PN (BIT(3)|BIT(4)) |
| #define BQ2415X_SHIFT_PN 3 |
| #define BQ2415X_MASK_REVISION (BIT(0)|BIT(1)|BIT(2)) |
| #define BQ2415X_SHIFT_REVISION 0 |
| |
| /* current register */ |
| #define BQ2415X_MASK_RESET BIT(7) |
| #define BQ2415X_MASK_VI_CHRG (BIT(4)|BIT(5)|BIT(6)) |
| #define BQ2415X_SHIFT_VI_CHRG 4 |
| /* N/A BIT(3) */ |
| #define BQ2415X_MASK_VI_TERM (BIT(0)|BIT(1)|BIT(2)) |
| #define BQ2415X_SHIFT_VI_TERM 0 |
| |
| |
| enum bq2415x_command { |
| BQ2415X_TIMER_RESET, |
| BQ2415X_OTG_STATUS, |
| BQ2415X_STAT_PIN_STATUS, |
| BQ2415X_STAT_PIN_ENABLE, |
| BQ2415X_STAT_PIN_DISABLE, |
| BQ2415X_CHARGE_STATUS, |
| BQ2415X_BOOST_STATUS, |
| BQ2415X_FAULT_STATUS, |
| |
| BQ2415X_CHARGE_TERMINATION_STATUS, |
| BQ2415X_CHARGE_TERMINATION_ENABLE, |
| BQ2415X_CHARGE_TERMINATION_DISABLE, |
| BQ2415X_CHARGER_STATUS, |
| BQ2415X_CHARGER_ENABLE, |
| BQ2415X_CHARGER_DISABLE, |
| BQ2415X_HIGH_IMPEDANCE_STATUS, |
| BQ2415X_HIGH_IMPEDANCE_ENABLE, |
| BQ2415X_HIGH_IMPEDANCE_DISABLE, |
| BQ2415X_BOOST_MODE_STATUS, |
| BQ2415X_BOOST_MODE_ENABLE, |
| BQ2415X_BOOST_MODE_DISABLE, |
| |
| BQ2415X_OTG_LEVEL, |
| BQ2415X_OTG_ACTIVATE_HIGH, |
| BQ2415X_OTG_ACTIVATE_LOW, |
| BQ2415X_OTG_PIN_STATUS, |
| BQ2415X_OTG_PIN_ENABLE, |
| BQ2415X_OTG_PIN_DISABLE, |
| |
| BQ2415X_VENDER_CODE, |
| BQ2415X_PART_NUMBER, |
| BQ2415X_REVISION, |
| }; |
| |
| enum bq2415x_chip { |
| BQUNKNOWN, |
| BQ24150, |
| BQ24150A, |
| BQ24151, |
| BQ24151A, |
| BQ24152, |
| BQ24153, |
| BQ24153A, |
| BQ24155, |
| BQ24156, |
| BQ24156A, |
| BQ24157S, |
| BQ24158, |
| }; |
| |
| static char *bq2415x_chip_name[] = { |
| "unknown", |
| "bq24150", |
| "bq24150a", |
| "bq24151", |
| "bq24151a", |
| "bq24152", |
| "bq24153", |
| "bq24153a", |
| "bq24155", |
| "bq24156", |
| "bq24156a", |
| "bq24157s", |
| "bq24158", |
| }; |
| |
| struct bq2415x_device { |
| struct device *dev; |
| struct bq2415x_platform_data init_data; |
| struct power_supply charger; |
| struct delayed_work work; |
| struct power_supply *notify_psy; |
| struct notifier_block nb; |
| enum bq2415x_mode reported_mode;/* mode reported by hook function */ |
| enum bq2415x_mode mode; /* currently configured mode */ |
| enum bq2415x_chip chip; |
| const char *timer_error; |
| char *model; |
| char *name; |
| int autotimer; /* 1 - if driver automatically reset timer, 0 - not */ |
| int automode; /* 1 - enabled, 0 - disabled; -1 - not supported */ |
| int id; |
| }; |
| |
| /* each registered chip must have unique id */ |
| static DEFINE_IDR(bq2415x_id); |
| |
| static DEFINE_MUTEX(bq2415x_id_mutex); |
| static DEFINE_MUTEX(bq2415x_timer_mutex); |
| static DEFINE_MUTEX(bq2415x_i2c_mutex); |
| |
| /**** i2c read functions ****/ |
| |
| /* read value from register */ |
| static int bq2415x_i2c_read(struct bq2415x_device *bq, u8 reg) |
| { |
| struct i2c_client *client = to_i2c_client(bq->dev); |
| struct i2c_msg msg[2]; |
| u8 val; |
| int ret; |
| |
| if (!client->adapter) |
| return -ENODEV; |
| |
| msg[0].addr = client->addr; |
| msg[0].flags = 0; |
| msg[0].buf = ® |
| msg[0].len = sizeof(reg); |
| msg[1].addr = client->addr; |
| msg[1].flags = I2C_M_RD; |
| msg[1].buf = &val; |
| msg[1].len = sizeof(val); |
| |
| mutex_lock(&bq2415x_i2c_mutex); |
| ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg)); |
| mutex_unlock(&bq2415x_i2c_mutex); |
| |
| if (ret < 0) |
| return ret; |
| |
| return val; |
| } |
| |
| /* read value from register, apply mask and right shift it */ |
| static int bq2415x_i2c_read_mask(struct bq2415x_device *bq, u8 reg, |
| u8 mask, u8 shift) |
| { |
| int ret; |
| |
| if (shift > 8) |
| return -EINVAL; |
| |
| ret = bq2415x_i2c_read(bq, reg); |
| if (ret < 0) |
| return ret; |
| return (ret & mask) >> shift; |
| } |
| |
| /* read value from register and return one specified bit */ |
| static int bq2415x_i2c_read_bit(struct bq2415x_device *bq, u8 reg, u8 bit) |
| { |
| if (bit > 8) |
| return -EINVAL; |
| return bq2415x_i2c_read_mask(bq, reg, BIT(bit), bit); |
| } |
| |
| /**** i2c write functions ****/ |
| |
| /* write value to register */ |
| static int bq2415x_i2c_write(struct bq2415x_device *bq, u8 reg, u8 val) |
| { |
| struct i2c_client *client = to_i2c_client(bq->dev); |
| struct i2c_msg msg[1]; |
| u8 data[2]; |
| int ret; |
| |
| data[0] = reg; |
| data[1] = val; |
| |
| msg[0].addr = client->addr; |
| msg[0].flags = 0; |
| msg[0].buf = data; |
| msg[0].len = ARRAY_SIZE(data); |
| |
| mutex_lock(&bq2415x_i2c_mutex); |
| ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg)); |
| mutex_unlock(&bq2415x_i2c_mutex); |
| |
| /* i2c_transfer returns number of messages transferred */ |
| if (ret < 0) |
| return ret; |
| else if (ret != 1) |
| return -EIO; |
| |
| return 0; |
| } |
| |
| /* read value from register, change it with mask left shifted and write back */ |
| static int bq2415x_i2c_write_mask(struct bq2415x_device *bq, u8 reg, u8 val, |
| u8 mask, u8 shift) |
| { |
| int ret; |
| |
| if (shift > 8) |
| return -EINVAL; |
| |
| ret = bq2415x_i2c_read(bq, reg); |
| if (ret < 0) |
| return ret; |
| |
| ret &= ~mask; |
| ret |= val << shift; |
| |
| return bq2415x_i2c_write(bq, reg, ret); |
| } |
| |
| /* change only one bit in register */ |
| static int bq2415x_i2c_write_bit(struct bq2415x_device *bq, u8 reg, |
| bool val, u8 bit) |
| { |
| if (bit > 8) |
| return -EINVAL; |
| return bq2415x_i2c_write_mask(bq, reg, val, BIT(bit), bit); |
| } |
| |
| /**** global functions ****/ |
| |
| /* exec command function */ |
| static int bq2415x_exec_command(struct bq2415x_device *bq, |
| enum bq2415x_command command) |
| { |
| int ret; |
| |
| switch (command) { |
| case BQ2415X_TIMER_RESET: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, |
| 1, BQ2415X_BIT_TMR_RST); |
| case BQ2415X_OTG_STATUS: |
| return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS, |
| BQ2415X_BIT_OTG); |
| case BQ2415X_STAT_PIN_STATUS: |
| return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS, |
| BQ2415X_BIT_EN_STAT); |
| case BQ2415X_STAT_PIN_ENABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 1, |
| BQ2415X_BIT_EN_STAT); |
| case BQ2415X_STAT_PIN_DISABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 0, |
| BQ2415X_BIT_EN_STAT); |
| case BQ2415X_CHARGE_STATUS: |
| return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS, |
| BQ2415X_MASK_STAT, BQ2415X_SHIFT_STAT); |
| case BQ2415X_BOOST_STATUS: |
| return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS, |
| BQ2415X_BIT_BOOST); |
| case BQ2415X_FAULT_STATUS: |
| return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS, |
| BQ2415X_MASK_FAULT, BQ2415X_SHIFT_FAULT); |
| |
| case BQ2415X_CHARGE_TERMINATION_STATUS: |
| return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL, |
| BQ2415X_BIT_TE); |
| case BQ2415X_CHARGE_TERMINATION_ENABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL, |
| 1, BQ2415X_BIT_TE); |
| case BQ2415X_CHARGE_TERMINATION_DISABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL, |
| 0, BQ2415X_BIT_TE); |
| case BQ2415X_CHARGER_STATUS: |
| ret = bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL, |
| BQ2415X_BIT_CE); |
| if (ret < 0) |
| return ret; |
| return ret > 0 ? 0 : 1; |
| case BQ2415X_CHARGER_ENABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL, |
| 0, BQ2415X_BIT_CE); |
| case BQ2415X_CHARGER_DISABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL, |
| 1, BQ2415X_BIT_CE); |
| case BQ2415X_HIGH_IMPEDANCE_STATUS: |
| return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL, |
| BQ2415X_BIT_HZ_MODE); |
| case BQ2415X_HIGH_IMPEDANCE_ENABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL, |
| 1, BQ2415X_BIT_HZ_MODE); |
| case BQ2415X_HIGH_IMPEDANCE_DISABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL, |
| 0, BQ2415X_BIT_HZ_MODE); |
| case BQ2415X_BOOST_MODE_STATUS: |
| return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL, |
| BQ2415X_BIT_OPA_MODE); |
| case BQ2415X_BOOST_MODE_ENABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL, |
| 1, BQ2415X_BIT_OPA_MODE); |
| case BQ2415X_BOOST_MODE_DISABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL, |
| 0, BQ2415X_BIT_OPA_MODE); |
| |
| case BQ2415X_OTG_LEVEL: |
| return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE, |
| BQ2415X_BIT_OTG_PL); |
| case BQ2415X_OTG_ACTIVATE_HIGH: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE, |
| 1, BQ2415X_BIT_OTG_PL); |
| case BQ2415X_OTG_ACTIVATE_LOW: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE, |
| 0, BQ2415X_BIT_OTG_PL); |
| case BQ2415X_OTG_PIN_STATUS: |
| return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE, |
| BQ2415X_BIT_OTG_EN); |
| case BQ2415X_OTG_PIN_ENABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE, |
| 1, BQ2415X_BIT_OTG_EN); |
| case BQ2415X_OTG_PIN_DISABLE: |
| return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE, |
| 0, BQ2415X_BIT_OTG_EN); |
| |
| case BQ2415X_VENDER_CODE: |
| return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER, |
| BQ2415X_MASK_VENDER, BQ2415X_SHIFT_VENDER); |
| case BQ2415X_PART_NUMBER: |
| return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER, |
| BQ2415X_MASK_PN, BQ2415X_SHIFT_PN); |
| case BQ2415X_REVISION: |
| return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER, |
| BQ2415X_MASK_REVISION, BQ2415X_SHIFT_REVISION); |
| } |
| return -EINVAL; |
| } |
| |
| /* detect chip type */ |
| static enum bq2415x_chip bq2415x_detect_chip(struct bq2415x_device *bq) |
| { |
| struct i2c_client *client = to_i2c_client(bq->dev); |
| int ret = bq2415x_exec_command(bq, BQ2415X_PART_NUMBER); |
| |
| if (ret < 0) |
| return ret; |
| |
| switch (client->addr) { |
| case 0x6b: |
| switch (ret) { |
| case 0: |
| if (bq->chip == BQ24151A) |
| return bq->chip; |
| return BQ24151; |
| case 1: |
| if (bq->chip == BQ24150A || |
| bq->chip == BQ24152 || |
| bq->chip == BQ24155) |
| return bq->chip; |
| return BQ24150; |
| case 2: |
| if (bq->chip == BQ24153A) |
| return bq->chip; |
| return BQ24153; |
| default: |
| return BQUNKNOWN; |
| } |
| break; |
| |
| case 0x6a: |
| switch (ret) { |
| case 0: |
| if (bq->chip == BQ24156A) |
| return bq->chip; |
| return BQ24156; |
| case 2: |
| if (bq->chip == BQ24157S) |
| return bq->chip; |
| return BQ24158; |
| default: |
| return BQUNKNOWN; |
| } |
| break; |
| } |
| |
| return BQUNKNOWN; |
| } |
| |
| /* detect chip revision */ |
| static int bq2415x_detect_revision(struct bq2415x_device *bq) |
| { |
| int ret = bq2415x_exec_command(bq, BQ2415X_REVISION); |
| int chip = bq2415x_detect_chip(bq); |
| |
| if (ret < 0 || chip < 0) |
| return -1; |
| |
| switch (chip) { |
| case BQ24150: |
| case BQ24150A: |
| case BQ24151: |
| case BQ24151A: |
| case BQ24152: |
| if (ret >= 0 && ret <= 3) |
| return ret; |
| return -1; |
| case BQ24153: |
| case BQ24153A: |
| case BQ24156: |
| case BQ24156A: |
| case BQ24157S: |
| case BQ24158: |
| if (ret == 3) |
| return 0; |
| else if (ret == 1) |
| return 1; |
| return -1; |
| case BQ24155: |
| if (ret == 3) |
| return 3; |
| return -1; |
| case BQUNKNOWN: |
| return -1; |
| } |
| |
| return -1; |
| } |
| |
| /* return chip vender code */ |
| static int bq2415x_get_vender_code(struct bq2415x_device *bq) |
| { |
| int ret; |
| |
| ret = bq2415x_exec_command(bq, BQ2415X_VENDER_CODE); |
| if (ret < 0) |
| return 0; |
| |
| /* convert to binary */ |
| return (ret & 0x1) + |
| ((ret >> 1) & 0x1) * 10 + |
| ((ret >> 2) & 0x1) * 100; |
| } |
| |
| /* reset all chip registers to default state */ |
| static void bq2415x_reset_chip(struct bq2415x_device *bq) |
| { |
| bq2415x_i2c_write(bq, BQ2415X_REG_CURRENT, BQ2415X_RESET_CURRENT); |
| bq2415x_i2c_write(bq, BQ2415X_REG_VOLTAGE, BQ2415X_RESET_VOLTAGE); |
| bq2415x_i2c_write(bq, BQ2415X_REG_CONTROL, BQ2415X_RESET_CONTROL); |
| bq2415x_i2c_write(bq, BQ2415X_REG_STATUS, BQ2415X_RESET_STATUS); |
| bq->timer_error = NULL; |
| } |
| |
| /**** properties functions ****/ |
| |
| /* set current limit in mA */ |
| static int bq2415x_set_current_limit(struct bq2415x_device *bq, int mA) |
| { |
| int val; |
| |
| if (mA <= 100) |
| val = 0; |
| else if (mA <= 500) |
| val = 1; |
| else if (mA <= 800) |
| val = 2; |
| else |
| val = 3; |
| |
| return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val, |
| BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT); |
| } |
| |
| /* get current limit in mA */ |
| static int bq2415x_get_current_limit(struct bq2415x_device *bq) |
| { |
| int ret; |
| |
| ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL, |
| BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT); |
| if (ret < 0) |
| return ret; |
| else if (ret == 0) |
| return 100; |
| else if (ret == 1) |
| return 500; |
| else if (ret == 2) |
| return 800; |
| else if (ret == 3) |
| return 1800; |
| return -EINVAL; |
| } |
| |
| /* set weak battery voltage in mV */ |
| static int bq2415x_set_weak_battery_voltage(struct bq2415x_device *bq, int mV) |
| { |
| int val; |
| |
| /* round to 100mV */ |
| if (mV <= 3400 + 50) |
| val = 0; |
| else if (mV <= 3500 + 50) |
| val = 1; |
| else if (mV <= 3600 + 50) |
| val = 2; |
| else |
| val = 3; |
| |
| return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val, |
| BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV); |
| } |
| |
| /* get weak battery voltage in mV */ |
| static int bq2415x_get_weak_battery_voltage(struct bq2415x_device *bq) |
| { |
| int ret; |
| |
| ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL, |
| BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV); |
| if (ret < 0) |
| return ret; |
| return 100 * (34 + ret); |
| } |
| |
| /* set battery regulation voltage in mV */ |
| static int bq2415x_set_battery_regulation_voltage(struct bq2415x_device *bq, |
| int mV) |
| { |
| int val = (mV/10 - 350) / 2; |
| |
| /* |
| * According to datasheet, maximum battery regulation voltage is |
| * 4440mV which is b101111 = 47. |
| */ |
| if (val < 0) |
| val = 0; |
| else if (val > 47) |
| return -EINVAL; |
| |
| return bq2415x_i2c_write_mask(bq, BQ2415X_REG_VOLTAGE, val, |
| BQ2415X_MASK_VO, BQ2415X_SHIFT_VO); |
| } |
| |
| /* get battery regulation voltage in mV */ |
| static int bq2415x_get_battery_regulation_voltage(struct bq2415x_device *bq) |
| { |
| int ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_VOLTAGE, |
| BQ2415X_MASK_VO, BQ2415X_SHIFT_VO); |
| |
| if (ret < 0) |
| return ret; |
| return 10 * (350 + 2*ret); |
| } |
| |
| /* set charge current in mA (platform data must provide resistor sense) */ |
| static int bq2415x_set_charge_current(struct bq2415x_device *bq, int mA) |
| { |
| int val; |
| |
| if (bq->init_data.resistor_sense <= 0) |
| return -ENOSYS; |
| |
| val = (mA * bq->init_data.resistor_sense - 37400) / 6800; |
| if (val < 0) |
| val = 0; |
| else if (val > 7) |
| val = 7; |
| |
| return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val, |
| BQ2415X_MASK_VI_CHRG | BQ2415X_MASK_RESET, |
| BQ2415X_SHIFT_VI_CHRG); |
| } |
| |
| /* get charge current in mA (platform data must provide resistor sense) */ |
| static int bq2415x_get_charge_current(struct bq2415x_device *bq) |
| { |
| int ret; |
| |
| if (bq->init_data.resistor_sense <= 0) |
| return -ENOSYS; |
| |
| ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT, |
| BQ2415X_MASK_VI_CHRG, BQ2415X_SHIFT_VI_CHRG); |
| if (ret < 0) |
| return ret; |
| return (37400 + 6800*ret) / bq->init_data.resistor_sense; |
| } |
| |
| /* set termination current in mA (platform data must provide resistor sense) */ |
| static int bq2415x_set_termination_current(struct bq2415x_device *bq, int mA) |
| { |
| int val; |
| |
| if (bq->init_data.resistor_sense <= 0) |
| return -ENOSYS; |
| |
| val = (mA * bq->init_data.resistor_sense - 3400) / 3400; |
| if (val < 0) |
| val = 0; |
| else if (val > 7) |
| val = 7; |
| |
| return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val, |
| BQ2415X_MASK_VI_TERM | BQ2415X_MASK_RESET, |
| BQ2415X_SHIFT_VI_TERM); |
| } |
| |
| /* get termination current in mA (platform data must provide resistor sense) */ |
| static int bq2415x_get_termination_current(struct bq2415x_device *bq) |
| { |
| int ret; |
| |
| if (bq->init_data.resistor_sense <= 0) |
| return -ENOSYS; |
| |
| ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT, |
| BQ2415X_MASK_VI_TERM, BQ2415X_SHIFT_VI_TERM); |
| if (ret < 0) |
| return ret; |
| return (3400 + 3400*ret) / bq->init_data.resistor_sense; |
| } |
| |
| /* set default value of property */ |
| #define bq2415x_set_default_value(bq, prop) \ |
| do { \ |
| int ret = 0; \ |
| if (bq->init_data.prop != -1) \ |
| ret = bq2415x_set_##prop(bq, bq->init_data.prop); \ |
| if (ret < 0) \ |
| return ret; \ |
| } while (0) |
| |
| /* set default values of all properties */ |
| static int bq2415x_set_defaults(struct bq2415x_device *bq) |
| { |
| bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE); |
| bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE); |
| bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_DISABLE); |
| |
| bq2415x_set_default_value(bq, current_limit); |
| bq2415x_set_default_value(bq, weak_battery_voltage); |
| bq2415x_set_default_value(bq, battery_regulation_voltage); |
| |
| if (bq->init_data.resistor_sense > 0) { |
| bq2415x_set_default_value(bq, charge_current); |
| bq2415x_set_default_value(bq, termination_current); |
| bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_ENABLE); |
| } |
| |
| bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE); |
| return 0; |
| } |
| |
| /**** charger mode functions ****/ |
| |
| /* set charger mode */ |
| static int bq2415x_set_mode(struct bq2415x_device *bq, enum bq2415x_mode mode) |
| { |
| int ret = 0; |
| int charger = 0; |
| int boost = 0; |
| |
| if (mode == BQ2415X_MODE_BOOST) |
| boost = 1; |
| else if (mode != BQ2415X_MODE_OFF) |
| charger = 1; |
| |
| if (!charger) |
| ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE); |
| |
| if (!boost) |
| ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE); |
| |
| if (ret < 0) |
| return ret; |
| |
| switch (mode) { |
| case BQ2415X_MODE_OFF: |
| dev_dbg(bq->dev, "changing mode to: Offline\n"); |
| ret = bq2415x_set_current_limit(bq, 100); |
| break; |
| case BQ2415X_MODE_NONE: |
| dev_dbg(bq->dev, "changing mode to: N/A\n"); |
| ret = bq2415x_set_current_limit(bq, 100); |
| break; |
| case BQ2415X_MODE_HOST_CHARGER: |
| dev_dbg(bq->dev, "changing mode to: Host/HUB charger\n"); |
| ret = bq2415x_set_current_limit(bq, 500); |
| break; |
| case BQ2415X_MODE_DEDICATED_CHARGER: |
| dev_dbg(bq->dev, "changing mode to: Dedicated charger\n"); |
| ret = bq2415x_set_current_limit(bq, 1800); |
| break; |
| case BQ2415X_MODE_BOOST: /* Boost mode */ |
| dev_dbg(bq->dev, "changing mode to: Boost\n"); |
| ret = bq2415x_set_current_limit(bq, 100); |
| break; |
| } |
| |
| if (ret < 0) |
| return ret; |
| |
| if (charger) |
| ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE); |
| else if (boost) |
| ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_ENABLE); |
| |
| if (ret < 0) |
| return ret; |
| |
| bq2415x_set_default_value(bq, weak_battery_voltage); |
| bq2415x_set_default_value(bq, battery_regulation_voltage); |
| |
| bq->mode = mode; |
| sysfs_notify(&bq->charger.dev->kobj, NULL, "mode"); |
| |
| return 0; |
| |
| } |
| |
| static int bq2415x_notifier_call(struct notifier_block *nb, |
| unsigned long val, void *v) |
| { |
| struct bq2415x_device *bq = |
| container_of(nb, struct bq2415x_device, nb); |
| struct power_supply *psy = v; |
| enum bq2415x_mode mode; |
| union power_supply_propval prop; |
| int ret; |
| int mA; |
| |
| if (val != PSY_EVENT_PROP_CHANGED) |
| return NOTIFY_OK; |
| |
| if (psy != bq->notify_psy) |
| return NOTIFY_OK; |
| |
| dev_dbg(bq->dev, "notifier call was called\n"); |
| |
| ret = power_supply_get_property(psy, POWER_SUPPLY_PROP_CURRENT_MAX, |
| &prop); |
| if (ret != 0) |
| return NOTIFY_OK; |
| |
| mA = prop.intval; |
| |
| if (mA == 0) |
| mode = BQ2415X_MODE_OFF; |
| else if (mA < 500) |
| mode = BQ2415X_MODE_NONE; |
| else if (mA < 1800) |
| mode = BQ2415X_MODE_HOST_CHARGER; |
| else |
| mode = BQ2415X_MODE_DEDICATED_CHARGER; |
| |
| if (bq->reported_mode == mode) |
| return NOTIFY_OK; |
| |
| bq->reported_mode = mode; |
| |
| /* if automode is not enabled do not tell about reported_mode */ |
| if (bq->automode < 1) |
| return NOTIFY_OK; |
| |
| schedule_delayed_work(&bq->work, 0); |
| |
| return NOTIFY_OK; |
| } |
| |
| /**** timer functions ****/ |
| |
| /* enable/disable auto resetting chip timer */ |
| static void bq2415x_set_autotimer(struct bq2415x_device *bq, int state) |
| { |
| mutex_lock(&bq2415x_timer_mutex); |
| |
| if (bq->autotimer == state) { |
| mutex_unlock(&bq2415x_timer_mutex); |
| return; |
| } |
| |
| bq->autotimer = state; |
| |
| if (state) { |
| schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ); |
| bq2415x_exec_command(bq, BQ2415X_TIMER_RESET); |
| bq->timer_error = NULL; |
| } else { |
| cancel_delayed_work_sync(&bq->work); |
| } |
| |
| mutex_unlock(&bq2415x_timer_mutex); |
| } |
| |
| /* called by bq2415x_timer_work on timer error */ |
| static void bq2415x_timer_error(struct bq2415x_device *bq, const char *msg) |
| { |
| bq->timer_error = msg; |
| sysfs_notify(&bq->charger.dev->kobj, NULL, "timer"); |
| dev_err(bq->dev, "%s\n", msg); |
| if (bq->automode > 0) |
| bq->automode = 0; |
| bq2415x_set_mode(bq, BQ2415X_MODE_OFF); |
| bq2415x_set_autotimer(bq, 0); |
| } |
| |
| /* delayed work function for auto resetting chip timer */ |
| static void bq2415x_timer_work(struct work_struct *work) |
| { |
| struct bq2415x_device *bq = container_of(work, struct bq2415x_device, |
| work.work); |
| int ret; |
| int error; |
| int boost; |
| |
| if (bq->automode > 0 && (bq->reported_mode != bq->mode)) { |
| sysfs_notify(&bq->charger.dev->kobj, NULL, "reported_mode"); |
| bq2415x_set_mode(bq, bq->reported_mode); |
| } |
| |
| if (!bq->autotimer) |
| return; |
| |
| ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET); |
| if (ret < 0) { |
| bq2415x_timer_error(bq, "Resetting timer failed"); |
| return; |
| } |
| |
| boost = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_STATUS); |
| if (boost < 0) { |
| bq2415x_timer_error(bq, "Unknown error"); |
| return; |
| } |
| |
| error = bq2415x_exec_command(bq, BQ2415X_FAULT_STATUS); |
| if (error < 0) { |
| bq2415x_timer_error(bq, "Unknown error"); |
| return; |
| } |
| |
| if (boost) { |
| switch (error) { |
| /* Non fatal errors, chip is OK */ |
| case 0: /* No error */ |
| break; |
| case 6: /* Timer expired */ |
| dev_err(bq->dev, "Timer expired\n"); |
| break; |
| case 3: /* Battery voltage too low */ |
| dev_err(bq->dev, "Battery voltage to low\n"); |
| break; |
| |
| /* Fatal errors, disable and reset chip */ |
| case 1: /* Overvoltage protection (chip fried) */ |
| bq2415x_timer_error(bq, |
| "Overvoltage protection (chip fried)"); |
| return; |
| case 2: /* Overload */ |
| bq2415x_timer_error(bq, "Overload"); |
| return; |
| case 4: /* Battery overvoltage protection */ |
| bq2415x_timer_error(bq, |
| "Battery overvoltage protection"); |
| return; |
| case 5: /* Thermal shutdown (too hot) */ |
| bq2415x_timer_error(bq, |
| "Thermal shutdown (too hot)"); |
| return; |
| case 7: /* N/A */ |
| bq2415x_timer_error(bq, "Unknown error"); |
| return; |
| } |
| } else { |
| switch (error) { |
| /* Non fatal errors, chip is OK */ |
| case 0: /* No error */ |
| break; |
| case 2: /* Sleep mode */ |
| dev_err(bq->dev, "Sleep mode\n"); |
| break; |
| case 3: /* Poor input source */ |
| dev_err(bq->dev, "Poor input source\n"); |
| break; |
| case 6: /* Timer expired */ |
| dev_err(bq->dev, "Timer expired\n"); |
| break; |
| case 7: /* No battery */ |
| dev_err(bq->dev, "No battery\n"); |
| break; |
| |
| /* Fatal errors, disable and reset chip */ |
| case 1: /* Overvoltage protection (chip fried) */ |
| bq2415x_timer_error(bq, |
| "Overvoltage protection (chip fried)"); |
| return; |
| case 4: /* Battery overvoltage protection */ |
| bq2415x_timer_error(bq, |
| "Battery overvoltage protection"); |
| return; |
| case 5: /* Thermal shutdown (too hot) */ |
| bq2415x_timer_error(bq, |
| "Thermal shutdown (too hot)"); |
| return; |
| } |
| } |
| |
| schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ); |
| } |
| |
| /**** power supply interface code ****/ |
| |
| static enum power_supply_property bq2415x_power_supply_props[] = { |
| /* TODO: maybe add more power supply properties */ |
| POWER_SUPPLY_PROP_STATUS, |
| POWER_SUPPLY_PROP_MODEL_NAME, |
| }; |
| |
| static int bq2415x_power_supply_get_property(struct power_supply *psy, |
| enum power_supply_property psp, |
| union power_supply_propval *val) |
| { |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| int ret; |
| |
| switch (psp) { |
| case POWER_SUPPLY_PROP_STATUS: |
| ret = bq2415x_exec_command(bq, BQ2415X_CHARGE_STATUS); |
| if (ret < 0) |
| return ret; |
| else if (ret == 0) /* Ready */ |
| val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING; |
| else if (ret == 1) /* Charge in progress */ |
| val->intval = POWER_SUPPLY_STATUS_CHARGING; |
| else if (ret == 2) /* Charge done */ |
| val->intval = POWER_SUPPLY_STATUS_FULL; |
| else |
| val->intval = POWER_SUPPLY_STATUS_UNKNOWN; |
| break; |
| case POWER_SUPPLY_PROP_MODEL_NAME: |
| val->strval = bq->model; |
| break; |
| default: |
| return -EINVAL; |
| } |
| return 0; |
| } |
| |
| static int bq2415x_power_supply_init(struct bq2415x_device *bq) |
| { |
| int ret; |
| int chip; |
| char revstr[8]; |
| |
| bq->charger.name = bq->name; |
| bq->charger.type = POWER_SUPPLY_TYPE_USB; |
| bq->charger.properties = bq2415x_power_supply_props; |
| bq->charger.num_properties = ARRAY_SIZE(bq2415x_power_supply_props); |
| bq->charger.get_property = bq2415x_power_supply_get_property; |
| |
| ret = bq2415x_detect_chip(bq); |
| if (ret < 0) |
| chip = BQUNKNOWN; |
| else |
| chip = ret; |
| |
| ret = bq2415x_detect_revision(bq); |
| if (ret < 0) |
| strcpy(revstr, "unknown"); |
| else |
| sprintf(revstr, "1.%d", ret); |
| |
| bq->model = kasprintf(GFP_KERNEL, |
| "chip %s, revision %s, vender code %.3d", |
| bq2415x_chip_name[chip], revstr, |
| bq2415x_get_vender_code(bq)); |
| if (!bq->model) { |
| dev_err(bq->dev, "failed to allocate model name\n"); |
| return -ENOMEM; |
| } |
| |
| ret = power_supply_register(bq->dev, &bq->charger, NULL); |
| if (ret) { |
| kfree(bq->model); |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| static void bq2415x_power_supply_exit(struct bq2415x_device *bq) |
| { |
| bq->autotimer = 0; |
| if (bq->automode > 0) |
| bq->automode = 0; |
| cancel_delayed_work_sync(&bq->work); |
| power_supply_unregister(&bq->charger); |
| kfree(bq->model); |
| } |
| |
| /**** additional sysfs entries for power supply interface ****/ |
| |
| /* show *_status entries */ |
| static ssize_t bq2415x_sysfs_show_status(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| enum bq2415x_command command; |
| int ret; |
| |
| if (strcmp(attr->attr.name, "otg_status") == 0) |
| command = BQ2415X_OTG_STATUS; |
| else if (strcmp(attr->attr.name, "charge_status") == 0) |
| command = BQ2415X_CHARGE_STATUS; |
| else if (strcmp(attr->attr.name, "boost_status") == 0) |
| command = BQ2415X_BOOST_STATUS; |
| else if (strcmp(attr->attr.name, "fault_status") == 0) |
| command = BQ2415X_FAULT_STATUS; |
| else |
| return -EINVAL; |
| |
| ret = bq2415x_exec_command(bq, command); |
| if (ret < 0) |
| return ret; |
| return sprintf(buf, "%d\n", ret); |
| } |
| |
| /* |
| * set timer entry: |
| * auto - enable auto mode |
| * off - disable auto mode |
| * (other values) - reset chip timer |
| */ |
| static ssize_t bq2415x_sysfs_set_timer(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, |
| size_t count) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| int ret = 0; |
| |
| if (strncmp(buf, "auto", 4) == 0) |
| bq2415x_set_autotimer(bq, 1); |
| else if (strncmp(buf, "off", 3) == 0) |
| bq2415x_set_autotimer(bq, 0); |
| else |
| ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET); |
| |
| if (ret < 0) |
| return ret; |
| return count; |
| } |
| |
| /* show timer entry (auto or off) */ |
| static ssize_t bq2415x_sysfs_show_timer(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| |
| if (bq->timer_error) |
| return sprintf(buf, "%s\n", bq->timer_error); |
| |
| if (bq->autotimer) |
| return sprintf(buf, "auto\n"); |
| return sprintf(buf, "off\n"); |
| } |
| |
| /* |
| * set mode entry: |
| * auto - if automode is supported, enable it and set mode to reported |
| * none - disable charger and boost mode |
| * host - charging mode for host/hub chargers (current limit 500mA) |
| * dedicated - charging mode for dedicated chargers (unlimited current limit) |
| * boost - disable charger and enable boost mode |
| */ |
| static ssize_t bq2415x_sysfs_set_mode(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, |
| size_t count) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| enum bq2415x_mode mode; |
| int ret = 0; |
| |
| if (strncmp(buf, "auto", 4) == 0) { |
| if (bq->automode < 0) |
| return -ENOSYS; |
| bq->automode = 1; |
| mode = bq->reported_mode; |
| } else if (strncmp(buf, "off", 3) == 0) { |
| if (bq->automode > 0) |
| bq->automode = 0; |
| mode = BQ2415X_MODE_OFF; |
| } else if (strncmp(buf, "none", 4) == 0) { |
| if (bq->automode > 0) |
| bq->automode = 0; |
| mode = BQ2415X_MODE_NONE; |
| } else if (strncmp(buf, "host", 4) == 0) { |
| if (bq->automode > 0) |
| bq->automode = 0; |
| mode = BQ2415X_MODE_HOST_CHARGER; |
| } else if (strncmp(buf, "dedicated", 9) == 0) { |
| if (bq->automode > 0) |
| bq->automode = 0; |
| mode = BQ2415X_MODE_DEDICATED_CHARGER; |
| } else if (strncmp(buf, "boost", 5) == 0) { |
| if (bq->automode > 0) |
| bq->automode = 0; |
| mode = BQ2415X_MODE_BOOST; |
| } else if (strncmp(buf, "reset", 5) == 0) { |
| bq2415x_reset_chip(bq); |
| bq2415x_set_defaults(bq); |
| if (bq->automode <= 0) |
| return count; |
| bq->automode = 1; |
| mode = bq->reported_mode; |
| } else { |
| return -EINVAL; |
| } |
| |
| ret = bq2415x_set_mode(bq, mode); |
| if (ret < 0) |
| return ret; |
| return count; |
| } |
| |
| /* show mode entry (auto, none, host, dedicated or boost) */ |
| static ssize_t bq2415x_sysfs_show_mode(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| ssize_t ret = 0; |
| |
| if (bq->automode > 0) |
| ret += sprintf(buf+ret, "auto ("); |
| |
| switch (bq->mode) { |
| case BQ2415X_MODE_OFF: |
| ret += sprintf(buf+ret, "off"); |
| break; |
| case BQ2415X_MODE_NONE: |
| ret += sprintf(buf+ret, "none"); |
| break; |
| case BQ2415X_MODE_HOST_CHARGER: |
| ret += sprintf(buf+ret, "host"); |
| break; |
| case BQ2415X_MODE_DEDICATED_CHARGER: |
| ret += sprintf(buf+ret, "dedicated"); |
| break; |
| case BQ2415X_MODE_BOOST: |
| ret += sprintf(buf+ret, "boost"); |
| break; |
| } |
| |
| if (bq->automode > 0) |
| ret += sprintf(buf+ret, ")"); |
| |
| ret += sprintf(buf+ret, "\n"); |
| return ret; |
| } |
| |
| /* show reported_mode entry (none, host, dedicated or boost) */ |
| static ssize_t bq2415x_sysfs_show_reported_mode(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| |
| if (bq->automode < 0) |
| return -EINVAL; |
| |
| switch (bq->reported_mode) { |
| case BQ2415X_MODE_OFF: |
| return sprintf(buf, "off\n"); |
| case BQ2415X_MODE_NONE: |
| return sprintf(buf, "none\n"); |
| case BQ2415X_MODE_HOST_CHARGER: |
| return sprintf(buf, "host\n"); |
| case BQ2415X_MODE_DEDICATED_CHARGER: |
| return sprintf(buf, "dedicated\n"); |
| case BQ2415X_MODE_BOOST: |
| return sprintf(buf, "boost\n"); |
| } |
| |
| return -EINVAL; |
| } |
| |
| /* directly set raw value to chip register, format: 'register value' */ |
| static ssize_t bq2415x_sysfs_set_registers(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, |
| size_t count) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| ssize_t ret = 0; |
| unsigned int reg; |
| unsigned int val; |
| |
| if (sscanf(buf, "%x %x", ®, &val) != 2) |
| return -EINVAL; |
| |
| if (reg > 4 || val > 255) |
| return -EINVAL; |
| |
| ret = bq2415x_i2c_write(bq, reg, val); |
| if (ret < 0) |
| return ret; |
| return count; |
| } |
| |
| /* print value of chip register, format: 'register=value' */ |
| static ssize_t bq2415x_sysfs_print_reg(struct bq2415x_device *bq, |
| u8 reg, |
| char *buf) |
| { |
| int ret = bq2415x_i2c_read(bq, reg); |
| |
| if (ret < 0) |
| return sprintf(buf, "%#.2x=error %d\n", reg, ret); |
| return sprintf(buf, "%#.2x=%#.2x\n", reg, ret); |
| } |
| |
| /* show all raw values of chip register, format per line: 'register=value' */ |
| static ssize_t bq2415x_sysfs_show_registers(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| ssize_t ret = 0; |
| |
| ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_STATUS, buf+ret); |
| ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CONTROL, buf+ret); |
| ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VOLTAGE, buf+ret); |
| ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VENDER, buf+ret); |
| ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CURRENT, buf+ret); |
| return ret; |
| } |
| |
| /* set current and voltage limit entries (in mA or mV) */ |
| static ssize_t bq2415x_sysfs_set_limit(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, |
| size_t count) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| long val; |
| int ret; |
| |
| if (kstrtol(buf, 10, &val) < 0) |
| return -EINVAL; |
| |
| if (strcmp(attr->attr.name, "current_limit") == 0) |
| ret = bq2415x_set_current_limit(bq, val); |
| else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0) |
| ret = bq2415x_set_weak_battery_voltage(bq, val); |
| else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0) |
| ret = bq2415x_set_battery_regulation_voltage(bq, val); |
| else if (strcmp(attr->attr.name, "charge_current") == 0) |
| ret = bq2415x_set_charge_current(bq, val); |
| else if (strcmp(attr->attr.name, "termination_current") == 0) |
| ret = bq2415x_set_termination_current(bq, val); |
| else |
| return -EINVAL; |
| |
| if (ret < 0) |
| return ret; |
| return count; |
| } |
| |
| /* show current and voltage limit entries (in mA or mV) */ |
| static ssize_t bq2415x_sysfs_show_limit(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| int ret; |
| |
| if (strcmp(attr->attr.name, "current_limit") == 0) |
| ret = bq2415x_get_current_limit(bq); |
| else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0) |
| ret = bq2415x_get_weak_battery_voltage(bq); |
| else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0) |
| ret = bq2415x_get_battery_regulation_voltage(bq); |
| else if (strcmp(attr->attr.name, "charge_current") == 0) |
| ret = bq2415x_get_charge_current(bq); |
| else if (strcmp(attr->attr.name, "termination_current") == 0) |
| ret = bq2415x_get_termination_current(bq); |
| else |
| return -EINVAL; |
| |
| if (ret < 0) |
| return ret; |
| return sprintf(buf, "%d\n", ret); |
| } |
| |
| /* set *_enable entries */ |
| static ssize_t bq2415x_sysfs_set_enable(struct device *dev, |
| struct device_attribute *attr, |
| const char *buf, |
| size_t count) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| enum bq2415x_command command; |
| long val; |
| int ret; |
| |
| if (kstrtol(buf, 10, &val) < 0) |
| return -EINVAL; |
| |
| if (strcmp(attr->attr.name, "charge_termination_enable") == 0) |
| command = val ? BQ2415X_CHARGE_TERMINATION_ENABLE : |
| BQ2415X_CHARGE_TERMINATION_DISABLE; |
| else if (strcmp(attr->attr.name, "high_impedance_enable") == 0) |
| command = val ? BQ2415X_HIGH_IMPEDANCE_ENABLE : |
| BQ2415X_HIGH_IMPEDANCE_DISABLE; |
| else if (strcmp(attr->attr.name, "otg_pin_enable") == 0) |
| command = val ? BQ2415X_OTG_PIN_ENABLE : |
| BQ2415X_OTG_PIN_DISABLE; |
| else if (strcmp(attr->attr.name, "stat_pin_enable") == 0) |
| command = val ? BQ2415X_STAT_PIN_ENABLE : |
| BQ2415X_STAT_PIN_DISABLE; |
| else |
| return -EINVAL; |
| |
| ret = bq2415x_exec_command(bq, command); |
| if (ret < 0) |
| return ret; |
| return count; |
| } |
| |
| /* show *_enable entries */ |
| static ssize_t bq2415x_sysfs_show_enable(struct device *dev, |
| struct device_attribute *attr, |
| char *buf) |
| { |
| struct power_supply *psy = dev_get_drvdata(dev); |
| struct bq2415x_device *bq = container_of(psy, struct bq2415x_device, |
| charger); |
| enum bq2415x_command command; |
| int ret; |
| |
| if (strcmp(attr->attr.name, "charge_termination_enable") == 0) |
| command = BQ2415X_CHARGE_TERMINATION_STATUS; |
| else if (strcmp(attr->attr.name, "high_impedance_enable") == 0) |
| command = BQ2415X_HIGH_IMPEDANCE_STATUS; |
| else if (strcmp(attr->attr.name, "otg_pin_enable") == 0) |
| command = BQ2415X_OTG_PIN_STATUS; |
| else if (strcmp(attr->attr.name, "stat_pin_enable") == 0) |
| command = BQ2415X_STAT_PIN_STATUS; |
| else |
| return -EINVAL; |
| |
| ret = bq2415x_exec_command(bq, command); |
| if (ret < 0) |
| return ret; |
| return sprintf(buf, "%d\n", ret); |
| } |
| |
| static DEVICE_ATTR(current_limit, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit); |
| static DEVICE_ATTR(weak_battery_voltage, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit); |
| static DEVICE_ATTR(battery_regulation_voltage, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit); |
| static DEVICE_ATTR(charge_current, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit); |
| static DEVICE_ATTR(termination_current, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit); |
| |
| static DEVICE_ATTR(charge_termination_enable, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable); |
| static DEVICE_ATTR(high_impedance_enable, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable); |
| static DEVICE_ATTR(otg_pin_enable, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable); |
| static DEVICE_ATTR(stat_pin_enable, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable); |
| |
| static DEVICE_ATTR(reported_mode, S_IRUGO, |
| bq2415x_sysfs_show_reported_mode, NULL); |
| static DEVICE_ATTR(mode, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_mode, bq2415x_sysfs_set_mode); |
| static DEVICE_ATTR(timer, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_timer, bq2415x_sysfs_set_timer); |
| |
| static DEVICE_ATTR(registers, S_IWUSR | S_IRUGO, |
| bq2415x_sysfs_show_registers, bq2415x_sysfs_set_registers); |
| |
| static DEVICE_ATTR(otg_status, S_IRUGO, bq2415x_sysfs_show_status, NULL); |
| static DEVICE_ATTR(charge_status, S_IRUGO, bq2415x_sysfs_show_status, NULL); |
| static DEVICE_ATTR(boost_status, S_IRUGO, bq2415x_sysfs_show_status, NULL); |
| static DEVICE_ATTR(fault_status, S_IRUGO, bq2415x_sysfs_show_status, NULL); |
| |
| static struct attribute *bq2415x_sysfs_attributes[] = { |
| /* |
| * TODO: some (appropriate) of these attrs should be switched to |
| * use power supply class props. |
| */ |
| &dev_attr_current_limit.attr, |
| &dev_attr_weak_battery_voltage.attr, |
| &dev_attr_battery_regulation_voltage.attr, |
| &dev_attr_charge_current.attr, |
| &dev_attr_termination_current.attr, |
| |
| &dev_attr_charge_termination_enable.attr, |
| &dev_attr_high_impedance_enable.attr, |
| &dev_attr_otg_pin_enable.attr, |
| &dev_attr_stat_pin_enable.attr, |
| |
| &dev_attr_reported_mode.attr, |
| &dev_attr_mode.attr, |
| &dev_attr_timer.attr, |
| |
| &dev_attr_registers.attr, |
| |
| &dev_attr_otg_status.attr, |
| &dev_attr_charge_status.attr, |
| &dev_attr_boost_status.attr, |
| &dev_attr_fault_status.attr, |
| NULL, |
| }; |
| |
| static const struct attribute_group bq2415x_sysfs_attr_group = { |
| .attrs = bq2415x_sysfs_attributes, |
| }; |
| |
| static int bq2415x_sysfs_init(struct bq2415x_device *bq) |
| { |
| return sysfs_create_group(&bq->charger.dev->kobj, |
| &bq2415x_sysfs_attr_group); |
| } |
| |
| static void bq2415x_sysfs_exit(struct bq2415x_device *bq) |
| { |
| sysfs_remove_group(&bq->charger.dev->kobj, &bq2415x_sysfs_attr_group); |
| } |
| |
| /* main bq2415x probe function */ |
| static int bq2415x_probe(struct i2c_client *client, |
| const struct i2c_device_id *id) |
| { |
| int ret; |
| int num; |
| char *name; |
| struct bq2415x_device *bq; |
| struct device_node *np = client->dev.of_node; |
| struct bq2415x_platform_data *pdata = client->dev.platform_data; |
| |
| if (!np && !pdata) { |
| dev_err(&client->dev, "platform data missing\n"); |
| return -ENODEV; |
| } |
| |
| /* Get new ID for the new device */ |
| mutex_lock(&bq2415x_id_mutex); |
| num = idr_alloc(&bq2415x_id, client, 0, 0, GFP_KERNEL); |
| mutex_unlock(&bq2415x_id_mutex); |
| if (num < 0) |
| return num; |
| |
| name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num); |
| if (!name) { |
| dev_err(&client->dev, "failed to allocate device name\n"); |
| ret = -ENOMEM; |
| goto error_1; |
| } |
| |
| bq = devm_kzalloc(&client->dev, sizeof(*bq), GFP_KERNEL); |
| if (!bq) { |
| dev_err(&client->dev, "failed to allocate device data\n"); |
| ret = -ENOMEM; |
| goto error_2; |
| } |
| |
| if (np) { |
| bq->notify_psy = power_supply_get_by_phandle(np, "ti,usb-charger-detection"); |
| |
| if (IS_ERR(bq->notify_psy)) { |
| dev_info(&client->dev, |
| "no 'ti,usb-charger-detection' property (err=%ld)\n", |
| PTR_ERR(bq->notify_psy)); |
| bq->notify_psy = NULL; |
| } else if (!bq->notify_psy) { |
| ret = -EPROBE_DEFER; |
| goto error_2; |
| } |
| } |
| else if (pdata->notify_device) |
| bq->notify_psy = power_supply_get_by_name(pdata->notify_device); |
| else |
| bq->notify_psy = NULL; |
| |
| i2c_set_clientdata(client, bq); |
| |
| bq->id = num; |
| bq->dev = &client->dev; |
| bq->chip = id->driver_data; |
| bq->name = name; |
| bq->mode = BQ2415X_MODE_OFF; |
| bq->reported_mode = BQ2415X_MODE_OFF; |
| bq->autotimer = 0; |
| bq->automode = 0; |
| |
| if (np) { |
| ret = of_property_read_u32(np, "ti,current-limit", |
| &bq->init_data.current_limit); |
| if (ret) |
| goto error_2; |
| ret = of_property_read_u32(np, "ti,weak-battery-voltage", |
| &bq->init_data.weak_battery_voltage); |
| if (ret) |
| goto error_2; |
| ret = of_property_read_u32(np, "ti,battery-regulation-voltage", |
| &bq->init_data.battery_regulation_voltage); |
| if (ret) |
| goto error_2; |
| ret = of_property_read_u32(np, "ti,charge-current", |
| &bq->init_data.charge_current); |
| if (ret) |
| goto error_2; |
| ret = of_property_read_u32(np, "ti,termination-current", |
| &bq->init_data.termination_current); |
| if (ret) |
| goto error_2; |
| ret = of_property_read_u32(np, "ti,resistor-sense", |
| &bq->init_data.resistor_sense); |
| if (ret) |
| goto error_2; |
| } else { |
| memcpy(&bq->init_data, pdata, sizeof(bq->init_data)); |
| } |
| |
| bq2415x_reset_chip(bq); |
| |
| ret = bq2415x_power_supply_init(bq); |
| if (ret) { |
| dev_err(bq->dev, "failed to register power supply: %d\n", ret); |
| goto error_2; |
| } |
| |
| ret = bq2415x_sysfs_init(bq); |
| if (ret) { |
| dev_err(bq->dev, "failed to create sysfs entries: %d\n", ret); |
| goto error_3; |
| } |
| |
| ret = bq2415x_set_defaults(bq); |
| if (ret) { |
| dev_err(bq->dev, "failed to set default values: %d\n", ret); |
| goto error_4; |
| } |
| |
| if (bq->notify_psy) { |
| bq->nb.notifier_call = bq2415x_notifier_call; |
| ret = power_supply_reg_notifier(&bq->nb); |
| if (ret) { |
| dev_err(bq->dev, "failed to reg notifier: %d\n", ret); |
| goto error_5; |
| } |
| |
| /* Query for initial reported_mode and set it */ |
| bq2415x_notifier_call(&bq->nb, PSY_EVENT_PROP_CHANGED, bq->notify_psy); |
| bq2415x_set_mode(bq, bq->reported_mode); |
| |
| bq->automode = 1; |
| dev_info(bq->dev, "automode enabled\n"); |
| } else { |
| bq->automode = -1; |
| dev_info(bq->dev, "automode not supported\n"); |
| } |
| |
| INIT_DELAYED_WORK(&bq->work, bq2415x_timer_work); |
| bq2415x_set_autotimer(bq, 1); |
| |
| dev_info(bq->dev, "driver registered\n"); |
| return 0; |
| |
| error_5: |
| error_4: |
| bq2415x_sysfs_exit(bq); |
| error_3: |
| bq2415x_power_supply_exit(bq); |
| error_2: |
| kfree(name); |
| error_1: |
| mutex_lock(&bq2415x_id_mutex); |
| idr_remove(&bq2415x_id, num); |
| mutex_unlock(&bq2415x_id_mutex); |
| |
| return ret; |
| } |
| |
| /* main bq2415x remove function */ |
| |
| static int bq2415x_remove(struct i2c_client *client) |
| { |
| struct bq2415x_device *bq = i2c_get_clientdata(client); |
| |
| if (bq->notify_psy) |
| power_supply_unreg_notifier(&bq->nb); |
| |
| bq2415x_sysfs_exit(bq); |
| bq2415x_power_supply_exit(bq); |
| |
| bq2415x_reset_chip(bq); |
| |
| mutex_lock(&bq2415x_id_mutex); |
| idr_remove(&bq2415x_id, bq->id); |
| mutex_unlock(&bq2415x_id_mutex); |
| |
| dev_info(bq->dev, "driver unregistered\n"); |
| |
| kfree(bq->name); |
| |
| return 0; |
| } |
| |
| static const struct i2c_device_id bq2415x_i2c_id_table[] = { |
| { "bq2415x", BQUNKNOWN }, |
| { "bq24150", BQ24150 }, |
| { "bq24150a", BQ24150A }, |
| { "bq24151", BQ24151 }, |
| { "bq24151a", BQ24151A }, |
| { "bq24152", BQ24152 }, |
| { "bq24153", BQ24153 }, |
| { "bq24153a", BQ24153A }, |
| { "bq24155", BQ24155 }, |
| { "bq24156", BQ24156 }, |
| { "bq24156a", BQ24156A }, |
| { "bq24157s", BQ24157S }, |
| { "bq24158", BQ24158 }, |
| {}, |
| }; |
| MODULE_DEVICE_TABLE(i2c, bq2415x_i2c_id_table); |
| |
| static struct i2c_driver bq2415x_driver = { |
| .driver = { |
| .name = "bq2415x-charger", |
| }, |
| .probe = bq2415x_probe, |
| .remove = bq2415x_remove, |
| .id_table = bq2415x_i2c_id_table, |
| }; |
| module_i2c_driver(bq2415x_driver); |
| |
| MODULE_AUTHOR("Pali Rohár <pali.rohar@gmail.com>"); |
| MODULE_DESCRIPTION("bq2415x charger driver"); |
| MODULE_LICENSE("GPL"); |