linux/drivers/power/bq2415x_charger.c
<<
>>
Prefs
   1/*
   2 * bq2415x charger driver
   3 *
   4 * Copyright (C) 2011-2012  Pali Rohár <pali.rohar@gmail.com>
   5 *
   6 * This program is free software; you can redistribute it and/or modify
   7 * it under the terms of the GNU General Public License as published by
   8 * the Free Software Foundation; either version 2 of the License, or
   9 * (at your option) any later version.
  10 *
  11 * This program is distributed in the hope that it will be useful,
  12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14 * GNU General Public License for more details.
  15 *
  16 * You should have received a copy of the GNU General Public License along
  17 * with this program; if not, write to the Free Software Foundation, Inc.,
  18 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  19 */
  20
  21/*
  22 * Datasheets:
  23 * http://www.ti.com/product/bq24150
  24 * http://www.ti.com/product/bq24150a
  25 * http://www.ti.com/product/bq24152
  26 * http://www.ti.com/product/bq24153
  27 * http://www.ti.com/product/bq24153a
  28 * http://www.ti.com/product/bq24155
  29 */
  30
  31#include <linux/kernel.h>
  32#include <linux/module.h>
  33#include <linux/param.h>
  34#include <linux/err.h>
  35#include <linux/workqueue.h>
  36#include <linux/sysfs.h>
  37#include <linux/platform_device.h>
  38#include <linux/power_supply.h>
  39#include <linux/idr.h>
  40#include <linux/i2c.h>
  41#include <linux/slab.h>
  42
  43#include <linux/power/bq2415x_charger.h>
  44
  45/* timeout for resetting chip timer */
  46#define BQ2415X_TIMER_TIMEOUT           10
  47
  48#define BQ2415X_REG_STATUS              0x00
  49#define BQ2415X_REG_CONTROL             0x01
  50#define BQ2415X_REG_VOLTAGE             0x02
  51#define BQ2415X_REG_VENDER              0x03
  52#define BQ2415X_REG_CURRENT             0x04
  53
  54/* reset state for all registers */
  55#define BQ2415X_RESET_STATUS            BIT(6)
  56#define BQ2415X_RESET_CONTROL           (BIT(4)|BIT(5))
  57#define BQ2415X_RESET_VOLTAGE           (BIT(1)|BIT(3))
  58#define BQ2415X_RESET_CURRENT           (BIT(0)|BIT(3)|BIT(7))
  59
  60/* status register */
  61#define BQ2415X_BIT_TMR_RST             7
  62#define BQ2415X_BIT_OTG                 7
  63#define BQ2415X_BIT_EN_STAT             6
  64#define BQ2415X_MASK_STAT               (BIT(4)|BIT(5))
  65#define BQ2415X_SHIFT_STAT              4
  66#define BQ2415X_BIT_BOOST               3
  67#define BQ2415X_MASK_FAULT              (BIT(0)|BIT(1)|BIT(2))
  68#define BQ2415X_SHIFT_FAULT             0
  69
  70/* control register */
  71#define BQ2415X_MASK_LIMIT              (BIT(6)|BIT(7))
  72#define BQ2415X_SHIFT_LIMIT             6
  73#define BQ2415X_MASK_VLOWV              (BIT(4)|BIT(5))
  74#define BQ2415X_SHIFT_VLOWV             4
  75#define BQ2415X_BIT_TE                  3
  76#define BQ2415X_BIT_CE                  2
  77#define BQ2415X_BIT_HZ_MODE             1
  78#define BQ2415X_BIT_OPA_MODE            0
  79
  80/* voltage register */
  81#define BQ2415X_MASK_VO         (BIT(2)|BIT(3)|BIT(4)|BIT(5)|BIT(6)|BIT(7))
  82#define BQ2415X_SHIFT_VO                2
  83#define BQ2415X_BIT_OTG_PL              1
  84#define BQ2415X_BIT_OTG_EN              0
  85
  86/* vender register */
  87#define BQ2415X_MASK_VENDER             (BIT(5)|BIT(6)|BIT(7))
  88#define BQ2415X_SHIFT_VENDER            5
  89#define BQ2415X_MASK_PN                 (BIT(3)|BIT(4))
  90#define BQ2415X_SHIFT_PN                3
  91#define BQ2415X_MASK_REVISION           (BIT(0)|BIT(1)|BIT(2))
  92#define BQ2415X_SHIFT_REVISION          0
  93
  94/* current register */
  95#define BQ2415X_MASK_RESET              BIT(7)
  96#define BQ2415X_MASK_VI_CHRG            (BIT(4)|BIT(5)|BIT(6))
  97#define BQ2415X_SHIFT_VI_CHRG           4
  98/* N/A                                  BIT(3) */
  99#define BQ2415X_MASK_VI_TERM            (BIT(0)|BIT(1)|BIT(2))
 100#define BQ2415X_SHIFT_VI_TERM           0
 101
 102
 103enum bq2415x_command {
 104        BQ2415X_TIMER_RESET,
 105        BQ2415X_OTG_STATUS,
 106        BQ2415X_STAT_PIN_STATUS,
 107        BQ2415X_STAT_PIN_ENABLE,
 108        BQ2415X_STAT_PIN_DISABLE,
 109        BQ2415X_CHARGE_STATUS,
 110        BQ2415X_BOOST_STATUS,
 111        BQ2415X_FAULT_STATUS,
 112
 113        BQ2415X_CHARGE_TERMINATION_STATUS,
 114        BQ2415X_CHARGE_TERMINATION_ENABLE,
 115        BQ2415X_CHARGE_TERMINATION_DISABLE,
 116        BQ2415X_CHARGER_STATUS,
 117        BQ2415X_CHARGER_ENABLE,
 118        BQ2415X_CHARGER_DISABLE,
 119        BQ2415X_HIGH_IMPEDANCE_STATUS,
 120        BQ2415X_HIGH_IMPEDANCE_ENABLE,
 121        BQ2415X_HIGH_IMPEDANCE_DISABLE,
 122        BQ2415X_BOOST_MODE_STATUS,
 123        BQ2415X_BOOST_MODE_ENABLE,
 124        BQ2415X_BOOST_MODE_DISABLE,
 125
 126        BQ2415X_OTG_LEVEL,
 127        BQ2415X_OTG_ACTIVATE_HIGH,
 128        BQ2415X_OTG_ACTIVATE_LOW,
 129        BQ2415X_OTG_PIN_STATUS,
 130        BQ2415X_OTG_PIN_ENABLE,
 131        BQ2415X_OTG_PIN_DISABLE,
 132
 133        BQ2415X_VENDER_CODE,
 134        BQ2415X_PART_NUMBER,
 135        BQ2415X_REVISION,
 136};
 137
 138enum bq2415x_chip {
 139        BQUNKNOWN,
 140        BQ24150,
 141        BQ24150A,
 142        BQ24151,
 143        BQ24151A,
 144        BQ24152,
 145        BQ24153,
 146        BQ24153A,
 147        BQ24155,
 148        BQ24156,
 149        BQ24156A,
 150        BQ24158,
 151};
 152
 153static char *bq2415x_chip_name[] = {
 154        "unknown",
 155        "bq24150",
 156        "bq24150a",
 157        "bq24151",
 158        "bq24151a",
 159        "bq24152",
 160        "bq24153",
 161        "bq24153a",
 162        "bq24155",
 163        "bq24156",
 164        "bq24156a",
 165        "bq24158",
 166};
 167
 168struct bq2415x_device {
 169        struct device *dev;
 170        struct bq2415x_platform_data init_data;
 171        struct power_supply charger;
 172        struct delayed_work work;
 173        enum bq2415x_mode reported_mode;/* mode reported by hook function */
 174        enum bq2415x_mode mode;         /* current configured mode */
 175        enum bq2415x_chip chip;
 176        const char *timer_error;
 177        char *model;
 178        char *name;
 179        int autotimer;  /* 1 - if driver automatically reset timer, 0 - not */
 180        int automode;   /* 1 - enabled, 0 - disabled; -1 - not supported */
 181        int id;
 182};
 183
 184/* each registered chip must have unique id */
 185static DEFINE_IDR(bq2415x_id);
 186
 187static DEFINE_MUTEX(bq2415x_id_mutex);
 188static DEFINE_MUTEX(bq2415x_timer_mutex);
 189static DEFINE_MUTEX(bq2415x_i2c_mutex);
 190
 191/**** i2c read functions ****/
 192
 193/* read value from register */
 194static int bq2415x_i2c_read(struct bq2415x_device *bq, u8 reg)
 195{
 196        struct i2c_client *client = to_i2c_client(bq->dev);
 197        struct i2c_msg msg[2];
 198        u8 val;
 199        int ret;
 200
 201        if (!client->adapter)
 202                return -ENODEV;
 203
 204        msg[0].addr = client->addr;
 205        msg[0].flags = 0;
 206        msg[0].buf = &reg;
 207        msg[0].len = sizeof(reg);
 208        msg[1].addr = client->addr;
 209        msg[1].flags = I2C_M_RD;
 210        msg[1].buf = &val;
 211        msg[1].len = sizeof(val);
 212
 213        mutex_lock(&bq2415x_i2c_mutex);
 214        ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
 215        mutex_unlock(&bq2415x_i2c_mutex);
 216
 217        if (ret < 0)
 218                return ret;
 219
 220        return val;
 221}
 222
 223/* read value from register, apply mask and right shift it */
 224static int bq2415x_i2c_read_mask(struct bq2415x_device *bq, u8 reg,
 225                                 u8 mask, u8 shift)
 226{
 227        int ret;
 228
 229        if (shift > 8)
 230                return -EINVAL;
 231
 232        ret = bq2415x_i2c_read(bq, reg);
 233        if (ret < 0)
 234                return ret;
 235        return (ret & mask) >> shift;
 236}
 237
 238/* read value from register and return one specified bit */
 239static int bq2415x_i2c_read_bit(struct bq2415x_device *bq, u8 reg, u8 bit)
 240{
 241        if (bit > 8)
 242                return -EINVAL;
 243        return bq2415x_i2c_read_mask(bq, reg, BIT(bit), bit);
 244}
 245
 246/**** i2c write functions ****/
 247
 248/* write value to register */
 249static int bq2415x_i2c_write(struct bq2415x_device *bq, u8 reg, u8 val)
 250{
 251        struct i2c_client *client = to_i2c_client(bq->dev);
 252        struct i2c_msg msg[1];
 253        u8 data[2];
 254        int ret;
 255
 256        data[0] = reg;
 257        data[1] = val;
 258
 259        msg[0].addr = client->addr;
 260        msg[0].flags = 0;
 261        msg[0].buf = data;
 262        msg[0].len = ARRAY_SIZE(data);
 263
 264        mutex_lock(&bq2415x_i2c_mutex);
 265        ret = i2c_transfer(client->adapter, msg, ARRAY_SIZE(msg));
 266        mutex_unlock(&bq2415x_i2c_mutex);
 267
 268        /* i2c_transfer returns number of messages transferred */
 269        if (ret < 0)
 270                return ret;
 271        else if (ret != 1)
 272                return -EIO;
 273
 274        return 0;
 275}
 276
 277/* read value from register, change it with mask left shifted and write back */
 278static int bq2415x_i2c_write_mask(struct bq2415x_device *bq, u8 reg, u8 val,
 279                                  u8 mask, u8 shift)
 280{
 281        int ret;
 282
 283        if (shift > 8)
 284                return -EINVAL;
 285
 286        ret = bq2415x_i2c_read(bq, reg);
 287        if (ret < 0)
 288                return ret;
 289
 290        ret &= ~mask;
 291        ret |= val << shift;
 292
 293        return bq2415x_i2c_write(bq, reg, ret);
 294}
 295
 296/* change only one bit in register */
 297static int bq2415x_i2c_write_bit(struct bq2415x_device *bq, u8 reg,
 298                                 bool val, u8 bit)
 299{
 300        if (bit > 8)
 301                return -EINVAL;
 302        return bq2415x_i2c_write_mask(bq, reg, val, BIT(bit), bit);
 303}
 304
 305/**** global functions ****/
 306
 307/* exec command function */
 308static int bq2415x_exec_command(struct bq2415x_device *bq,
 309                                enum bq2415x_command command)
 310{
 311        int ret;
 312
 313        switch (command) {
 314        case BQ2415X_TIMER_RESET:
 315                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS,
 316                                1, BQ2415X_BIT_TMR_RST);
 317        case BQ2415X_OTG_STATUS:
 318                return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
 319                                BQ2415X_BIT_OTG);
 320        case BQ2415X_STAT_PIN_STATUS:
 321                return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
 322                                BQ2415X_BIT_EN_STAT);
 323        case BQ2415X_STAT_PIN_ENABLE:
 324                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 1,
 325                                BQ2415X_BIT_EN_STAT);
 326        case BQ2415X_STAT_PIN_DISABLE:
 327                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_STATUS, 0,
 328                                BQ2415X_BIT_EN_STAT);
 329        case BQ2415X_CHARGE_STATUS:
 330                return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS,
 331                                BQ2415X_MASK_STAT, BQ2415X_SHIFT_STAT);
 332        case BQ2415X_BOOST_STATUS:
 333                return bq2415x_i2c_read_bit(bq, BQ2415X_REG_STATUS,
 334                                BQ2415X_BIT_BOOST);
 335        case BQ2415X_FAULT_STATUS:
 336                return bq2415x_i2c_read_mask(bq, BQ2415X_REG_STATUS,
 337                        BQ2415X_MASK_FAULT, BQ2415X_SHIFT_FAULT);
 338
 339        case BQ2415X_CHARGE_TERMINATION_STATUS:
 340                return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
 341                                BQ2415X_BIT_TE);
 342        case BQ2415X_CHARGE_TERMINATION_ENABLE:
 343                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
 344                                1, BQ2415X_BIT_TE);
 345        case BQ2415X_CHARGE_TERMINATION_DISABLE:
 346                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
 347                                0, BQ2415X_BIT_TE);
 348        case BQ2415X_CHARGER_STATUS:
 349                ret = bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
 350                        BQ2415X_BIT_CE);
 351                if (ret < 0)
 352                        return ret;
 353                else
 354                        return ret > 0 ? 0 : 1;
 355        case BQ2415X_CHARGER_ENABLE:
 356                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
 357                                0, BQ2415X_BIT_CE);
 358        case BQ2415X_CHARGER_DISABLE:
 359                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
 360                                1, BQ2415X_BIT_CE);
 361        case BQ2415X_HIGH_IMPEDANCE_STATUS:
 362                return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
 363                                BQ2415X_BIT_HZ_MODE);
 364        case BQ2415X_HIGH_IMPEDANCE_ENABLE:
 365                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
 366                                1, BQ2415X_BIT_HZ_MODE);
 367        case BQ2415X_HIGH_IMPEDANCE_DISABLE:
 368                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
 369                                0, BQ2415X_BIT_HZ_MODE);
 370        case BQ2415X_BOOST_MODE_STATUS:
 371                return bq2415x_i2c_read_bit(bq, BQ2415X_REG_CONTROL,
 372                                BQ2415X_BIT_OPA_MODE);
 373        case BQ2415X_BOOST_MODE_ENABLE:
 374                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
 375                                1, BQ2415X_BIT_OPA_MODE);
 376        case BQ2415X_BOOST_MODE_DISABLE:
 377                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_CONTROL,
 378                                0, BQ2415X_BIT_OPA_MODE);
 379
 380        case BQ2415X_OTG_LEVEL:
 381                return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE,
 382                                BQ2415X_BIT_OTG_PL);
 383        case BQ2415X_OTG_ACTIVATE_HIGH:
 384                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
 385                                1, BQ2415X_BIT_OTG_PL);
 386        case BQ2415X_OTG_ACTIVATE_LOW:
 387                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
 388                                0, BQ2415X_BIT_OTG_PL);
 389        case BQ2415X_OTG_PIN_STATUS:
 390                return bq2415x_i2c_read_bit(bq, BQ2415X_REG_VOLTAGE,
 391                                BQ2415X_BIT_OTG_EN);
 392        case BQ2415X_OTG_PIN_ENABLE:
 393                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
 394                                1, BQ2415X_BIT_OTG_EN);
 395        case BQ2415X_OTG_PIN_DISABLE:
 396                return bq2415x_i2c_write_bit(bq, BQ2415X_REG_VOLTAGE,
 397                                0, BQ2415X_BIT_OTG_EN);
 398
 399        case BQ2415X_VENDER_CODE:
 400                return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
 401                        BQ2415X_MASK_VENDER, BQ2415X_SHIFT_VENDER);
 402        case BQ2415X_PART_NUMBER:
 403                return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
 404                                BQ2415X_MASK_PN, BQ2415X_SHIFT_PN);
 405        case BQ2415X_REVISION:
 406                return bq2415x_i2c_read_mask(bq, BQ2415X_REG_VENDER,
 407                        BQ2415X_MASK_REVISION, BQ2415X_SHIFT_REVISION);
 408        }
 409        return -EINVAL;
 410}
 411
 412/* detect chip type */
 413static enum bq2415x_chip bq2415x_detect_chip(struct bq2415x_device *bq)
 414{
 415        struct i2c_client *client = to_i2c_client(bq->dev);
 416        int ret = bq2415x_exec_command(bq, BQ2415X_PART_NUMBER);
 417
 418        if (ret < 0)
 419                return ret;
 420
 421        switch (client->addr) {
 422        case 0x6b:
 423                switch (ret) {
 424                case 0:
 425                        if (bq->chip == BQ24151A)
 426                                return bq->chip;
 427                        else
 428                                return BQ24151;
 429                case 1:
 430                        if (bq->chip == BQ24150A ||
 431                                bq->chip == BQ24152 ||
 432                                bq->chip == BQ24155)
 433                                return bq->chip;
 434                        else
 435                                return BQ24150;
 436                case 2:
 437                        if (bq->chip == BQ24153A)
 438                                return bq->chip;
 439                        else
 440                                return BQ24153;
 441                default:
 442                        return BQUNKNOWN;
 443                }
 444                break;
 445
 446        case 0x6a:
 447                switch (ret) {
 448                case 0:
 449                        if (bq->chip == BQ24156A)
 450                                return bq->chip;
 451                        else
 452                                return BQ24156;
 453                case 2:
 454                        return BQ24158;
 455                default:
 456                        return BQUNKNOWN;
 457                }
 458                break;
 459        }
 460
 461        return BQUNKNOWN;
 462}
 463
 464/* detect chip revision */
 465static int bq2415x_detect_revision(struct bq2415x_device *bq)
 466{
 467        int ret = bq2415x_exec_command(bq, BQ2415X_REVISION);
 468        int chip = bq2415x_detect_chip(bq);
 469
 470        if (ret < 0 || chip < 0)
 471                return -1;
 472
 473        switch (chip) {
 474        case BQ24150:
 475        case BQ24150A:
 476        case BQ24151:
 477        case BQ24151A:
 478        case BQ24152:
 479                if (ret >= 0 && ret <= 3)
 480                        return ret;
 481                else
 482                        return -1;
 483        case BQ24153:
 484        case BQ24153A:
 485        case BQ24156:
 486        case BQ24156A:
 487        case BQ24158:
 488                if (ret == 3)
 489                        return 0;
 490                else if (ret == 1)
 491                        return 1;
 492                else
 493                        return -1;
 494        case BQ24155:
 495                if (ret == 3)
 496                        return 3;
 497                else
 498                        return -1;
 499        case BQUNKNOWN:
 500                return -1;
 501        }
 502
 503        return -1;
 504}
 505
 506/* return chip vender code */
 507static int bq2415x_get_vender_code(struct bq2415x_device *bq)
 508{
 509        int ret;
 510
 511        ret = bq2415x_exec_command(bq, BQ2415X_VENDER_CODE);
 512        if (ret < 0)
 513                return 0;
 514
 515        /* convert to binary */
 516        return (ret & 0x1) +
 517               ((ret >> 1) & 0x1) * 10 +
 518               ((ret >> 2) & 0x1) * 100;
 519}
 520
 521/* reset all chip registers to default state */
 522static void bq2415x_reset_chip(struct bq2415x_device *bq)
 523{
 524        bq2415x_i2c_write(bq, BQ2415X_REG_CURRENT, BQ2415X_RESET_CURRENT);
 525        bq2415x_i2c_write(bq, BQ2415X_REG_VOLTAGE, BQ2415X_RESET_VOLTAGE);
 526        bq2415x_i2c_write(bq, BQ2415X_REG_CONTROL, BQ2415X_RESET_CONTROL);
 527        bq2415x_i2c_write(bq, BQ2415X_REG_STATUS, BQ2415X_RESET_STATUS);
 528        bq->timer_error = NULL;
 529}
 530
 531/**** properties functions ****/
 532
 533/* set current limit in mA */
 534static int bq2415x_set_current_limit(struct bq2415x_device *bq, int mA)
 535{
 536        int val;
 537
 538        if (mA <= 100)
 539                val = 0;
 540        else if (mA <= 500)
 541                val = 1;
 542        else if (mA <= 800)
 543                val = 2;
 544        else
 545                val = 3;
 546
 547        return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
 548                        BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
 549}
 550
 551/* get current limit in mA */
 552static int bq2415x_get_current_limit(struct bq2415x_device *bq)
 553{
 554        int ret;
 555
 556        ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
 557                        BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
 558        if (ret < 0)
 559                return ret;
 560        else if (ret == 0)
 561                return 100;
 562        else if (ret == 1)
 563                return 500;
 564        else if (ret == 2)
 565                return 800;
 566        else if (ret == 3)
 567                return 1800;
 568        return -EINVAL;
 569}
 570
 571/* set weak battery voltage in mV */
 572static int bq2415x_set_weak_battery_voltage(struct bq2415x_device *bq, int mV)
 573{
 574        int val;
 575
 576        /* round to 100mV */
 577        if (mV <= 3400 + 50)
 578                val = 0;
 579        else if (mV <= 3500 + 50)
 580                val = 1;
 581        else if (mV <= 3600 + 50)
 582                val = 2;
 583        else
 584                val = 3;
 585
 586        return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
 587                        BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
 588}
 589
 590/* get weak battery voltage in mV */
 591static int bq2415x_get_weak_battery_voltage(struct bq2415x_device *bq)
 592{
 593        int ret;
 594
 595        ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
 596                        BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
 597        if (ret < 0)
 598                return ret;
 599        return 100 * (34 + ret);
 600}
 601
 602/* set battery regulation voltage in mV */
 603static int bq2415x_set_battery_regulation_voltage(struct bq2415x_device *bq,
 604                                                  int mV)
 605{
 606        int val = (mV/10 - 350) / 2;
 607
 608        if (val < 0)
 609                val = 0;
 610        else if (val > 94) /* FIXME: Max is 94 or 122 ? Set max value ? */
 611                return -EINVAL;
 612
 613        return bq2415x_i2c_write_mask(bq, BQ2415X_REG_VOLTAGE, val,
 614                        BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
 615}
 616
 617/* get battery regulation voltage in mV */
 618static int bq2415x_get_battery_regulation_voltage(struct bq2415x_device *bq)
 619{
 620        int ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_VOLTAGE,
 621                        BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
 622
 623        if (ret < 0)
 624                return ret;
 625        return 10 * (350 + 2*ret);
 626}
 627
 628/* set charge current in mA (platform data must provide resistor sense) */
 629static int bq2415x_set_charge_current(struct bq2415x_device *bq, int mA)
 630{
 631        int val;
 632
 633        if (bq->init_data.resistor_sense <= 0)
 634                return -ENOSYS;
 635
 636        val = (mA * bq->init_data.resistor_sense - 37400) / 6800;
 637        if (val < 0)
 638                val = 0;
 639        else if (val > 7)
 640                val = 7;
 641
 642        return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
 643                        BQ2415X_MASK_VI_CHRG | BQ2415X_MASK_RESET,
 644                        BQ2415X_SHIFT_VI_CHRG);
 645}
 646
 647/* get charge current in mA (platform data must provide resistor sense) */
 648static int bq2415x_get_charge_current(struct bq2415x_device *bq)
 649{
 650        int ret;
 651
 652        if (bq->init_data.resistor_sense <= 0)
 653                return -ENOSYS;
 654
 655        ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
 656                        BQ2415X_MASK_VI_CHRG, BQ2415X_SHIFT_VI_CHRG);
 657        if (ret < 0)
 658                return ret;
 659        return (37400 + 6800*ret) / bq->init_data.resistor_sense;
 660}
 661
 662/* set termination current in mA (platform data must provide resistor sense) */
 663static int bq2415x_set_termination_current(struct bq2415x_device *bq, int mA)
 664{
 665        int val;
 666
 667        if (bq->init_data.resistor_sense <= 0)
 668                return -ENOSYS;
 669
 670        val = (mA * bq->init_data.resistor_sense - 3400) / 3400;
 671        if (val < 0)
 672                val = 0;
 673        else if (val > 7)
 674                val = 7;
 675
 676        return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
 677                        BQ2415X_MASK_VI_TERM | BQ2415X_MASK_RESET,
 678                        BQ2415X_SHIFT_VI_TERM);
 679}
 680
 681/* get termination current in mA (platform data must provide resistor sense) */
 682static int bq2415x_get_termination_current(struct bq2415x_device *bq)
 683{
 684        int ret;
 685
 686        if (bq->init_data.resistor_sense <= 0)
 687                return -ENOSYS;
 688
 689        ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
 690                        BQ2415X_MASK_VI_TERM, BQ2415X_SHIFT_VI_TERM);
 691        if (ret < 0)
 692                return ret;
 693        return (3400 + 3400*ret) / bq->init_data.resistor_sense;
 694}
 695
 696/* set default value of property */
 697#define bq2415x_set_default_value(bq, prop) \
 698        do { \
 699                int ret = 0; \
 700                if (bq->init_data.prop != -1) \
 701                        ret = bq2415x_set_##prop(bq, bq->init_data.prop); \
 702                if (ret < 0) \
 703                        return ret; \
 704        } while (0)
 705
 706/* set default values of all properties */
 707static int bq2415x_set_defaults(struct bq2415x_device *bq)
 708{
 709        bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
 710        bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
 711        bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_DISABLE);
 712
 713        bq2415x_set_default_value(bq, current_limit);
 714        bq2415x_set_default_value(bq, weak_battery_voltage);
 715        bq2415x_set_default_value(bq, battery_regulation_voltage);
 716
 717        if (bq->init_data.resistor_sense > 0) {
 718                bq2415x_set_default_value(bq, charge_current);
 719                bq2415x_set_default_value(bq, termination_current);
 720                bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_ENABLE);
 721        }
 722
 723        bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
 724        return 0;
 725}
 726
 727/**** charger mode functions ****/
 728
 729/* set charger mode */
 730static int bq2415x_set_mode(struct bq2415x_device *bq, enum bq2415x_mode mode)
 731{
 732        int ret = 0;
 733        int charger = 0;
 734        int boost = 0;
 735
 736        if (mode == BQ2415X_MODE_BOOST)
 737                boost = 1;
 738        else if (mode != BQ2415X_MODE_OFF)
 739                charger = 1;
 740
 741        if (!charger)
 742                ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
 743
 744        if (!boost)
 745                ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
 746
 747        if (ret < 0)
 748                return ret;
 749
 750        switch (mode) {
 751        case BQ2415X_MODE_OFF:
 752                dev_dbg(bq->dev, "changing mode to: Offline\n");
 753                ret = bq2415x_set_current_limit(bq, 100);
 754                break;
 755        case BQ2415X_MODE_NONE:
 756                dev_dbg(bq->dev, "changing mode to: N/A\n");
 757                ret = bq2415x_set_current_limit(bq, 100);
 758                break;
 759        case BQ2415X_MODE_HOST_CHARGER:
 760                dev_dbg(bq->dev, "changing mode to: Host/HUB charger\n");
 761                ret = bq2415x_set_current_limit(bq, 500);
 762                break;
 763        case BQ2415X_MODE_DEDICATED_CHARGER:
 764                dev_dbg(bq->dev, "changing mode to: Dedicated charger\n");
 765                ret = bq2415x_set_current_limit(bq, 1800);
 766                break;
 767        case BQ2415X_MODE_BOOST: /* Boost mode */
 768                dev_dbg(bq->dev, "changing mode to: Boost\n");
 769                ret = bq2415x_set_current_limit(bq, 100);
 770                break;
 771        }
 772
 773        if (ret < 0)
 774                return ret;
 775
 776        if (charger)
 777                ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
 778        else if (boost)
 779                ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_ENABLE);
 780
 781        if (ret < 0)
 782                return ret;
 783
 784        bq2415x_set_default_value(bq, weak_battery_voltage);
 785        bq2415x_set_default_value(bq, battery_regulation_voltage);
 786
 787        bq->mode = mode;
 788        sysfs_notify(&bq->charger.dev->kobj, NULL, "mode");
 789
 790        return 0;
 791
 792}
 793
 794/* hook function called by other driver which set reported mode */
 795static void bq2415x_hook_function(enum bq2415x_mode mode, void *data)
 796{
 797        struct bq2415x_device *bq = data;
 798
 799        if (!bq)
 800                return;
 801
 802        dev_dbg(bq->dev, "hook function was called\n");
 803        bq->reported_mode = mode;
 804
 805        /* if automode is not enabled do not tell about reported_mode */
 806        if (bq->automode < 1)
 807                return;
 808
 809        sysfs_notify(&bq->charger.dev->kobj, NULL, "reported_mode");
 810        bq2415x_set_mode(bq, bq->reported_mode);
 811
 812}
 813
 814/**** timer functions ****/
 815
 816/* enable/disable auto resetting chip timer */
 817static void bq2415x_set_autotimer(struct bq2415x_device *bq, int state)
 818{
 819        mutex_lock(&bq2415x_timer_mutex);
 820
 821        if (bq->autotimer == state) {
 822                mutex_unlock(&bq2415x_timer_mutex);
 823                return;
 824        }
 825
 826        bq->autotimer = state;
 827
 828        if (state) {
 829                schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
 830                bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
 831                bq->timer_error = NULL;
 832        } else {
 833                cancel_delayed_work_sync(&bq->work);
 834        }
 835
 836        mutex_unlock(&bq2415x_timer_mutex);
 837}
 838
 839/* called by bq2415x_timer_work on timer error */
 840static void bq2415x_timer_error(struct bq2415x_device *bq, const char *msg)
 841{
 842        bq->timer_error = msg;
 843        sysfs_notify(&bq->charger.dev->kobj, NULL, "timer");
 844        dev_err(bq->dev, "%s\n", msg);
 845        if (bq->automode > 0)
 846                bq->automode = 0;
 847        bq2415x_set_mode(bq, BQ2415X_MODE_OFF);
 848        bq2415x_set_autotimer(bq, 0);
 849}
 850
 851/* delayed work function for auto resetting chip timer */
 852static void bq2415x_timer_work(struct work_struct *work)
 853{
 854        struct bq2415x_device *bq = container_of(work, struct bq2415x_device,
 855                                                 work.work);
 856        int ret;
 857        int error;
 858        int boost;
 859
 860        if (!bq->autotimer)
 861                return;
 862
 863        ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
 864        if (ret < 0) {
 865                bq2415x_timer_error(bq, "Resetting timer failed");
 866                return;
 867        }
 868
 869        boost = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_STATUS);
 870        if (boost < 0) {
 871                bq2415x_timer_error(bq, "Unknown error");
 872                return;
 873        }
 874
 875        error = bq2415x_exec_command(bq, BQ2415X_FAULT_STATUS);
 876        if (error < 0) {
 877                bq2415x_timer_error(bq, "Unknown error");
 878                return;
 879        }
 880
 881        if (boost) {
 882                switch (error) {
 883                /* Non fatal errors, chip is OK */
 884                case 0: /* No error */
 885                        break;
 886                case 6: /* Timer expired */
 887                        dev_err(bq->dev, "Timer expired\n");
 888                        break;
 889                case 3: /* Battery voltage too low */
 890                        dev_err(bq->dev, "Battery voltage to low\n");
 891                        break;
 892
 893                /* Fatal errors, disable and reset chip */
 894                case 1: /* Overvoltage protection (chip fried) */
 895                        bq2415x_timer_error(bq,
 896                                "Overvoltage protection (chip fried)");
 897                        return;
 898                case 2: /* Overload */
 899                        bq2415x_timer_error(bq, "Overload");
 900                        return;
 901                case 4: /* Battery overvoltage protection */
 902                        bq2415x_timer_error(bq,
 903                                "Battery overvoltage protection");
 904                        return;
 905                case 5: /* Thermal shutdown (too hot) */
 906                        bq2415x_timer_error(bq,
 907                                        "Thermal shutdown (too hot)");
 908                        return;
 909                case 7: /* N/A */
 910                        bq2415x_timer_error(bq, "Unknown error");
 911                        return;
 912                }
 913        } else {
 914                switch (error) {
 915                /* Non fatal errors, chip is OK */
 916                case 0: /* No error */
 917                        break;
 918                case 2: /* Sleep mode */
 919                        dev_err(bq->dev, "Sleep mode\n");
 920                        break;
 921                case 3: /* Poor input source */
 922                        dev_err(bq->dev, "Poor input source\n");
 923                        break;
 924                case 6: /* Timer expired */
 925                        dev_err(bq->dev, "Timer expired\n");
 926                        break;
 927                case 7: /* No battery */
 928                        dev_err(bq->dev, "No battery\n");
 929                        break;
 930
 931                /* Fatal errors, disable and reset chip */
 932                case 1: /* Overvoltage protection (chip fried) */
 933                        bq2415x_timer_error(bq,
 934                                "Overvoltage protection (chip fried)");
 935                        return;
 936                case 4: /* Battery overvoltage protection */
 937                        bq2415x_timer_error(bq,
 938                                "Battery overvoltage protection");
 939                        return;
 940                case 5: /* Thermal shutdown (too hot) */
 941                        bq2415x_timer_error(bq,
 942                                "Thermal shutdown (too hot)");
 943                        return;
 944                }
 945        }
 946
 947        schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
 948}
 949
 950/**** power supply interface code ****/
 951
 952static enum power_supply_property bq2415x_power_supply_props[] = {
 953        /* TODO: maybe add more power supply properties */
 954        POWER_SUPPLY_PROP_STATUS,
 955        POWER_SUPPLY_PROP_MODEL_NAME,
 956};
 957
 958static int bq2415x_power_supply_get_property(struct power_supply *psy,
 959                                             enum power_supply_property psp,
 960                                             union power_supply_propval *val)
 961{
 962        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
 963                                                 charger);
 964        int ret;
 965
 966        switch (psp) {
 967        case POWER_SUPPLY_PROP_STATUS:
 968                ret = bq2415x_exec_command(bq, BQ2415X_CHARGE_STATUS);
 969                if (ret < 0)
 970                        return ret;
 971                else if (ret == 0) /* Ready */
 972                        val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
 973                else if (ret == 1) /* Charge in progress */
 974                        val->intval = POWER_SUPPLY_STATUS_CHARGING;
 975                else if (ret == 2) /* Charge done */
 976                        val->intval = POWER_SUPPLY_STATUS_FULL;
 977                else
 978                        val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
 979                break;
 980        case POWER_SUPPLY_PROP_MODEL_NAME:
 981                val->strval = bq->model;
 982                break;
 983        default:
 984                return -EINVAL;
 985        }
 986        return 0;
 987}
 988
 989static int bq2415x_power_supply_init(struct bq2415x_device *bq)
 990{
 991        int ret;
 992        int chip;
 993        char revstr[8];
 994
 995        bq->charger.name = bq->name;
 996        bq->charger.type = POWER_SUPPLY_TYPE_USB;
 997        bq->charger.properties = bq2415x_power_supply_props;
 998        bq->charger.num_properties = ARRAY_SIZE(bq2415x_power_supply_props);
 999        bq->charger.get_property = bq2415x_power_supply_get_property;
1000
1001        ret = bq2415x_detect_chip(bq);
1002        if (ret < 0)
1003                chip = BQUNKNOWN;
1004        else
1005                chip = ret;
1006
1007        ret = bq2415x_detect_revision(bq);
1008        if (ret < 0)
1009                strcpy(revstr, "unknown");
1010        else
1011                sprintf(revstr, "1.%d", ret);
1012
1013        bq->model = kasprintf(GFP_KERNEL,
1014                                "chip %s, revision %s, vender code %.3d",
1015                                bq2415x_chip_name[chip], revstr,
1016                                bq2415x_get_vender_code(bq));
1017        if (!bq->model) {
1018                dev_err(bq->dev, "failed to allocate model name\n");
1019                return -ENOMEM;
1020        }
1021
1022        ret = power_supply_register(bq->dev, &bq->charger);
1023        if (ret) {
1024                kfree(bq->model);
1025                return ret;
1026        }
1027
1028        return 0;
1029}
1030
1031static void bq2415x_power_supply_exit(struct bq2415x_device *bq)
1032{
1033        bq->autotimer = 0;
1034        if (bq->automode > 0)
1035                bq->automode = 0;
1036        cancel_delayed_work_sync(&bq->work);
1037        power_supply_unregister(&bq->charger);
1038        kfree(bq->model);
1039}
1040
1041/**** additional sysfs entries for power supply interface ****/
1042
1043/* show *_status entries */
1044static ssize_t bq2415x_sysfs_show_status(struct device *dev,
1045                                         struct device_attribute *attr,
1046                                         char *buf)
1047{
1048        struct power_supply *psy = dev_get_drvdata(dev);
1049        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1050                                                charger);
1051        enum bq2415x_command command;
1052        int ret;
1053
1054        if (strcmp(attr->attr.name, "otg_status") == 0)
1055                command = BQ2415X_OTG_STATUS;
1056        else if (strcmp(attr->attr.name, "charge_status") == 0)
1057                command = BQ2415X_CHARGE_STATUS;
1058        else if (strcmp(attr->attr.name, "boost_status") == 0)
1059                command = BQ2415X_BOOST_STATUS;
1060        else if (strcmp(attr->attr.name, "fault_status") == 0)
1061                command = BQ2415X_FAULT_STATUS;
1062        else
1063                return -EINVAL;
1064
1065        ret = bq2415x_exec_command(bq, command);
1066        if (ret < 0)
1067                return ret;
1068        return sprintf(buf, "%d\n", ret);
1069}
1070
1071/*
1072 * set timer entry:
1073 *    auto - enable auto mode
1074 *    off - disable auto mode
1075 *    (other values) - reset chip timer
1076 */
1077static ssize_t bq2415x_sysfs_set_timer(struct device *dev,
1078                                       struct device_attribute *attr,
1079                                       const char *buf,
1080                                       size_t count)
1081{
1082        struct power_supply *psy = dev_get_drvdata(dev);
1083        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1084                                                charger);
1085        int ret = 0;
1086
1087        if (strncmp(buf, "auto", 4) == 0)
1088                bq2415x_set_autotimer(bq, 1);
1089        else if (strncmp(buf, "off", 3) == 0)
1090                bq2415x_set_autotimer(bq, 0);
1091        else
1092                ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
1093
1094        if (ret < 0)
1095                return ret;
1096        return count;
1097}
1098
1099/* show timer entry (auto or off) */
1100static ssize_t bq2415x_sysfs_show_timer(struct device *dev,
1101                                        struct device_attribute *attr,
1102                                        char *buf)
1103{
1104        struct power_supply *psy = dev_get_drvdata(dev);
1105        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1106                                                 charger);
1107
1108        if (bq->timer_error)
1109                return sprintf(buf, "%s\n", bq->timer_error);
1110
1111        if (bq->autotimer)
1112                return sprintf(buf, "auto\n");
1113        return sprintf(buf, "off\n");
1114}
1115
1116/*
1117 * set mode entry:
1118 *    auto - if automode is supported, enable it and set mode to reported
1119 *    none - disable charger and boost mode
1120 *    host - charging mode for host/hub chargers (current limit 500mA)
1121 *    dedicated - charging mode for dedicated chargers (unlimited current limit)
1122 *    boost - disable charger and enable boost mode
1123 */
1124static ssize_t bq2415x_sysfs_set_mode(struct device *dev,
1125                                      struct device_attribute *attr,
1126                                      const char *buf,
1127                                      size_t count)
1128{
1129        struct power_supply *psy = dev_get_drvdata(dev);
1130        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1131                                                 charger);
1132        enum bq2415x_mode mode;
1133        int ret = 0;
1134
1135        if (strncmp(buf, "auto", 4) == 0) {
1136                if (bq->automode < 0)
1137                        return -ENOSYS;
1138                bq->automode = 1;
1139                mode = bq->reported_mode;
1140        } else if (strncmp(buf, "off", 3) == 0) {
1141                if (bq->automode > 0)
1142                        bq->automode = 0;
1143                mode = BQ2415X_MODE_OFF;
1144        } else if (strncmp(buf, "none", 4) == 0) {
1145                if (bq->automode > 0)
1146                        bq->automode = 0;
1147                mode = BQ2415X_MODE_NONE;
1148        } else if (strncmp(buf, "host", 4) == 0) {
1149                if (bq->automode > 0)
1150                        bq->automode = 0;
1151                mode = BQ2415X_MODE_HOST_CHARGER;
1152        } else if (strncmp(buf, "dedicated", 9) == 0) {
1153                if (bq->automode > 0)
1154                        bq->automode = 0;
1155                mode = BQ2415X_MODE_DEDICATED_CHARGER;
1156        } else if (strncmp(buf, "boost", 5) == 0) {
1157                if (bq->automode > 0)
1158                        bq->automode = 0;
1159                mode = BQ2415X_MODE_BOOST;
1160        } else if (strncmp(buf, "reset", 5) == 0) {
1161                bq2415x_reset_chip(bq);
1162                bq2415x_set_defaults(bq);
1163                if (bq->automode <= 0)
1164                        return count;
1165                bq->automode = 1;
1166                mode = bq->reported_mode;
1167        } else {
1168                return -EINVAL;
1169        }
1170
1171        ret = bq2415x_set_mode(bq, mode);
1172        if (ret < 0)
1173                return ret;
1174        return count;
1175}
1176
1177/* show mode entry (auto, none, host, dedicated or boost) */
1178static ssize_t bq2415x_sysfs_show_mode(struct device *dev,
1179                                       struct device_attribute *attr,
1180                                       char *buf)
1181{
1182        struct power_supply *psy = dev_get_drvdata(dev);
1183        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1184                                                charger);
1185        ssize_t ret = 0;
1186
1187        if (bq->automode > 0)
1188                ret += sprintf(buf+ret, "auto (");
1189
1190        switch (bq->mode) {
1191        case BQ2415X_MODE_OFF:
1192                ret += sprintf(buf+ret, "off");
1193                break;
1194        case BQ2415X_MODE_NONE:
1195                ret += sprintf(buf+ret, "none");
1196                break;
1197        case BQ2415X_MODE_HOST_CHARGER:
1198                ret += sprintf(buf+ret, "host");
1199                break;
1200        case BQ2415X_MODE_DEDICATED_CHARGER:
1201                ret += sprintf(buf+ret, "dedicated");
1202                break;
1203        case BQ2415X_MODE_BOOST:
1204                ret += sprintf(buf+ret, "boost");
1205                break;
1206        }
1207
1208        if (bq->automode > 0)
1209                ret += sprintf(buf+ret, ")");
1210
1211        ret += sprintf(buf+ret, "\n");
1212        return ret;
1213}
1214
1215/* show reported_mode entry (none, host, dedicated or boost) */
1216static ssize_t bq2415x_sysfs_show_reported_mode(struct device *dev,
1217                                                struct device_attribute *attr,
1218                                                char *buf)
1219{
1220        struct power_supply *psy = dev_get_drvdata(dev);
1221        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1222                                                 charger);
1223
1224        if (bq->automode < 0)
1225                return -EINVAL;
1226
1227        switch (bq->reported_mode) {
1228        case BQ2415X_MODE_OFF:
1229                return sprintf(buf, "off\n");
1230        case BQ2415X_MODE_NONE:
1231                return sprintf(buf, "none\n");
1232        case BQ2415X_MODE_HOST_CHARGER:
1233                return sprintf(buf, "host\n");
1234        case BQ2415X_MODE_DEDICATED_CHARGER:
1235                return sprintf(buf, "dedicated\n");
1236        case BQ2415X_MODE_BOOST:
1237                return sprintf(buf, "boost\n");
1238        }
1239
1240        return -EINVAL;
1241}
1242
1243/* directly set raw value to chip register, format: 'register value' */
1244static ssize_t bq2415x_sysfs_set_registers(struct device *dev,
1245                                           struct device_attribute *attr,
1246                                           const char *buf,
1247                                           size_t count)
1248{
1249        struct power_supply *psy = dev_get_drvdata(dev);
1250        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1251                                                 charger);
1252        ssize_t ret = 0;
1253        unsigned int reg;
1254        unsigned int val;
1255
1256        if (sscanf(buf, "%x %x", &reg, &val) != 2)
1257                return -EINVAL;
1258
1259        if (reg > 4 || val > 255)
1260                return -EINVAL;
1261
1262        ret = bq2415x_i2c_write(bq, reg, val);
1263        if (ret < 0)
1264                return ret;
1265        return count;
1266}
1267
1268/* print value of chip register, format: 'register=value' */
1269static ssize_t bq2415x_sysfs_print_reg(struct bq2415x_device *bq,
1270                                       u8 reg,
1271                                       char *buf)
1272{
1273        int ret = bq2415x_i2c_read(bq, reg);
1274
1275        if (ret < 0)
1276                return sprintf(buf, "%#.2x=error %d\n", reg, ret);
1277        return sprintf(buf, "%#.2x=%#.2x\n", reg, ret);
1278}
1279
1280/* show all raw values of chip register, format per line: 'register=value' */
1281static ssize_t bq2415x_sysfs_show_registers(struct device *dev,
1282                                            struct device_attribute *attr,
1283                                            char *buf)
1284{
1285        struct power_supply *psy = dev_get_drvdata(dev);
1286        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1287                                                 charger);
1288        ssize_t ret = 0;
1289
1290        ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_STATUS, buf+ret);
1291        ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CONTROL, buf+ret);
1292        ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VOLTAGE, buf+ret);
1293        ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VENDER, buf+ret);
1294        ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CURRENT, buf+ret);
1295        return ret;
1296}
1297
1298/* set current and voltage limit entries (in mA or mV) */
1299static ssize_t bq2415x_sysfs_set_limit(struct device *dev,
1300                                       struct device_attribute *attr,
1301                                       const char *buf,
1302                                       size_t count)
1303{
1304        struct power_supply *psy = dev_get_drvdata(dev);
1305        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1306                                                 charger);
1307        long val;
1308        int ret;
1309
1310        if (kstrtol(buf, 10, &val) < 0)
1311                return -EINVAL;
1312
1313        if (strcmp(attr->attr.name, "current_limit") == 0)
1314                ret = bq2415x_set_current_limit(bq, val);
1315        else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
1316                ret = bq2415x_set_weak_battery_voltage(bq, val);
1317        else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
1318                ret = bq2415x_set_battery_regulation_voltage(bq, val);
1319        else if (strcmp(attr->attr.name, "charge_current") == 0)
1320                ret = bq2415x_set_charge_current(bq, val);
1321        else if (strcmp(attr->attr.name, "termination_current") == 0)
1322                ret = bq2415x_set_termination_current(bq, val);
1323        else
1324                return -EINVAL;
1325
1326        if (ret < 0)
1327                return ret;
1328        return count;
1329}
1330
1331/* show current and voltage limit entries (in mA or mV) */
1332static ssize_t bq2415x_sysfs_show_limit(struct device *dev,
1333                                        struct device_attribute *attr,
1334                                        char *buf)
1335{
1336        struct power_supply *psy = dev_get_drvdata(dev);
1337        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1338                                                 charger);
1339        int ret;
1340
1341        if (strcmp(attr->attr.name, "current_limit") == 0)
1342                ret = bq2415x_get_current_limit(bq);
1343        else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
1344                ret = bq2415x_get_weak_battery_voltage(bq);
1345        else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
1346                ret = bq2415x_get_battery_regulation_voltage(bq);
1347        else if (strcmp(attr->attr.name, "charge_current") == 0)
1348                ret = bq2415x_get_charge_current(bq);
1349        else if (strcmp(attr->attr.name, "termination_current") == 0)
1350                ret = bq2415x_get_termination_current(bq);
1351        else
1352                return -EINVAL;
1353
1354        if (ret < 0)
1355                return ret;
1356        return sprintf(buf, "%d\n", ret);
1357}
1358
1359/* set *_enable entries */
1360static ssize_t bq2415x_sysfs_set_enable(struct device *dev,
1361                                        struct device_attribute *attr,
1362                                        const char *buf,
1363                                        size_t count)
1364{
1365        struct power_supply *psy = dev_get_drvdata(dev);
1366        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1367                                                 charger);
1368        enum bq2415x_command command;
1369        long val;
1370        int ret;
1371
1372        if (kstrtol(buf, 10, &val) < 0)
1373                return -EINVAL;
1374
1375        if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
1376                command = val ? BQ2415X_CHARGE_TERMINATION_ENABLE :
1377                        BQ2415X_CHARGE_TERMINATION_DISABLE;
1378        else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
1379                command = val ? BQ2415X_HIGH_IMPEDANCE_ENABLE :
1380                        BQ2415X_HIGH_IMPEDANCE_DISABLE;
1381        else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
1382                command = val ? BQ2415X_OTG_PIN_ENABLE :
1383                        BQ2415X_OTG_PIN_DISABLE;
1384        else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
1385                command = val ? BQ2415X_STAT_PIN_ENABLE :
1386                        BQ2415X_STAT_PIN_DISABLE;
1387        else
1388                return -EINVAL;
1389
1390        ret = bq2415x_exec_command(bq, command);
1391        if (ret < 0)
1392                return ret;
1393        return count;
1394}
1395
1396/* show *_enable entries */
1397static ssize_t bq2415x_sysfs_show_enable(struct device *dev,
1398                                         struct device_attribute *attr,
1399                                         char *buf)
1400{
1401        struct power_supply *psy = dev_get_drvdata(dev);
1402        struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1403                                                 charger);
1404        enum bq2415x_command command;
1405        int ret;
1406
1407        if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
1408                command = BQ2415X_CHARGE_TERMINATION_STATUS;
1409        else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
1410                command = BQ2415X_HIGH_IMPEDANCE_STATUS;
1411        else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
1412                command = BQ2415X_OTG_PIN_STATUS;
1413        else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
1414                command = BQ2415X_STAT_PIN_STATUS;
1415        else
1416                return -EINVAL;
1417
1418        ret = bq2415x_exec_command(bq, command);
1419        if (ret < 0)
1420                return ret;
1421        return sprintf(buf, "%d\n", ret);
1422}
1423
1424static DEVICE_ATTR(current_limit, S_IWUSR | S_IRUGO,
1425                bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1426static DEVICE_ATTR(weak_battery_voltage, S_IWUSR | S_IRUGO,
1427                bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1428static DEVICE_ATTR(battery_regulation_voltage, S_IWUSR | S_IRUGO,
1429                bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1430static DEVICE_ATTR(charge_current, S_IWUSR | S_IRUGO,
1431                bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1432static DEVICE_ATTR(termination_current, S_IWUSR | S_IRUGO,
1433                bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1434
1435static DEVICE_ATTR(charge_termination_enable, S_IWUSR | S_IRUGO,
1436                bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1437static DEVICE_ATTR(high_impedance_enable, S_IWUSR | S_IRUGO,
1438                bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1439static DEVICE_ATTR(otg_pin_enable, S_IWUSR | S_IRUGO,
1440                bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1441static DEVICE_ATTR(stat_pin_enable, S_IWUSR | S_IRUGO,
1442                bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1443
1444static DEVICE_ATTR(reported_mode, S_IRUGO,
1445                bq2415x_sysfs_show_reported_mode, NULL);
1446static DEVICE_ATTR(mode, S_IWUSR | S_IRUGO,
1447                bq2415x_sysfs_show_mode, bq2415x_sysfs_set_mode);
1448static DEVICE_ATTR(timer, S_IWUSR | S_IRUGO,
1449                bq2415x_sysfs_show_timer, bq2415x_sysfs_set_timer);
1450
1451static DEVICE_ATTR(registers, S_IWUSR | S_IRUGO,
1452                bq2415x_sysfs_show_registers, bq2415x_sysfs_set_registers);
1453
1454static DEVICE_ATTR(otg_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1455static DEVICE_ATTR(charge_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1456static DEVICE_ATTR(boost_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1457static DEVICE_ATTR(fault_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1458
1459static struct attribute *bq2415x_sysfs_attributes[] = {
1460        /*
1461         * TODO: some (appropriate) of these attrs should be switched to
1462         * use power supply class props.
1463         */
1464        &dev_attr_current_limit.attr,
1465        &dev_attr_weak_battery_voltage.attr,
1466        &dev_attr_battery_regulation_voltage.attr,
1467        &dev_attr_charge_current.attr,
1468        &dev_attr_termination_current.attr,
1469
1470        &dev_attr_charge_termination_enable.attr,
1471        &dev_attr_high_impedance_enable.attr,
1472        &dev_attr_otg_pin_enable.attr,
1473        &dev_attr_stat_pin_enable.attr,
1474
1475        &dev_attr_reported_mode.attr,
1476        &dev_attr_mode.attr,
1477        &dev_attr_timer.attr,
1478
1479        &dev_attr_registers.attr,
1480
1481        &dev_attr_otg_status.attr,
1482        &dev_attr_charge_status.attr,
1483        &dev_attr_boost_status.attr,
1484        &dev_attr_fault_status.attr,
1485        NULL,
1486};
1487
1488static const struct attribute_group bq2415x_sysfs_attr_group = {
1489        .attrs = bq2415x_sysfs_attributes,
1490};
1491
1492static int bq2415x_sysfs_init(struct bq2415x_device *bq)
1493{
1494        return sysfs_create_group(&bq->charger.dev->kobj,
1495                        &bq2415x_sysfs_attr_group);
1496}
1497
1498static void bq2415x_sysfs_exit(struct bq2415x_device *bq)
1499{
1500        sysfs_remove_group(&bq->charger.dev->kobj, &bq2415x_sysfs_attr_group);
1501}
1502
1503/* main bq2415x probe function */
1504static int bq2415x_probe(struct i2c_client *client,
1505                         const struct i2c_device_id *id)
1506{
1507        int ret;
1508        int num;
1509        char *name;
1510        struct bq2415x_device *bq;
1511
1512        if (!client->dev.platform_data) {
1513                dev_err(&client->dev, "platform data not set\n");
1514                return -ENODEV;
1515        }
1516
1517        /* Get new ID for the new device */
1518        mutex_lock(&bq2415x_id_mutex);
1519        num = idr_alloc(&bq2415x_id, client, 0, 0, GFP_KERNEL);
1520        mutex_unlock(&bq2415x_id_mutex);
1521        if (num < 0)
1522                return num;
1523
1524        name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num);
1525        if (!name) {
1526                dev_err(&client->dev, "failed to allocate device name\n");
1527                ret = -ENOMEM;
1528                goto error_1;
1529        }
1530
1531        bq = devm_kzalloc(&client->dev, sizeof(*bq), GFP_KERNEL);
1532        if (!bq) {
1533                dev_err(&client->dev, "failed to allocate device data\n");
1534                ret = -ENOMEM;
1535                goto error_2;
1536        }
1537
1538        i2c_set_clientdata(client, bq);
1539
1540        bq->id = num;
1541        bq->dev = &client->dev;
1542        bq->chip = id->driver_data;
1543        bq->name = name;
1544        bq->mode = BQ2415X_MODE_OFF;
1545        bq->reported_mode = BQ2415X_MODE_OFF;
1546        bq->autotimer = 0;
1547        bq->automode = 0;
1548
1549        memcpy(&bq->init_data, client->dev.platform_data,
1550                        sizeof(bq->init_data));
1551
1552        bq2415x_reset_chip(bq);
1553
1554        ret = bq2415x_power_supply_init(bq);
1555        if (ret) {
1556                dev_err(bq->dev, "failed to register power supply: %d\n", ret);
1557                goto error_2;
1558        }
1559
1560        ret = bq2415x_sysfs_init(bq);
1561        if (ret) {
1562                dev_err(bq->dev, "failed to create sysfs entries: %d\n", ret);
1563                goto error_3;
1564        }
1565
1566        ret = bq2415x_set_defaults(bq);
1567        if (ret) {
1568                dev_err(bq->dev, "failed to set default values: %d\n", ret);
1569                goto error_4;
1570        }
1571
1572        if (bq->init_data.set_mode_hook) {
1573                if (bq->init_data.set_mode_hook(
1574                                bq2415x_hook_function, bq)) {
1575                        bq->automode = 1;
1576                        bq2415x_set_mode(bq, bq->reported_mode);
1577                        dev_info(bq->dev, "automode enabled\n");
1578                } else {
1579                        bq->automode = -1;
1580                        dev_info(bq->dev, "automode failed\n");
1581                }
1582        } else {
1583                bq->automode = -1;
1584                dev_info(bq->dev, "automode not supported\n");
1585        }
1586
1587        INIT_DELAYED_WORK(&bq->work, bq2415x_timer_work);
1588        bq2415x_set_autotimer(bq, 1);
1589
1590        dev_info(bq->dev, "driver registered\n");
1591        return 0;
1592
1593error_4:
1594        bq2415x_sysfs_exit(bq);
1595error_3:
1596        bq2415x_power_supply_exit(bq);
1597error_2:
1598        kfree(name);
1599error_1:
1600        mutex_lock(&bq2415x_id_mutex);
1601        idr_remove(&bq2415x_id, num);
1602        mutex_unlock(&bq2415x_id_mutex);
1603
1604        return ret;
1605}
1606
1607/* main bq2415x remove function */
1608
1609static int bq2415x_remove(struct i2c_client *client)
1610{
1611        struct bq2415x_device *bq = i2c_get_clientdata(client);
1612
1613        if (bq->init_data.set_mode_hook)
1614                bq->init_data.set_mode_hook(NULL, NULL);
1615
1616        bq2415x_sysfs_exit(bq);
1617        bq2415x_power_supply_exit(bq);
1618
1619        bq2415x_reset_chip(bq);
1620
1621        mutex_lock(&bq2415x_id_mutex);
1622        idr_remove(&bq2415x_id, bq->id);
1623        mutex_unlock(&bq2415x_id_mutex);
1624
1625        dev_info(bq->dev, "driver unregistered\n");
1626
1627        kfree(bq->name);
1628
1629        return 0;
1630}
1631
1632static const struct i2c_device_id bq2415x_i2c_id_table[] = {
1633        { "bq2415x", BQUNKNOWN },
1634        { "bq24150", BQ24150 },
1635        { "bq24150a", BQ24150A },
1636        { "bq24151", BQ24151 },
1637        { "bq24151a", BQ24151A },
1638        { "bq24152", BQ24152 },
1639        { "bq24153", BQ24153 },
1640        { "bq24153a", BQ24153A },
1641        { "bq24155", BQ24155 },
1642        { "bq24156", BQ24156 },
1643        { "bq24156a", BQ24156A },
1644        { "bq24158", BQ24158 },
1645        {},
1646};
1647MODULE_DEVICE_TABLE(i2c, bq2415x_i2c_id_table);
1648
1649static struct i2c_driver bq2415x_driver = {
1650        .driver = {
1651                .name = "bq2415x-charger",
1652        },
1653        .probe = bq2415x_probe,
1654        .remove = bq2415x_remove,
1655        .id_table = bq2415x_i2c_id_table,
1656};
1657module_i2c_driver(bq2415x_driver);
1658
1659MODULE_AUTHOR("Pali Rohár <pali.rohar@gmail.com>");
1660MODULE_DESCRIPTION("bq2415x charger driver");
1661MODULE_LICENSE("GPL");
1662
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.