Pileus Git - ~andy/linux/blob - drivers/power/max17042_battery.c

   1 /*
   2  * Fuel gauge driver for Maxim 17042 / 8966 / 8997
   3  *  Note that Maxim 8966 and 8997 are mfd and this is its subdevice.
   4  *
   5  * Copyright (C) 2011 Samsung Electronics
   6  * MyungJoo Ham <myungjoo.ham@samsung.com>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the Free Software
  20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  21  *
  22  * This driver is based on max17040_battery.c
  23  */
  24
  25 #include <linux/init.h>
  26 #include <linux/module.h>
  27 #include <linux/slab.h>
  28 #include <linux/i2c.h>
  29 #include <linux/delay.h>
  30 #include <linux/interrupt.h>
  31 #include <linux/mod_devicetable.h>
  32 #include <linux/power_supply.h>
  33 #include <linux/power/max17042_battery.h>
  34 #include <linux/of.h>
  35
  36 /* Status register bits */
  37 #define STATUS_POR_BIT         (1 << 1)
  38 #define STATUS_BST_BIT         (1 << 3)
  39 #define STATUS_VMN_BIT         (1 << 8)
  40 #define STATUS_TMN_BIT         (1 << 9)
  41 #define STATUS_SMN_BIT         (1 << 10)
  42 #define STATUS_BI_BIT          (1 << 11)
  43 #define STATUS_VMX_BIT         (1 << 12)
  44 #define STATUS_TMX_BIT         (1 << 13)
  45 #define STATUS_SMX_BIT         (1 << 14)
  46 #define STATUS_BR_BIT          (1 << 15)
  47
  48 /* Interrupt mask bits */
  49 #define CONFIG_ALRT_BIT_ENBL    (1 << 2)
  50 #define STATUS_INTR_SOCMIN_BIT  (1 << 10)
  51 #define STATUS_INTR_SOCMAX_BIT  (1 << 14)
  52
  53 #define VFSOC0_LOCK             0x0000
  54 #define VFSOC0_UNLOCK           0x0080
  55 #define MODEL_UNLOCK1   0X0059
  56 #define MODEL_UNLOCK2   0X00C4
  57 #define MODEL_LOCK1             0X0000
  58 #define MODEL_LOCK2             0X0000
  59
  60 #define dQ_ACC_DIV      0x4
  61 #define dP_ACC_100      0x1900
  62 #define dP_ACC_200      0x3200
  63
  64 struct max17042_chip {
  65         struct i2c_client *client;
  66         struct power_supply battery;
  67         struct max17042_platform_data *pdata;
  68         struct work_struct work;
  69         int    init_complete;
  70 };
  71
  72 static int max17042_write_reg(struct i2c_client *client, u8 reg, u16 value)
  73 {
  74         int ret = i2c_smbus_write_word_data(client, reg, value);
  75
  76         if (ret < 0)
  77                 dev_err(&client->dev, "%s: err %d\n", __func__, ret);
  78
  79         return ret;
  80 }
  81
  82 static int max17042_read_reg(struct i2c_client *client, u8 reg)
  83 {
  84         int ret = i2c_smbus_read_word_data(client, reg);
  85
  86         if (ret < 0)
  87                 dev_err(&client->dev, "%s: err %d\n", __func__, ret);
  88
  89         return ret;
  90 }
  91
  92 static void max17042_set_reg(struct i2c_client *client,
  93                              struct max17042_reg_data *data, int size)
  94 {
  95         int i;
  96
  97         for (i = 0; i < size; i++)
  98                 max17042_write_reg(client, data[i].addr, data[i].data);
  99 }
 100
 101 static enum power_supply_property max17042_battery_props[] = {
 102         POWER_SUPPLY_PROP_PRESENT,
 103         POWER_SUPPLY_PROP_CYCLE_COUNT,
 104         POWER_SUPPLY_PROP_VOLTAGE_MAX,
 105         POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN,
 106         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 107         POWER_SUPPLY_PROP_VOLTAGE_AVG,
 108         POWER_SUPPLY_PROP_CAPACITY,
 109         POWER_SUPPLY_PROP_CHARGE_FULL,
 110         POWER_SUPPLY_PROP_TEMP,
 111         POWER_SUPPLY_PROP_CURRENT_NOW,
 112         POWER_SUPPLY_PROP_CURRENT_AVG,
 113 };
 114
 115 static int max17042_get_property(struct power_supply *psy,
 116                             enum power_supply_property psp,
 117                             union power_supply_propval *val)
 118 {
 119         struct max17042_chip *chip = container_of(psy,
 120                                 struct max17042_chip, battery);
 121         int ret;
 122
 123         if (!chip->init_complete)
 124                 return -EAGAIN;
 125
 126         switch (psp) {
 127         case POWER_SUPPLY_PROP_PRESENT:
 128                 ret = max17042_read_reg(chip->client, MAX17042_STATUS);
 129                 if (ret < 0)
 130                         return ret;
 131
 132                 if (ret & MAX17042_STATUS_BattAbsent)
 133                         val->intval = 0;
 134                 else
 135                         val->intval = 1;
 136                 break;
 137         case POWER_SUPPLY_PROP_CYCLE_COUNT:
 138                 ret = max17042_read_reg(chip->client, MAX17042_Cycles);
 139                 if (ret < 0)
 140                         return ret;
 141
 142                 val->intval = ret;
 143                 break;
 144         case POWER_SUPPLY_PROP_VOLTAGE_MAX:
 145                 ret = max17042_read_reg(chip->client, MAX17042_MinMaxVolt);
 146                 if (ret < 0)
 147                         return ret;
 148
 149                 val->intval = ret >> 8;
 150                 val->intval *= 20000; /* Units of LSB = 20mV */
 151                 break;
 152         case POWER_SUPPLY_PROP_VOLTAGE_MIN_DESIGN:
 153                 ret = max17042_read_reg(chip->client, MAX17042_V_empty);
 154                 if (ret < 0)
 155                         return ret;
 156
 157                 val->intval = ret >> 7;
 158                 val->intval *= 10000; /* Units of LSB = 10mV */
 159                 break;
 160         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 161                 ret = max17042_read_reg(chip->client, MAX17042_VCELL);
 162                 if (ret < 0)
 163                         return ret;
 164
 165                 val->intval = ret * 625 / 8;
 166                 break;
 167         case POWER_SUPPLY_PROP_VOLTAGE_AVG:
 168                 ret = max17042_read_reg(chip->client, MAX17042_AvgVCELL);
 169                 if (ret < 0)
 170                         return ret;
 171
 172                 val->intval = ret * 625 / 8;
 173                 break;
 174         case POWER_SUPPLY_PROP_CAPACITY:
 175                 ret = max17042_read_reg(chip->client, MAX17042_RepSOC);
 176                 if (ret < 0)
 177                         return ret;
 178
 179                 val->intval = ret >> 8;
 180                 break;
 181         case POWER_SUPPLY_PROP_CHARGE_FULL:
 182                 ret = max17042_read_reg(chip->client, MAX17042_FullCAP);
 183                 if (ret < 0)
 184                         return ret;
 185
 186                 val->intval = ret * 1000 / 2;
 187                 break;
 188         case POWER_SUPPLY_PROP_TEMP:
 189                 ret = max17042_read_reg(chip->client, MAX17042_TEMP);
 190                 if (ret < 0)
 191                         return ret;
 192
 193                 val->intval = ret;
 194                 /* The value is signed. */
 195                 if (val->intval & 0x8000) {
 196                         val->intval = (0x7fff & ~val->intval) + 1;
 197                         val->intval *= -1;
 198                 }
 199                 /* The value is converted into deci-centigrade scale */
 200                 /* Units of LSB = 1 / 256 degree Celsius */
 201                 val->intval = val->intval * 10 / 256;
 202                 break;
 203         case POWER_SUPPLY_PROP_CURRENT_NOW:
 204                 if (chip->pdata->enable_current_sense) {
 205                         ret = max17042_read_reg(chip->client, MAX17042_Current);
 206                         if (ret < 0)
 207                                 return ret;
 208
 209                         val->intval = ret;
 210                         if (val->intval & 0x8000) {
 211                                 /* Negative */
 212                                 val->intval = ~val->intval & 0x7fff;
 213                                 val->intval++;
 214                                 val->intval *= -1;
 215                         }
 216                         val->intval *= 1562500 / chip->pdata->r_sns;
 217                 } else {
 218                         return -EINVAL;
 219                 }
 220                 break;
 221         case POWER_SUPPLY_PROP_CURRENT_AVG:
 222                 if (chip->pdata->enable_current_sense) {
 223                         ret = max17042_read_reg(chip->client,
 224                                                 MAX17042_AvgCurrent);
 225                         if (ret < 0)
 226                                 return ret;
 227
 228                         val->intval = ret;
 229                         if (val->intval & 0x8000) {
 230                                 /* Negative */
 231                                 val->intval = ~val->intval & 0x7fff;
 232                                 val->intval++;
 233                                 val->intval *= -1;
 234                         }
 235                         val->intval *= 1562500 / chip->pdata->r_sns;
 236                 } else {
 237                         return -EINVAL;
 238                 }
 239                 break;
 240         default:
 241                 return -EINVAL;
 242         }
 243         return 0;
 244 }
 245
 246 static int max17042_write_verify_reg(struct i2c_client *client,
 247                                 u8 reg, u16 value)
 248 {
 249         int retries = 8;
 250         int ret;
 251         u16 read_value;
 252
 253         do {
 254                 ret = i2c_smbus_write_word_data(client, reg, value);
 255                 read_value =  max17042_read_reg(client, reg);
 256                 if (read_value != value) {
 257                         ret = -EIO;
 258                         retries--;
 259                 }
 260         } while (retries && read_value != value);
 261
 262         if (ret < 0)
 263                 dev_err(&client->dev, "%s: err %d\n", __func__, ret);
 264
 265         return ret;
 266 }
 267
 268 static inline void max17042_override_por(
 269         struct i2c_client *client, u8 reg, u16 value)
 270 {
 271         if (value)
 272                 max17042_write_reg(client, reg, value);
 273 }
 274
 275 static inline void max10742_unlock_model(struct max17042_chip *chip)
 276 {
 277         struct i2c_client *client = chip->client;
 278         max17042_write_reg(client, MAX17042_MLOCKReg1, MODEL_UNLOCK1);
 279         max17042_write_reg(client, MAX17042_MLOCKReg2, MODEL_UNLOCK2);
 280 }
 281
 282 static inline void max10742_lock_model(struct max17042_chip *chip)
 283 {
 284         struct i2c_client *client = chip->client;
 285         max17042_write_reg(client, MAX17042_MLOCKReg1, MODEL_LOCK1);
 286         max17042_write_reg(client, MAX17042_MLOCKReg2, MODEL_LOCK2);
 287 }
 288
 289 static inline void max17042_write_model_data(struct max17042_chip *chip,
 290                                         u8 addr, int size)
 291 {
 292         struct i2c_client *client = chip->client;
 293         int i;
 294         for (i = 0; i < size; i++)
 295                 max17042_write_reg(client, addr + i,
 296                                 chip->pdata->config_data->cell_char_tbl[i]);
 297 }
 298
 299 static inline void max17042_read_model_data(struct max17042_chip *chip,
 300                                         u8 addr, u16 *data, int size)
 301 {
 302         struct i2c_client *client = chip->client;
 303         int i;
 304
 305         for (i = 0; i < size; i++)
 306                 data[i] = max17042_read_reg(client, addr + i);
 307 }
 308
 309 static inline int max17042_model_data_compare(struct max17042_chip *chip,
 310                                         u16 *data1, u16 *data2, int size)
 311 {
 312         int i;
 313
 314         if (memcmp(data1, data2, size)) {
 315                 dev_err(&chip->client->dev, "%s compare failed\n", __func__);
 316                 for (i = 0; i < size; i++)
 317                         dev_info(&chip->client->dev, "0x%x, 0x%x",
 318                                 data1[i], data2[i]);
 319                 dev_info(&chip->client->dev, "\n");
 320                 return -EINVAL;
 321         }
 322         return 0;
 323 }
 324
 325 static int max17042_init_model(struct max17042_chip *chip)
 326 {
 327         int ret;
 328         int table_size =
 329                 sizeof(chip->pdata->config_data->cell_char_tbl)/sizeof(u16);
 330         u16 *temp_data;
 331
 332         temp_data = kzalloc(table_size, GFP_KERNEL);
 333         if (!temp_data)
 334                 return -ENOMEM;
 335
 336         max10742_unlock_model(chip);
 337         max17042_write_model_data(chip, MAX17042_MODELChrTbl,
 338                                 table_size);
 339         max17042_read_model_data(chip, MAX17042_MODELChrTbl, temp_data,
 340                                 table_size);
 341
 342         ret = max17042_model_data_compare(
 343                 chip,
 344                 chip->pdata->config_data->cell_char_tbl,
 345                 temp_data,
 346                 table_size);
 347
 348         max10742_lock_model(chip);
 349         kfree(temp_data);
 350
 351         return ret;
 352 }
 353
 354 static int max17042_verify_model_lock(struct max17042_chip *chip)
 355 {
 356         int i;
 357         int table_size =
 358                 sizeof(chip->pdata->config_data->cell_char_tbl);
 359         u16 *temp_data;
 360         int ret = 0;
 361
 362         temp_data = kzalloc(table_size, GFP_KERNEL);
 363         if (!temp_data)
 364                 return -ENOMEM;
 365
 366         max17042_read_model_data(chip, MAX17042_MODELChrTbl, temp_data,
 367                                 table_size);
 368         for (i = 0; i < table_size; i++)
 369                 if (temp_data[i])
 370                         ret = -EINVAL;
 371
 372         kfree(temp_data);
 373         return ret;
 374 }
 375
 376 static void max17042_write_config_regs(struct max17042_chip *chip)
 377 {
 378         struct max17042_config_data *config = chip->pdata->config_data;
 379
 380         max17042_write_reg(chip->client, MAX17042_CONFIG, config->config);
 381         max17042_write_reg(chip->client, MAX17042_LearnCFG, config->learn_cfg);
 382         max17042_write_reg(chip->client, MAX17042_FilterCFG,
 383                         config->filter_cfg);
 384         max17042_write_reg(chip->client, MAX17042_RelaxCFG, config->relax_cfg);
 385 }
 386
 387 static void  max17042_write_custom_regs(struct max17042_chip *chip)
 388 {
 389         struct max17042_config_data *config = chip->pdata->config_data;
 390
 391         max17042_write_verify_reg(chip->client, MAX17042_RCOMP0,
 392                                 config->rcomp0);
 393         max17042_write_verify_reg(chip->client, MAX17042_TempCo,
 394                                 config->tcompc0);
 395         max17042_write_reg(chip->client, MAX17042_EmptyTempCo,
 396                         config->empty_tempco);
 397         max17042_write_verify_reg(chip->client, MAX17042_K_empty0,
 398                                 config->kempty0);
 399         max17042_write_verify_reg(chip->client, MAX17042_ICHGTerm,
 400                                 config->ichgt_term);
 401 }
 402
 403 static void max17042_update_capacity_regs(struct max17042_chip *chip)
 404 {
 405         struct max17042_config_data *config = chip->pdata->config_data;
 406
 407         max17042_write_verify_reg(chip->client, MAX17042_FullCAP,
 408                                 config->fullcap);
 409         max17042_write_reg(chip->client, MAX17042_DesignCap,
 410                         config->design_cap);
 411         max17042_write_verify_reg(chip->client, MAX17042_FullCAPNom,
 412                                 config->fullcapnom);
 413 }
 414
 415 static void max17042_reset_vfsoc0_reg(struct max17042_chip *chip)
 416 {
 417         u16 vfSoc;
 418
 419         vfSoc = max17042_read_reg(chip->client, MAX17042_VFSOC);
 420         max17042_write_reg(chip->client, MAX17042_VFSOC0Enable, VFSOC0_UNLOCK);
 421         max17042_write_verify_reg(chip->client, MAX17042_VFSOC0, vfSoc);
 422         max17042_write_reg(chip->client, MAX17042_VFSOC0Enable, VFSOC0_LOCK);
 423 }
 424
 425 static void max17042_load_new_capacity_params(struct max17042_chip *chip)
 426 {
 427         u16 full_cap0, rep_cap, dq_acc, vfSoc;
 428         u32 rem_cap;
 429
 430         struct max17042_config_data *config = chip->pdata->config_data;
 431
 432         full_cap0 = max17042_read_reg(chip->client, MAX17042_FullCAP0);
 433         vfSoc = max17042_read_reg(chip->client, MAX17042_VFSOC);
 434
 435         /* fg_vfSoc needs to shifted by 8 bits to get the
 436          * perc in 1% accuracy, to get the right rem_cap multiply
 437          * full_cap0, fg_vfSoc and devide by 100
 438          */
 439         rem_cap = ((vfSoc >> 8) * full_cap0) / 100;
 440         max17042_write_verify_reg(chip->client, MAX17042_RemCap, (u16)rem_cap);
 441
 442         rep_cap = (u16)rem_cap;
 443         max17042_write_verify_reg(chip->client, MAX17042_RepCap, rep_cap);
 444
 445         /* Write dQ_acc to 200% of Capacity and dP_acc to 200% */
 446         dq_acc = config->fullcap / dQ_ACC_DIV;
 447         max17042_write_verify_reg(chip->client, MAX17042_dQacc, dq_acc);
 448         max17042_write_verify_reg(chip->client, MAX17042_dPacc, dP_ACC_200);
 449
 450         max17042_write_verify_reg(chip->client, MAX17042_FullCAP,
 451                         config->fullcap);
 452         max17042_write_reg(chip->client, MAX17042_DesignCap,
 453                         config->design_cap);
 454         max17042_write_verify_reg(chip->client, MAX17042_FullCAPNom,
 455                         config->fullcapnom);
 456 }
 457
 458 /*
 459  * Block write all the override values coming from platform data.
 460  * This function MUST be called before the POR initialization proceedure
 461  * specified by maxim.
 462  */
 463 static inline void max17042_override_por_values(struct max17042_chip *chip)
 464 {
 465         struct i2c_client *client = chip->client;
 466         struct max17042_config_data *config = chip->pdata->config_data;
 467
 468         max17042_override_por(client, MAX17042_TGAIN, config->tgain);
 469         max17042_override_por(client, MAx17042_TOFF, config->toff);
 470         max17042_override_por(client, MAX17042_CGAIN, config->cgain);
 471         max17042_override_por(client, MAX17042_COFF, config->coff);
 472
 473         max17042_override_por(client, MAX17042_VALRT_Th, config->valrt_thresh);
 474         max17042_override_por(client, MAX17042_TALRT_Th, config->talrt_thresh);
 475         max17042_override_por(client, MAX17042_SALRT_Th,
 476                         config->soc_alrt_thresh);
 477         max17042_override_por(client, MAX17042_CONFIG, config->config);
 478         max17042_override_por(client, MAX17042_SHDNTIMER, config->shdntimer);
 479
 480         max17042_override_por(client, MAX17042_DesignCap, config->design_cap);
 481         max17042_override_por(client, MAX17042_ICHGTerm, config->ichgt_term);
 482
 483         max17042_override_por(client, MAX17042_AtRate, config->at_rate);
 484         max17042_override_por(client, MAX17042_LearnCFG, config->learn_cfg);
 485         max17042_override_por(client, MAX17042_FilterCFG, config->filter_cfg);
 486         max17042_override_por(client, MAX17042_RelaxCFG, config->relax_cfg);
 487         max17042_override_por(client, MAX17042_MiscCFG, config->misc_cfg);
 488         max17042_override_por(client, MAX17042_MaskSOC, config->masksoc);
 489
 490         max17042_override_por(client, MAX17042_FullCAP, config->fullcap);
 491         max17042_override_por(client, MAX17042_FullCAPNom, config->fullcapnom);
 492         max17042_override_por(client, MAX17042_SOC_empty, config->socempty);
 493         max17042_override_por(client, MAX17042_LAvg_empty, config->lavg_empty);
 494         max17042_override_por(client, MAX17042_dQacc, config->dqacc);
 495         max17042_override_por(client, MAX17042_dPacc, config->dpacc);
 496
 497         max17042_override_por(client, MAX17042_V_empty, config->vempty);
 498         max17042_override_por(client, MAX17042_TempNom, config->temp_nom);
 499         max17042_override_por(client, MAX17042_TempLim, config->temp_lim);
 500         max17042_override_por(client, MAX17042_FCTC, config->fctc);
 501         max17042_override_por(client, MAX17042_RCOMP0, config->rcomp0);
 502         max17042_override_por(client, MAX17042_TempCo, config->tcompc0);
 503         max17042_override_por(client, MAX17042_EmptyTempCo,
 504                         config->empty_tempco);
 505         max17042_override_por(client, MAX17042_K_empty0, config->kempty0);
 506 }
 507
 508 static int max17042_init_chip(struct max17042_chip *chip)
 509 {
 510         int ret;
 511         int val;
 512
 513         max17042_override_por_values(chip);
 514         /* After Power up, the MAX17042 requires 500mS in order
 515          * to perform signal debouncing and initial SOC reporting
 516          */
 517         msleep(500);
 518
 519         /* Initialize configaration */
 520         max17042_write_config_regs(chip);
 521
 522         /* write cell characterization data */
 523         ret = max17042_init_model(chip);
 524         if (ret) {
 525                 dev_err(&chip->client->dev, "%s init failed\n",
 526                         __func__);
 527                 return -EIO;
 528         }
 529         max17042_verify_model_lock(chip);
 530         if (ret) {
 531                 dev_err(&chip->client->dev, "%s lock verify failed\n",
 532                         __func__);
 533                 return -EIO;
 534         }
 535         /* write custom parameters */
 536         max17042_write_custom_regs(chip);
 537
 538         /* update capacity params */
 539         max17042_update_capacity_regs(chip);
 540
 541         /* delay must be atleast 350mS to allow VFSOC
 542          * to be calculated from the new configuration
 543          */
 544         msleep(350);
 545
 546         /* reset vfsoc0 reg */
 547         max17042_reset_vfsoc0_reg(chip);
 548
 549         /* load new capacity params */
 550         max17042_load_new_capacity_params(chip);
 551
 552         /* Init complete, Clear the POR bit */
 553         val = max17042_read_reg(chip->client, MAX17042_STATUS);
 554         max17042_write_reg(chip->client, MAX17042_STATUS,
 555                         val & (~STATUS_POR_BIT));
 556         return 0;
 557 }
 558
 559 static void max17042_set_soc_threshold(struct max17042_chip *chip, u16 off)
 560 {
 561         u16 soc, soc_tr;
 562
 563         /* program interrupt thesholds such that we should
 564          * get interrupt for every 'off' perc change in the soc
 565          */
 566         soc = max17042_read_reg(chip->client, MAX17042_RepSOC) >> 8;
 567         soc_tr = (soc + off) << 8;
 568         soc_tr |= (soc - off);
 569         max17042_write_reg(chip->client, MAX17042_SALRT_Th, soc_tr);
 570 }
 571
 572 static irqreturn_t max17042_thread_handler(int id, void *dev)
 573 {
 574         struct max17042_chip *chip = dev;
 575         u16 val;
 576
 577         val = max17042_read_reg(chip->client, MAX17042_STATUS);
 578         if ((val & STATUS_INTR_SOCMIN_BIT) ||
 579                 (val & STATUS_INTR_SOCMAX_BIT)) {
 580                 dev_info(&chip->client->dev, "SOC threshold INTR\n");
 581                 max17042_set_soc_threshold(chip, 1);
 582         }
 583
 584         power_supply_changed(&chip->battery);
 585         return IRQ_HANDLED;
 586 }
 587
 588 static void max17042_init_worker(struct work_struct *work)
 589 {
 590         struct max17042_chip *chip = container_of(work,
 591                                 struct max17042_chip, work);
 592         int ret;
 593
 594         /* Initialize registers according to values from the platform data */
 595         if (chip->pdata->enable_por_init && chip->pdata->config_data) {
 596                 ret = max17042_init_chip(chip);
 597                 if (ret)
 598                         return;
 599         }
 600
 601         chip->init_complete = 1;
 602 }
 603
 604 #ifdef CONFIG_OF
 605 static struct max17042_platform_data *
 606 max17042_get_pdata(struct device *dev)
 607 {
 608         struct device_node *np = dev->of_node;
 609         u32 prop;
 610         struct max17042_platform_data *pdata;
 611
 612         if (!np)
 613                 return dev->platform_data;
 614
 615         pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
 616         if (!pdata)
 617                 return NULL;
 618
 619         /*
 620          * Require current sense resistor value to be specified for
 621          * current-sense functionality to be enabled at all.
 622          */
 623         if (of_property_read_u32(np, "maxim,rsns-microohm", &prop) == 0) {
 624                 pdata->r_sns = prop;
 625                 pdata->enable_current_sense = true;
 626         }
 627
 628         return pdata;
 629 }
 630 #else
 631 static struct max17042_platform_data *
 632 max17042_get_pdata(struct device *dev)
 633 {
 634         return dev->platform_data;
 635 }
 636 #endif
 637
 638 static int __devinit max17042_probe(struct i2c_client *client,
 639                         const struct i2c_device_id *id)
 640 {
 641         struct i2c_adapter *adapter = to_i2c_adapter(client->dev.parent);
 642         struct max17042_chip *chip;
 643         int ret;
 644         int reg;
 645
 646         if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_WORD_DATA))
 647                 return -EIO;
 648
 649         chip = devm_kzalloc(&client->dev, sizeof(*chip), GFP_KERNEL);
 650         if (!chip)
 651                 return -ENOMEM;
 652
 653         chip->client = client;
 654         chip->pdata = max17042_get_pdata(&client->dev);
 655         if (!chip->pdata) {
 656                 dev_err(&client->dev, "no platform data provided\n");
 657                 return -EINVAL;
 658         }
 659
 660         i2c_set_clientdata(client, chip);
 661
 662         chip->battery.name              = "max17042_battery";
 663         chip->battery.type              = POWER_SUPPLY_TYPE_BATTERY;
 664         chip->battery.get_property      = max17042_get_property;
 665         chip->battery.properties        = max17042_battery_props;
 666         chip->battery.num_properties    = ARRAY_SIZE(max17042_battery_props);
 667
 668         /* When current is not measured,
 669          * CURRENT_NOW and CURRENT_AVG properties should be invisible. */
 670         if (!chip->pdata->enable_current_sense)
 671                 chip->battery.num_properties -= 2;
 672
 673         if (chip->pdata->r_sns == 0)
 674                 chip->pdata->r_sns = MAX17042_DEFAULT_SNS_RESISTOR;
 675
 676         if (chip->pdata->init_data)
 677                 max17042_set_reg(client, chip->pdata->init_data,
 678                                 chip->pdata->num_init_data);
 679
 680         if (!chip->pdata->enable_current_sense) {
 681                 max17042_write_reg(client, MAX17042_CGAIN, 0x0000);
 682                 max17042_write_reg(client, MAX17042_MiscCFG, 0x0003);
 683                 max17042_write_reg(client, MAX17042_LearnCFG, 0x0007);
 684         }
 685
 686         if (client->irq) {
 687                 ret = request_threaded_irq(client->irq, NULL,
 688                                                 max17042_thread_handler,
 689                                                 IRQF_TRIGGER_FALLING,
 690                                                 chip->battery.name, chip);
 691                 if (!ret) {
 692                         reg =  max17042_read_reg(client, MAX17042_CONFIG);
 693                         reg |= CONFIG_ALRT_BIT_ENBL;
 694                         max17042_write_reg(client, MAX17042_CONFIG, reg);
 695                         max17042_set_soc_threshold(chip, 1);
 696                 } else
 697                         dev_err(&client->dev, "%s(): cannot get IRQ\n",
 698                                 __func__);
 699         }
 700
 701         reg = max17042_read_reg(chip->client, MAX17042_STATUS);
 702
 703         if (reg & STATUS_POR_BIT) {
 704                 INIT_WORK(&chip->work, max17042_init_worker);
 705                 schedule_work(&chip->work);
 706         } else {
 707                 chip->init_complete = 1;
 708         }
 709
 710         ret = power_supply_register(&client->dev, &chip->battery);
 711         if (ret)
 712                 dev_err(&client->dev, "failed: power supply register\n");
 713         return ret;
 714 }
 715
 716 static int __devexit max17042_remove(struct i2c_client *client)
 717 {
 718         struct max17042_chip *chip = i2c_get_clientdata(client);
 719
 720         power_supply_unregister(&chip->battery);
 721         return 0;
 722 }
 723
 724 #ifdef CONFIG_OF
 725 static const struct of_device_id max17042_dt_match[] = {
 726         { .compatible = "maxim,max17042" },
 727         { },
 728 };
 729 MODULE_DEVICE_TABLE(of, max17042_dt_match);
 730 #endif
 731
 732 static const struct i2c_device_id max17042_id[] = {
 733         { "max17042", 0 },
 734         { }
 735 };
 736 MODULE_DEVICE_TABLE(i2c, max17042_id);
 737
 738 static struct i2c_driver max17042_i2c_driver = {
 739         .driver = {
 740                 .name   = "max17042",
 741                 .of_match_table = of_match_ptr(max17042_dt_match),
 742         },
 743         .probe          = max17042_probe,
 744         .remove         = __devexit_p(max17042_remove),
 745         .id_table       = max17042_id,
 746 };
 747 module_i2c_driver(max17042_i2c_driver);
 748
 749 MODULE_AUTHOR("MyungJoo Ham <myungjoo.ham@samsung.com>");
 750 MODULE_DESCRIPTION("MAX17042 Fuel Gauge");
 751 MODULE_LICENSE("GPL");