drivers/power/bq2415x_charger.c

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