drivers/power/bq2415x_charger.c

   1 /*
   2     bq2415x_charger.c - bq2415x charger driver
   3     Copyright (C) 2011-2012  Pali Rohár <pali.rohar@gmail.com>
   4
   5     This program is free software; you can redistribute it and/or modify
   6     it under the terms of the GNU General Public License as published by
   7     the Free Software Foundation; either version 2 of the License, or
   8     (at your option) any later version.
   9
  10     This program is distributed in the hope that it will be useful,
  11     but WITHOUT ANY WARRANTY; without even the implied warranty of
  12     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13     GNU General Public License for more details.
  14
  15     You should have received a copy of the GNU General Public License along
  16     with this program; if not, write to the Free Software Foundation, Inc.,
  17     51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  18 */
  19
  20 /*
  21   Datasheets:
  22   http://www.ti.com/product/bq24150
  23   http://www.ti.com/product/bq24150a
  24   http://www.ti.com/product/bq24152
  25   http://www.ti.com/product/bq24153
  26   http://www.ti.com/product/bq24153a
  27   http://www.ti.com/product/bq24155
  28 */
  29
  30 #include <linux/version.h>
  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         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 */
 185 static DEFINE_IDR(bq2415x_id);
 186
 187 static DEFINE_MUTEX(bq2415x_id_mutex);
 188 static DEFINE_MUTEX(bq2415x_timer_mutex);
 189 static DEFINE_MUTEX(bq2415x_i2c_mutex);
 190
 191 /**** i2c read functions ****/
 192
 193 /* read value from register */
 194 static 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 */
 224 static 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         else
 236                 return (ret & mask) >> shift;
 237 }
 238
 239 /* read value from register and return one specified bit */
 240 static int bq2415x_i2c_read_bit(struct bq2415x_device *bq, u8 reg, u8 bit)
 241 {
 242         if (bit > 8)
 243                 return -EINVAL;
 244         else
 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         else
 305                 return bq2415x_i2c_write_mask(bq, reg, val, BIT(bit), bit);
 306 }
 307
 308 /**** global functions ****/
 309
 310 /* exec command function */
 311 static int bq2415x_exec_command(struct bq2415x_device *bq,
 312                                 enum bq2415x_command command)
 313 {
 314         int ret;
 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         default:
 412                 return -EINVAL;
 413         }
 414 }
 415
 416 /* detect chip type */
 417 static enum bq2415x_chip bq2415x_detect_chip(struct bq2415x_device *bq)
 418 {
 419         struct i2c_client *client = to_i2c_client(bq->dev);
 420         int ret = bq2415x_exec_command(bq, BQ2415X_PART_NUMBER);
 421
 422         if (ret < 0)
 423                 return ret;
 424
 425         switch (client->addr) {
 426         case 0x6b:
 427                 switch (ret) {
 428                 case 0:
 429                         if (bq->chip == BQ24151A)
 430                                 return bq->chip;
 431                         else
 432                                 return BQ24151;
 433                 case 1:
 434                         if (bq->chip == BQ24150A ||
 435                                 bq->chip == BQ24152 ||
 436                                 bq->chip == BQ24155)
 437                                 return bq->chip;
 438                         else
 439                                 return BQ24150;
 440                 case 2:
 441                         if (bq->chip == BQ24153A)
 442                                 return bq->chip;
 443                         else
 444                                 return BQ24153;
 445                 default:
 446                         return BQUNKNOWN;
 447                 }
 448                 break;
 449
 450         case 0x6a:
 451                 switch (ret) {
 452                 case 0:
 453                         if (bq->chip == BQ24156A)
 454                                 return bq->chip;
 455                         else
 456                                 return BQ24156;
 457                 case 2:
 458                         return BQ24158;
 459                 default:
 460                         return BQUNKNOWN;
 461                 }
 462                 break;
 463         }
 464
 465         return BQUNKNOWN;
 466 }
 467
 468 /* detect chip revision */
 469 static int bq2415x_detect_revision(struct bq2415x_device *bq)
 470 {
 471         int ret = bq2415x_exec_command(bq, BQ2415X_REVISION);
 472         int chip = bq2415x_detect_chip(bq);
 473         if (ret < 0 || chip < 0)
 474                 return -1;
 475
 476         switch (chip) {
 477         case BQ24150:
 478         case BQ24150A:
 479         case BQ24151:
 480         case BQ24151A:
 481         case BQ24152:
 482                 if (ret >= 0 && ret <= 3)
 483                         return ret;
 484                 else
 485                         return -1;
 486
 487         case BQ24153:
 488         case BQ24153A:
 489         case BQ24156:
 490         case BQ24156A:
 491         case BQ24158:
 492                 if (ret == 3)
 493                         return 0;
 494                 else if (ret == 1)
 495                         return 1;
 496                 else
 497                         return -1;
 498
 499         case BQ24155:
 500                 if (ret == 3)
 501                         return 3;
 502                 else
 503                         return -1;
 504
 505         case BQUNKNOWN:
 506                 return -1;
 507         }
 508
 509         return -1;
 510 }
 511
 512 /* return chip vender code */
 513 static int bq2415x_get_vender_code(struct bq2415x_device *bq)
 514 {
 515         int ret = bq2415x_exec_command(bq, BQ2415X_VENDER_CODE);
 516         if (ret < 0)
 517                 return 0;
 518         else /* convert to binary */
 519                 return (ret & 0x1) +
 520                         ((ret >> 1) & 0x1) * 10 +
 521                         ((ret >> 2) & 0x1) * 100;
 522 }
 523
 524 /* reset all chip registers to default state */
 525 static void bq2415x_reset_chip(struct bq2415x_device *bq)
 526 {
 527         bq2415x_i2c_write(bq, BQ2415X_REG_CURRENT, BQ2415X_RESET_CURRENT);
 528         bq2415x_i2c_write(bq, BQ2415X_REG_VOLTAGE, BQ2415X_RESET_VOLTAGE);
 529         bq2415x_i2c_write(bq, BQ2415X_REG_CONTROL, BQ2415X_RESET_CONTROL);
 530         bq2415x_i2c_write(bq, BQ2415X_REG_STATUS, BQ2415X_RESET_STATUS);
 531         bq->timer_error = NULL;
 532 }
 533
 534 /**** properties functions ****/
 535
 536 /* set current limit in mA */
 537 static int bq2415x_set_current_limit(struct bq2415x_device *bq, int mA)
 538 {
 539         int val;
 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         return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
 549                         BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
 550 }
 551
 552 /* get current limit in mA */
 553 static int bq2415x_get_current_limit(struct bq2415x_device *bq)
 554 {
 555         int ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
 556                         BQ2415X_MASK_LIMIT, BQ2415X_SHIFT_LIMIT);
 557         if (ret < 0)
 558                 return ret;
 559         else if (ret == 0)
 560                 return 100;
 561         else if (ret == 1)
 562                 return 500;
 563         else if (ret == 2)
 564                 return 800;
 565         else if (ret == 3)
 566                 return 1800;
 567         else
 568                 return -EINVAL;
 569 }
 570
 571 /* set weak battery voltage in mV */
 572 static int bq2415x_set_weak_battery_voltage(struct bq2415x_device *bq, int mV)
 573 {
 574         /* round to 100mV */
 575         int val;
 576         if (mV <= 3400 + 50)
 577                 val = 0;
 578         else if (mV <= 3500 + 50)
 579                 val = 1;
 580         else if (mV <= 3600 + 50)
 581                 val = 2;
 582         else
 583                 val = 3;
 584         return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CONTROL, val,
 585                         BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
 586 }
 587
 588 /* get weak battery voltage in mV */
 589 static int bq2415x_get_weak_battery_voltage(struct bq2415x_device *bq)
 590 {
 591         int ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CONTROL,
 592                         BQ2415X_MASK_VLOWV, BQ2415X_SHIFT_VLOWV);
 593         if (ret < 0)
 594                 return ret;
 595         else
 596                 return 100 * (34 + ret);
 597 }
 598
 599 /* set battery regulation voltage in mV */
 600 static int bq2415x_set_battery_regulation_voltage(struct bq2415x_device *bq,
 601                                                 int mV)
 602 {
 603         int val = (mV/10 - 350) / 2;
 604
 605         if (val < 0)
 606                 val = 0;
 607         else if (val > 94) /* FIXME: Max is 94 or 122 ? Set max value ? */
 608                 return -EINVAL;
 609
 610         return bq2415x_i2c_write_mask(bq, BQ2415X_REG_VOLTAGE, val,
 611                         BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
 612 }
 613
 614 /* get battery regulation voltage in mV */
 615 static int bq2415x_get_battery_regulation_voltage(struct bq2415x_device *bq)
 616 {
 617         int ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_VOLTAGE,
 618                         BQ2415X_MASK_VO, BQ2415X_SHIFT_VO);
 619         if (ret < 0)
 620                 return ret;
 621         else
 622                 return 10 * (350 + 2*ret);
 623 }
 624
 625 /* set charge current in mA (platform data must provide resistor sense) */
 626 static int bq2415x_set_charge_current(struct bq2415x_device *bq, int mA)
 627 {
 628         int val;
 629         if (bq->init_data.resistor_sense <= 0)
 630                 return -ENOSYS;
 631
 632         val = (mA * bq->init_data.resistor_sense - 37400) / 6800;
 633
 634         if (val < 0)
 635                 val = 0;
 636         else if (val > 7)
 637                 val = 7;
 638
 639         return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
 640                         BQ2415X_MASK_VI_CHRG | BQ2415X_MASK_RESET,
 641                         BQ2415X_SHIFT_VI_CHRG);
 642 }
 643
 644 /* get charge current in mA (platform data must provide resistor sense) */
 645 static int bq2415x_get_charge_current(struct bq2415x_device *bq)
 646 {
 647         int ret;
 648         if (bq->init_data.resistor_sense <= 0)
 649                 return -ENOSYS;
 650
 651         ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
 652                         BQ2415X_MASK_VI_CHRG, BQ2415X_SHIFT_VI_CHRG);
 653         if (ret < 0)
 654                 return ret;
 655         else
 656                 return (37400 + 6800*ret) / bq->init_data.resistor_sense;
 657 }
 658
 659 /* set termination current in mA (platform data must provide resistor sense) */
 660 static int bq2415x_set_termination_current(struct bq2415x_device *bq, int mA)
 661 {
 662         int val;
 663         if (bq->init_data.resistor_sense <= 0)
 664                 return -ENOSYS;
 665
 666         val = (mA * bq->init_data.resistor_sense - 3400) / 3400;
 667
 668         if (val < 0)
 669                 val = 0;
 670         else if (val > 7)
 671                 val = 7;
 672
 673         return bq2415x_i2c_write_mask(bq, BQ2415X_REG_CURRENT, val,
 674                         BQ2415X_MASK_VI_TERM | BQ2415X_MASK_RESET,
 675                         BQ2415X_SHIFT_VI_TERM);
 676 }
 677
 678 /* get termination current in mA (platform data must provide resistor sense) */
 679 static int bq2415x_get_termination_current(struct bq2415x_device *bq)
 680 {
 681         int ret;
 682         if (bq->init_data.resistor_sense <= 0)
 683                 return -ENOSYS;
 684
 685         ret = bq2415x_i2c_read_mask(bq, BQ2415X_REG_CURRENT,
 686                         BQ2415X_MASK_VI_TERM, BQ2415X_SHIFT_VI_TERM);
 687         if (ret < 0)
 688                 return ret;
 689         else
 690                 return (3400 + 3400*ret) / bq->init_data.resistor_sense;
 691 }
 692
 693 /* set default value of property */
 694 #define bq2415x_set_default_value(bq, prop) \
 695         do { \
 696                 int ret = 0; \
 697                 if (bq->init_data.prop != -1) \
 698                         ret = bq2415x_set_##prop(bq, bq->init_data.prop); \
 699                 if (ret < 0) \
 700                         return ret; \
 701         } while (0)
 702
 703 /* set default values of all properties */
 704 static int bq2415x_set_defaults(struct bq2415x_device *bq)
 705 {
 706         bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
 707         bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
 708         bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_DISABLE);
 709         bq2415x_set_default_value(bq, current_limit);
 710         bq2415x_set_default_value(bq, weak_battery_voltage);
 711         bq2415x_set_default_value(bq, battery_regulation_voltage);
 712         if (bq->init_data.resistor_sense > 0) {
 713                 bq2415x_set_default_value(bq, charge_current);
 714                 bq2415x_set_default_value(bq, termination_current);
 715                 bq2415x_exec_command(bq, BQ2415X_CHARGE_TERMINATION_ENABLE);
 716         }
 717         bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
 718         return 0;
 719 }
 720
 721 /**** charger mode functions ****/
 722
 723 /* set charger mode */
 724 static int bq2415x_set_mode(struct bq2415x_device *bq, enum bq2415x_mode mode)
 725 {
 726         int ret = 0;
 727         int charger = 0;
 728         int boost = 0;
 729
 730         if (mode == BQ2415X_MODE_HOST_CHARGER ||
 731                 mode == BQ2415X_MODE_DEDICATED_CHARGER)
 732                         charger = 1;
 733
 734         if (mode == BQ2415X_MODE_BOOST)
 735                 boost = 1;
 736
 737         if (!charger)
 738                 ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_DISABLE);
 739
 740         if (!boost)
 741                 ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_DISABLE);
 742
 743         if (ret < 0)
 744                 return ret;
 745
 746         switch (mode) {
 747         case BQ2415X_MODE_NONE:
 748                 dev_dbg(bq->dev, "changing mode to: N/A\n");
 749                 ret = bq2415x_set_current_limit(bq, 100);
 750                 break;
 751         case BQ2415X_MODE_HOST_CHARGER:
 752                 dev_dbg(bq->dev, "changing mode to: Host/HUB charger\n");
 753                 ret = bq2415x_set_current_limit(bq, 500);
 754                 break;
 755         case BQ2415X_MODE_DEDICATED_CHARGER:
 756                 dev_dbg(bq->dev, "changing mode to: Dedicated charger\n");
 757                 ret = bq2415x_set_current_limit(bq, 1800);
 758                 break;
 759         case BQ2415X_MODE_BOOST: /* Boost mode */
 760                 dev_dbg(bq->dev, "changing mode to: Boost\n");
 761                 ret = bq2415x_set_current_limit(bq, 100);
 762                 break;
 763         }
 764
 765         if (ret < 0)
 766                 return ret;
 767
 768         if (charger)
 769                 ret = bq2415x_exec_command(bq, BQ2415X_CHARGER_ENABLE);
 770         else if (boost)
 771                 ret = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_ENABLE);
 772
 773         if (ret < 0)
 774                 return ret;
 775
 776         bq2415x_set_default_value(bq, weak_battery_voltage);
 777         bq2415x_set_default_value(bq, battery_regulation_voltage);
 778
 779         bq->mode = mode;
 780         sysfs_notify(&bq->charger.dev->kobj, NULL, "mode");
 781
 782         return 0;
 783
 784 }
 785
 786 /* hook function called by other driver which set reported mode */
 787 static void bq2415x_hook_function(enum bq2415x_mode mode, void *data)
 788 {
 789         struct bq2415x_device *bq = data;
 790
 791         if (!bq)
 792                 return;
 793
 794         dev_dbg(bq->dev, "hook function was called\n");
 795         bq->reported_mode = mode;
 796
 797         /* if automode is not enabled do not tell about reported_mode */
 798         if (bq->automode < 1)
 799                 return;
 800
 801         sysfs_notify(&bq->charger.dev->kobj, NULL, "reported_mode");
 802         bq2415x_set_mode(bq, bq->reported_mode);
 803
 804 }
 805
 806 /**** timer functions ****/
 807
 808 /* enable/disable auto resetting chip timer */
 809 static void bq2415x_set_autotimer(struct bq2415x_device *bq, int state)
 810 {
 811         mutex_lock(&bq2415x_timer_mutex);
 812
 813         if (bq->autotimer == state) {
 814                 mutex_unlock(&bq2415x_timer_mutex);
 815                 return;
 816         }
 817
 818         bq->autotimer = state;
 819
 820         if (state) {
 821                 schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
 822                 bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
 823                 bq->timer_error = NULL;
 824         } else {
 825                 cancel_delayed_work_sync(&bq->work);
 826         }
 827
 828         mutex_unlock(&bq2415x_timer_mutex);
 829 }
 830
 831 /* called by bq2415x_timer_work on timer error */
 832 static void bq2415x_timer_error(struct bq2415x_device *bq, const char *msg)
 833 {
 834         bq->timer_error = msg;
 835         sysfs_notify(&bq->charger.dev->kobj, NULL, "timer");
 836         dev_err(bq->dev, "%s\n", msg);
 837         if (bq->automode > 0)
 838                 bq->automode = 0;
 839         bq2415x_set_mode(bq, BQ2415X_MODE_NONE);
 840         bq2415x_set_autotimer(bq, 0);
 841 }
 842
 843 /* delayed work function for auto resetting chip timer */
 844 static void bq2415x_timer_work(struct work_struct *work)
 845 {
 846         struct bq2415x_device *bq = container_of(work, struct bq2415x_device,
 847                                                 work.work);
 848         int ret, error, boost;
 849
 850         if (!bq->autotimer)
 851                 return;
 852
 853         ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
 854         if (ret < 0) {
 855                 bq2415x_timer_error(bq, "Resetting timer failed");
 856                 return;
 857         }
 858
 859         boost = bq2415x_exec_command(bq, BQ2415X_BOOST_MODE_STATUS);
 860         if (boost < 0) {
 861                 bq2415x_timer_error(bq, "Unknown error");
 862                 return;
 863         }
 864
 865         error = bq2415x_exec_command(bq, BQ2415X_FAULT_STATUS);
 866         if (error < 0) {
 867                 bq2415x_timer_error(bq, "Unknown error");
 868                 return;
 869         }
 870
 871         if (boost) {
 872                 switch (error) {
 873                 /* Non fatal errors, chip is OK */
 874                 case 0: /* No error */
 875                         break;
 876                 case 6: /* Timer expired */
 877                         dev_err(bq->dev, "Timer expired\n");
 878                         break;
 879                 case 3: /* Battery voltage too low */
 880                         dev_err(bq->dev, "Battery voltage to low\n");
 881                         break;
 882
 883                 /* Fatal errors, disable and reset chip */
 884                 case 1: /* Overvoltage protection (chip fried) */
 885                         bq2415x_timer_error(bq,
 886                                 "Overvoltage protection (chip fried)");
 887                         return;
 888                 case 2: /* Overload */
 889                         bq2415x_timer_error(bq, "Overload");
 890                         return;
 891                 case 4: /* Battery overvoltage protection */
 892                         bq2415x_timer_error(bq,
 893                                 "Battery overvoltage protection");
 894                         return;
 895                 case 5: /* Thermal shutdown (too hot) */
 896                         bq2415x_timer_error(bq,
 897                                         "Thermal shutdown (too hot)");
 898                         return;
 899                 case 7: /* N/A */
 900                         bq2415x_timer_error(bq, "Unknown error");
 901                         return;
 902                 }
 903         } else {
 904                 switch (error) {
 905                 /* Non fatal errors, chip is OK */
 906                 case 0: /* No error */
 907                         break;
 908                 case 2: /* Sleep mode */
 909                         dev_err(bq->dev, "Sleep mode\n");
 910                         break;
 911                 case 3: /* Poor input source */
 912                         dev_err(bq->dev, "Poor input source\n");
 913                         break;
 914                 case 6: /* Timer expired */
 915                         dev_err(bq->dev, "Timer expired\n");
 916                         break;
 917                 case 7: /* No battery */
 918                         dev_err(bq->dev, "No battery\n");
 919                         break;
 920
 921                 /* Fatal errors, disable and reset chip */
 922                 case 1: /* Overvoltage protection (chip fried) */
 923                         bq2415x_timer_error(bq,
 924                                 "Overvoltage protection (chip fried)");
 925                         return;
 926                 case 4: /* Battery overvoltage protection */
 927                         bq2415x_timer_error(bq,
 928                                 "Battery overvoltage protection");
 929                         return;
 930                 case 5: /* Thermal shutdown (too hot) */
 931                         bq2415x_timer_error(bq,
 932                                 "Thermal shutdown (too hot)");
 933                         return;
 934                 }
 935         }
 936
 937         schedule_delayed_work(&bq->work, BQ2415X_TIMER_TIMEOUT * HZ);
 938 }
 939
 940 /**** power supply interface code ****/
 941
 942 static enum power_supply_property bq2415x_power_supply_props[] = {
 943         /* TODO: maybe add more power supply properties */
 944         POWER_SUPPLY_PROP_STATUS,
 945         POWER_SUPPLY_PROP_MODEL_NAME,
 946 };
 947
 948 static int bq2415x_power_supply_get_property(struct power_supply *psy,
 949         enum power_supply_property psp, union power_supply_propval *val)
 950 {
 951         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
 952                                                 charger);
 953         int ret;
 954
 955         switch (psp) {
 956         case POWER_SUPPLY_PROP_STATUS:
 957                 ret = bq2415x_exec_command(bq, BQ2415X_CHARGE_STATUS);
 958                 if (ret < 0)
 959                         return ret;
 960                 else if (ret == 0) /* Ready */
 961                         val->intval = POWER_SUPPLY_STATUS_NOT_CHARGING;
 962                 else if (ret == 1) /* Charge in progress */
 963                         val->intval = POWER_SUPPLY_STATUS_CHARGING;
 964                 else if (ret == 2) /* Charge done */
 965                         val->intval = POWER_SUPPLY_STATUS_FULL;
 966                 else
 967                         val->intval = POWER_SUPPLY_STATUS_UNKNOWN;
 968                 break;
 969         case POWER_SUPPLY_PROP_MODEL_NAME:
 970                 val->strval = bq->model;
 971                 break;
 972         default:
 973                 return -EINVAL;
 974         }
 975         return 0;
 976 }
 977
 978 static int bq2415x_power_supply_init(struct bq2415x_device *bq)
 979 {
 980         int ret;
 981         int chip;
 982         char revstr[8];
 983
 984         bq->charger.name = bq->name;
 985         bq->charger.type = POWER_SUPPLY_TYPE_USB;
 986         bq->charger.properties = bq2415x_power_supply_props;
 987         bq->charger.num_properties = ARRAY_SIZE(bq2415x_power_supply_props);
 988         bq->charger.get_property = bq2415x_power_supply_get_property;
 989
 990         ret = bq2415x_detect_chip(bq);
 991         if (ret < 0)
 992                 chip = BQUNKNOWN;
 993         else
 994                 chip = ret;
 995
 996         ret = bq2415x_detect_revision(bq);
 997         if (ret < 0)
 998                 strcpy(revstr, "unknown");
 999         else
1000                 sprintf(revstr, "1.%d", ret);
1001
1002         bq->model = kasprintf(GFP_KERNEL,
1003                                 "chip %s, revision %s, vender code %.3d",
1004                                 bq2415x_chip_name[chip], revstr,
1005                                 bq2415x_get_vender_code(bq));
1006         if (!bq->model) {
1007                 dev_err(bq->dev, "failed to allocate model name\n");
1008                 return -ENOMEM;
1009         }
1010
1011         ret = power_supply_register(bq->dev, &bq->charger);
1012         if (ret) {
1013                 kfree(bq->model);
1014                 return ret;
1015         }
1016
1017         return 0;
1018 }
1019
1020 static void bq2415x_power_supply_exit(struct bq2415x_device *bq)
1021 {
1022         bq->autotimer = 0;
1023         if (bq->automode > 0)
1024                 bq->automode = 0;
1025         cancel_delayed_work_sync(&bq->work);
1026         power_supply_unregister(&bq->charger);
1027         kfree(bq->model);
1028 }
1029
1030 /**** additional sysfs entries for power supply interface ****/
1031
1032 /* show *_status entries */
1033 static ssize_t bq2415x_sysfs_show_status(struct device *dev,
1034                 struct device_attribute *attr, char *buf)
1035 {
1036         struct power_supply *psy = dev_get_drvdata(dev);
1037         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1038                                                 charger);
1039         enum bq2415x_command command;
1040         int ret;
1041
1042         if (strcmp(attr->attr.name, "otg_status") == 0)
1043                 command = BQ2415X_OTG_STATUS;
1044         else if (strcmp(attr->attr.name, "charge_status") == 0)
1045                 command = BQ2415X_CHARGE_STATUS;
1046         else if (strcmp(attr->attr.name, "boost_status") == 0)
1047                 command = BQ2415X_BOOST_STATUS;
1048         else if (strcmp(attr->attr.name, "fault_status") == 0)
1049                 command = BQ2415X_FAULT_STATUS;
1050         else
1051                 return -EINVAL;
1052
1053         ret = bq2415x_exec_command(bq, command);
1054         if (ret < 0)
1055                 return ret;
1056         else
1057                 return sprintf(buf, "%d\n", ret);
1058 }
1059
1060 /* set timer entry:
1061      auto - enable auto mode
1062      off - disable auto mode
1063      (other values) - reset chip timer
1064 */
1065 static ssize_t bq2415x_sysfs_set_timer(struct device *dev,
1066                 struct device_attribute *attr, const char *buf, size_t count)
1067 {
1068         struct power_supply *psy = dev_get_drvdata(dev);
1069         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1070                                                 charger);
1071         int ret = 0;
1072
1073         if (strncmp(buf, "auto", 4) == 0)
1074                 bq2415x_set_autotimer(bq, 1);
1075         else if (strncmp(buf, "off", 3) == 0)
1076                 bq2415x_set_autotimer(bq, 0);
1077         else
1078                 ret = bq2415x_exec_command(bq, BQ2415X_TIMER_RESET);
1079
1080         if (ret < 0)
1081                 return ret;
1082         else
1083                 return count;
1084 }
1085
1086 /* show timer entry (auto or off) */
1087 static ssize_t bq2415x_sysfs_show_timer(struct device *dev,
1088                 struct device_attribute *attr, char *buf)
1089 {
1090         struct power_supply *psy = dev_get_drvdata(dev);
1091         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1092                                                 charger);
1093
1094         if (bq->timer_error)
1095                 return sprintf(buf, "%s\n", bq->timer_error);
1096
1097         if (bq->autotimer)
1098                 return sprintf(buf, "auto\n");
1099         else
1100                 return sprintf(buf, "off\n");
1101 }
1102
1103 /* set mode entry:
1104      auto - if automode is supported, enable it and set mode to reported
1105      none - disable charger and boost mode
1106      host - charging mode for host/hub chargers (current limit 500mA)
1107      dedicated - charging mode for dedicated chargers (unlimited current limit)
1108      boost - disable charger and enable boost mode
1109 */
1110 static ssize_t bq2415x_sysfs_set_mode(struct device *dev,
1111                 struct device_attribute *attr, const char *buf, size_t count)
1112 {
1113         struct power_supply *psy = dev_get_drvdata(dev);
1114         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1115                                                 charger);
1116         enum bq2415x_mode mode;
1117         int ret = 0;
1118
1119         if (strncmp(buf, "auto", 4) == 0) {
1120                 if (bq->automode < 0)
1121                         return -ENOSYS;
1122                 bq->automode = 1;
1123                 mode = bq->reported_mode;
1124         } else if (strncmp(buf, "none", 4) == 0) {
1125                 if (bq->automode > 0)
1126                         bq->automode = 0;
1127                 mode = BQ2415X_MODE_NONE;
1128         } else if (strncmp(buf, "host", 4) == 0) {
1129                 if (bq->automode > 0)
1130                         bq->automode = 0;
1131                 mode = BQ2415X_MODE_HOST_CHARGER;
1132         } else if (strncmp(buf, "dedicated", 9) == 0) {
1133                 if (bq->automode > 0)
1134                         bq->automode = 0;
1135                 mode = BQ2415X_MODE_DEDICATED_CHARGER;
1136         } else if (strncmp(buf, "boost", 5) == 0) {
1137                 if (bq->automode > 0)
1138                         bq->automode = 0;
1139                 mode = BQ2415X_MODE_BOOST;
1140         } else if (strncmp(buf, "reset", 5) == 0) {
1141                 bq2415x_reset_chip(bq);
1142                 bq2415x_set_defaults(bq);
1143                 if (bq->automode <= 0)
1144                         return count;
1145                 bq->automode = 1;
1146                 mode = bq->reported_mode;
1147         } else
1148                 return -EINVAL;
1149
1150         ret = bq2415x_set_mode(bq, mode);
1151         if (ret < 0)
1152                 return ret;
1153         else
1154                 return count;
1155 }
1156
1157 /* show mode entry (auto, none, host, dedicated or boost) */
1158 static ssize_t bq2415x_sysfs_show_mode(struct device *dev,
1159                 struct device_attribute *attr, char *buf)
1160 {
1161         struct power_supply *psy = dev_get_drvdata(dev);
1162         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1163                                                 charger);
1164         ssize_t ret = 0;
1165
1166         if (bq->automode > 0)
1167                 ret += sprintf(buf+ret, "auto (");
1168
1169         switch (bq->mode) {
1170         case BQ2415X_MODE_NONE:
1171                 ret += sprintf(buf+ret, "none");
1172                 break;
1173         case BQ2415X_MODE_HOST_CHARGER:
1174                 ret += sprintf(buf+ret, "host");
1175                 break;
1176         case BQ2415X_MODE_DEDICATED_CHARGER:
1177                 ret += sprintf(buf+ret, "dedicated");
1178                 break;
1179         case BQ2415X_MODE_BOOST:
1180                 ret += sprintf(buf+ret, "boost");
1181                 break;
1182         }
1183
1184         if (bq->automode > 0)
1185                 ret += sprintf(buf+ret, ")");
1186
1187         ret += sprintf(buf+ret, "\n");
1188         return ret;
1189 }
1190
1191 /* show reported_mode entry (none, host, dedicated or boost) */
1192 static ssize_t bq2415x_sysfs_show_reported_mode(struct device *dev,
1193                 struct device_attribute *attr, char *buf)
1194 {
1195         struct power_supply *psy = dev_get_drvdata(dev);
1196         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1197                                                 charger);
1198
1199         if (bq->automode < 0)
1200                 return -EINVAL;
1201
1202         switch (bq->reported_mode) {
1203         case BQ2415X_MODE_NONE:
1204                 return sprintf(buf, "none\n");
1205         case BQ2415X_MODE_HOST_CHARGER:
1206                 return sprintf(buf, "host\n");
1207         case BQ2415X_MODE_DEDICATED_CHARGER:
1208                 return sprintf(buf, "dedicated\n");
1209         case BQ2415X_MODE_BOOST:
1210                 return sprintf(buf, "boost\n");
1211         }
1212
1213         return -EINVAL;
1214 }
1215
1216 /* directly set raw value to chip register, format: 'register value' */
1217 static ssize_t bq2415x_sysfs_set_registers(struct device *dev,
1218                 struct device_attribute *attr, const char *buf, size_t count)
1219 {
1220         struct power_supply *psy = dev_get_drvdata(dev);
1221         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1222                                                 charger);
1223         ssize_t ret = 0;
1224         unsigned int reg;
1225         unsigned int val;
1226
1227         if (sscanf(buf, "%x %x", &reg, &val) != 2)
1228                 return -EINVAL;
1229
1230         if (reg > 4 || val > 255)
1231                 return -EINVAL;
1232
1233         ret = bq2415x_i2c_write(bq, reg, val);
1234         if (ret < 0)
1235                 return ret;
1236         else
1237                 return count;
1238 }
1239
1240 /* print value of chip register, format: 'register=value' */
1241 static ssize_t bq2415x_sysfs_print_reg(struct bq2415x_device *bq,
1242                                         u8 reg, char *buf)
1243 {
1244         int ret = bq2415x_i2c_read(bq, reg);
1245         if (ret < 0)
1246                 return sprintf(buf, "%#.2x=error %d\n", reg, ret);
1247         else
1248                 return sprintf(buf, "%#.2x=%#.2x\n", reg, ret);
1249 }
1250
1251 /* show all raw values of chip register, format per line: 'register=value' */
1252 static ssize_t bq2415x_sysfs_show_registers(struct device *dev,
1253                 struct device_attribute *attr, char *buf)
1254 {
1255         struct power_supply *psy = dev_get_drvdata(dev);
1256         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1257                                                 charger);
1258         ssize_t ret = 0;
1259
1260         ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_STATUS, buf+ret);
1261         ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CONTROL, buf+ret);
1262         ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VOLTAGE, buf+ret);
1263         ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_VENDER, buf+ret);
1264         ret += bq2415x_sysfs_print_reg(bq, BQ2415X_REG_CURRENT, buf+ret);
1265         return ret;
1266 }
1267
1268 /* set current and voltage limit entries (in mA or mV) */
1269 static ssize_t bq2415x_sysfs_set_limit(struct device *dev,
1270                 struct device_attribute *attr, const char *buf, size_t count)
1271 {
1272         struct power_supply *psy = dev_get_drvdata(dev);
1273         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1274                                                 charger);
1275         long val;
1276         int ret;
1277
1278         if (kstrtol(buf, 10, &val) < 0)
1279                 return -EINVAL;
1280
1281         if (strcmp(attr->attr.name, "current_limit") == 0)
1282                 ret = bq2415x_set_current_limit(bq, val);
1283         else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
1284                 ret = bq2415x_set_weak_battery_voltage(bq, val);
1285         else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
1286                 ret = bq2415x_set_battery_regulation_voltage(bq, val);
1287         else if (strcmp(attr->attr.name, "charge_current") == 0)
1288                 ret = bq2415x_set_charge_current(bq, val);
1289         else if (strcmp(attr->attr.name, "termination_current") == 0)
1290                 ret = bq2415x_set_termination_current(bq, val);
1291         else
1292                 return -EINVAL;
1293
1294         if (ret < 0)
1295                 return ret;
1296         else
1297                 return count;
1298 }
1299
1300 /* show current and voltage limit entries (in mA or mV) */
1301 static ssize_t bq2415x_sysfs_show_limit(struct device *dev,
1302                 struct device_attribute *attr, char *buf)
1303 {
1304         struct power_supply *psy = dev_get_drvdata(dev);
1305         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1306                                                 charger);
1307         int ret;
1308
1309         if (strcmp(attr->attr.name, "current_limit") == 0)
1310                 ret = bq2415x_get_current_limit(bq);
1311         else if (strcmp(attr->attr.name, "weak_battery_voltage") == 0)
1312                 ret = bq2415x_get_weak_battery_voltage(bq);
1313         else if (strcmp(attr->attr.name, "battery_regulation_voltage") == 0)
1314                 ret = bq2415x_get_battery_regulation_voltage(bq);
1315         else if (strcmp(attr->attr.name, "charge_current") == 0)
1316                 ret = bq2415x_get_charge_current(bq);
1317         else if (strcmp(attr->attr.name, "termination_current") == 0)
1318                 ret = bq2415x_get_termination_current(bq);
1319         else
1320                 return -EINVAL;
1321
1322         if (ret < 0)
1323                 return ret;
1324         else
1325                 return sprintf(buf, "%d\n", ret);
1326 }
1327
1328 /* set *_enable entries */
1329 static ssize_t bq2415x_sysfs_set_enable(struct device *dev,
1330                 struct device_attribute *attr, const char *buf, size_t count)
1331 {
1332         struct power_supply *psy = dev_get_drvdata(dev);
1333         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1334                                                 charger);
1335         enum bq2415x_command command;
1336         long val;
1337         int ret;
1338
1339         if (kstrtol(buf, 10, &val) < 0)
1340                 return -EINVAL;
1341
1342         if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
1343                 command = val ? BQ2415X_CHARGE_TERMINATION_ENABLE :
1344                         BQ2415X_CHARGE_TERMINATION_DISABLE;
1345         else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
1346                 command = val ? BQ2415X_HIGH_IMPEDANCE_ENABLE :
1347                         BQ2415X_HIGH_IMPEDANCE_DISABLE;
1348         else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
1349                 command = val ? BQ2415X_OTG_PIN_ENABLE :
1350                         BQ2415X_OTG_PIN_DISABLE;
1351         else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
1352                 command = val ? BQ2415X_STAT_PIN_ENABLE :
1353                         BQ2415X_STAT_PIN_DISABLE;
1354         else
1355                 return -EINVAL;
1356
1357         ret = bq2415x_exec_command(bq, command);
1358         if (ret < 0)
1359                 return ret;
1360         else
1361                 return count;
1362 }
1363
1364 /* show *_enable entries */
1365 static ssize_t bq2415x_sysfs_show_enable(struct device *dev,
1366                 struct device_attribute *attr, char *buf)
1367 {
1368         struct power_supply *psy = dev_get_drvdata(dev);
1369         struct bq2415x_device *bq = container_of(psy, struct bq2415x_device,
1370                                                 charger);
1371         enum bq2415x_command command;
1372         int ret;
1373
1374         if (strcmp(attr->attr.name, "charge_termination_enable") == 0)
1375                 command = BQ2415X_CHARGE_TERMINATION_STATUS;
1376         else if (strcmp(attr->attr.name, "high_impedance_enable") == 0)
1377                 command = BQ2415X_HIGH_IMPEDANCE_STATUS;
1378         else if (strcmp(attr->attr.name, "otg_pin_enable") == 0)
1379                 command = BQ2415X_OTG_PIN_STATUS;
1380         else if (strcmp(attr->attr.name, "stat_pin_enable") == 0)
1381                 command = BQ2415X_STAT_PIN_STATUS;
1382         else
1383                 return -EINVAL;
1384
1385         ret = bq2415x_exec_command(bq, command);
1386         if (ret < 0)
1387                 return ret;
1388         else
1389                 return sprintf(buf, "%d\n", ret);
1390 }
1391
1392 static DEVICE_ATTR(current_limit, S_IWUSR | S_IRUGO,
1393                 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1394 static DEVICE_ATTR(weak_battery_voltage, S_IWUSR | S_IRUGO,
1395                 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1396 static DEVICE_ATTR(battery_regulation_voltage, S_IWUSR | S_IRUGO,
1397                 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1398 static DEVICE_ATTR(charge_current, S_IWUSR | S_IRUGO,
1399                 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1400 static DEVICE_ATTR(termination_current, S_IWUSR | S_IRUGO,
1401                 bq2415x_sysfs_show_limit, bq2415x_sysfs_set_limit);
1402
1403 static DEVICE_ATTR(charge_termination_enable, S_IWUSR | S_IRUGO,
1404                 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1405 static DEVICE_ATTR(high_impedance_enable, S_IWUSR | S_IRUGO,
1406                 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1407 static DEVICE_ATTR(otg_pin_enable, S_IWUSR | S_IRUGO,
1408                 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1409 static DEVICE_ATTR(stat_pin_enable, S_IWUSR | S_IRUGO,
1410                 bq2415x_sysfs_show_enable, bq2415x_sysfs_set_enable);
1411
1412 static DEVICE_ATTR(reported_mode, S_IRUGO,
1413                 bq2415x_sysfs_show_reported_mode, NULL);
1414 static DEVICE_ATTR(mode, S_IWUSR | S_IRUGO,
1415                 bq2415x_sysfs_show_mode, bq2415x_sysfs_set_mode);
1416 static DEVICE_ATTR(timer, S_IWUSR | S_IRUGO,
1417                 bq2415x_sysfs_show_timer, bq2415x_sysfs_set_timer);
1418
1419 static DEVICE_ATTR(registers, S_IWUSR | S_IRUGO,
1420                 bq2415x_sysfs_show_registers, bq2415x_sysfs_set_registers);
1421
1422 static DEVICE_ATTR(otg_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1423 static DEVICE_ATTR(charge_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1424 static DEVICE_ATTR(boost_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1425 static DEVICE_ATTR(fault_status, S_IRUGO, bq2415x_sysfs_show_status, NULL);
1426
1427 static struct attribute *bq2415x_sysfs_attributes[] = {
1428         &dev_attr_current_limit.attr,
1429         &dev_attr_weak_battery_voltage.attr,
1430         &dev_attr_battery_regulation_voltage.attr,
1431         &dev_attr_charge_current.attr,
1432         &dev_attr_termination_current.attr,
1433
1434         &dev_attr_charge_termination_enable.attr,
1435         &dev_attr_high_impedance_enable.attr,
1436         &dev_attr_otg_pin_enable.attr,
1437         &dev_attr_stat_pin_enable.attr,
1438
1439         &dev_attr_reported_mode.attr,
1440         &dev_attr_mode.attr,
1441         &dev_attr_timer.attr,
1442
1443         &dev_attr_registers.attr,
1444
1445         &dev_attr_otg_status.attr,
1446         &dev_attr_charge_status.attr,
1447         &dev_attr_boost_status.attr,
1448         &dev_attr_fault_status.attr,
1449         NULL,
1450 };
1451
1452 static const struct attribute_group bq2415x_sysfs_attr_group = {
1453         .attrs = bq2415x_sysfs_attributes,
1454 };
1455
1456 static int bq2415x_sysfs_init(struct bq2415x_device *bq)
1457 {
1458         return sysfs_create_group(&bq->charger.dev->kobj,
1459                         &bq2415x_sysfs_attr_group);
1460 }
1461
1462 static void bq2415x_sysfs_exit(struct bq2415x_device *bq)
1463 {
1464         sysfs_remove_group(&bq->charger.dev->kobj, &bq2415x_sysfs_attr_group);
1465 }
1466
1467 /* main bq2415x probe function */
1468 static int bq2415x_probe(struct i2c_client *client,
1469                 const struct i2c_device_id *id)
1470 {
1471         int ret;
1472         int num;
1473         char *name;
1474         struct bq2415x_device *bq;
1475
1476         if (!client->dev.platform_data) {
1477                 dev_err(&client->dev, "platform data not set\n");
1478                 return -ENODEV;
1479         }
1480
1481         /* Get new ID for the new device */
1482         ret = idr_pre_get(&bq2415x_id, GFP_KERNEL);
1483         if (ret == 0)
1484                 return -ENOMEM;
1485
1486         mutex_lock(&bq2415x_id_mutex);
1487         ret = idr_get_new(&bq2415x_id, client, &num);
1488         mutex_unlock(&bq2415x_id_mutex);
1489
1490         if (ret < 0)
1491                 return ret;
1492
1493         name = kasprintf(GFP_KERNEL, "%s-%d", id->name, num);
1494         if (!name) {
1495                 dev_err(&client->dev, "failed to allocate device name\n");
1496                 ret = -ENOMEM;
1497                 goto error_1;
1498         }
1499
1500         bq = kzalloc(sizeof(*bq), GFP_KERNEL);
1501         if (!bq) {
1502                 dev_err(&client->dev, "failed to allocate device data\n");
1503                 ret = -ENOMEM;
1504                 goto error_2;
1505         }
1506
1507         i2c_set_clientdata(client, bq);
1508
1509         bq->id = num;
1510         bq->dev = &client->dev;
1511         bq->chip = id->driver_data;
1512         bq->name = name;
1513         bq->mode = BQ2415X_MODE_NONE;
1514         bq->reported_mode = BQ2415X_MODE_NONE;
1515         bq->autotimer = 0;
1516         bq->automode = 0;
1517
1518         memcpy(&bq->init_data, client->dev.platform_data,
1519                         sizeof(bq->init_data));
1520
1521         bq2415x_reset_chip(bq);
1522
1523         ret = bq2415x_power_supply_init(bq);
1524         if (ret) {
1525                 dev_err(bq->dev, "failed to register power supply: %d\n", ret);
1526                 goto error_3;
1527         }
1528
1529         ret = bq2415x_sysfs_init(bq);
1530         if (ret) {
1531                 dev_err(bq->dev, "failed to create sysfs entries: %d\n", ret);
1532                 goto error_4;
1533         }
1534
1535         ret = bq2415x_set_defaults(bq);
1536         if (ret) {
1537                 dev_err(bq->dev, "failed to set default values: %d\n", ret);
1538                 goto error_5;
1539         }
1540
1541         if (bq->init_data.set_mode_hook) {
1542                 if (bq->init_data.set_mode_hook(
1543                                 bq2415x_hook_function, bq)) {
1544                         bq->automode = 1;
1545                         bq2415x_set_mode(bq, bq->reported_mode);
1546                         dev_info(bq->dev, "automode enabled\n");
1547                 } else {
1548                         bq->automode = -1;
1549                         dev_info(bq->dev, "automode failed\n");
1550                 }
1551         } else {
1552                 bq->automode = -1;
1553                 dev_info(bq->dev, "automode not supported\n");
1554         }
1555
1556         INIT_DELAYED_WORK(&bq->work, bq2415x_timer_work);
1557         bq2415x_set_autotimer(bq, 1);
1558
1559         dev_info(bq->dev, "driver registered\n");
1560         return 0;
1561
1562 error_5:
1563         bq2415x_sysfs_exit(bq);
1564 error_4:
1565         bq2415x_power_supply_exit(bq);
1566 error_3:
1567         kfree(bq);
1568 error_2:
1569         kfree(name);
1570 error_1:
1571         mutex_lock(&bq2415x_id_mutex);
1572         idr_remove(&bq2415x_id, num);
1573         mutex_unlock(&bq2415x_id_mutex);
1574
1575         return ret;
1576 }
1577
1578 /* main bq2415x remove function */
1579
1580 static int bq2415x_remove(struct i2c_client *client)
1581 {
1582         struct bq2415x_device *bq = i2c_get_clientdata(client);
1583
1584         if (bq->init_data.set_mode_hook)
1585                 bq->init_data.set_mode_hook(NULL, NULL);
1586
1587         bq2415x_sysfs_exit(bq);
1588         bq2415x_power_supply_exit(bq);
1589
1590         bq2415x_reset_chip(bq);
1591
1592         mutex_lock(&bq2415x_id_mutex);
1593         idr_remove(&bq2415x_id, bq->id);
1594         mutex_unlock(&bq2415x_id_mutex);
1595
1596         dev_info(bq->dev, "driver unregistered\n");
1597
1598         kfree(bq->name);
1599         kfree(bq);
1600
1601         return 0;
1602 }
1603
1604 static const struct i2c_device_id bq2415x_i2c_id_table[] = {
1605         { "bq2415x", BQUNKNOWN },
1606         { "bq24150", BQ24150 },
1607         { "bq24150a", BQ24150A },
1608         { "bq24151", BQ24151 },
1609         { "bq24151a", BQ24151A },
1610         { "bq24152", BQ24152 },
1611         { "bq24153", BQ24153 },
1612         { "bq24153a", BQ24153A },
1613         { "bq24155", BQ24155 },
1614         { "bq24156", BQ24156 },
1615         { "bq24156a", BQ24156A },
1616         { "bq24158", BQ24158 },
1617         {},
1618 };
1619 MODULE_DEVICE_TABLE(i2c, bq2415x_i2c_id_table);
1620
1621 static struct i2c_driver bq2415x_driver = {
1622         .driver = {
1623                 .name = "bq2415x-charger",
1624         },
1625         .probe = bq2415x_probe,
1626         .remove = bq2415x_remove,
1627         .id_table = bq2415x_i2c_id_table,
1628 };
1629
1630 static int __init bq2415x_init(void)
1631 {
1632         return i2c_add_driver(&bq2415x_driver);
1633 }
1634 module_init(bq2415x_init);
1635
1636 static void __exit bq2415x_exit(void)
1637 {
1638         i2c_del_driver(&bq2415x_driver);
1639 }
1640 module_exit(bq2415x_exit);
1641
1642 MODULE_AUTHOR("Pali Rohár <pali.rohar@gmail.com>");
1643 MODULE_DESCRIPTION("bq2415x charger driver");
1644 MODULE_LICENSE("GPL");