linux/drivers/power/ab8500_charger.c
<<
>>
Prefs
   1/*
   2 * Copyright (C) ST-Ericsson SA 2012
   3 *
   4 * Charger driver for AB8500
   5 *
   6 * License Terms: GNU General Public License v2
   7 * Author:
   8 *      Johan Palsson <johan.palsson@stericsson.com>
   9 *      Karl Komierowski <karl.komierowski@stericsson.com>
  10 *      Arun R Murthy <arun.murthy@stericsson.com>
  11 */
  12
  13#include <linux/init.h>
  14#include <linux/module.h>
  15#include <linux/device.h>
  16#include <linux/interrupt.h>
  17#include <linux/delay.h>
  18#include <linux/notifier.h>
  19#include <linux/slab.h>
  20#include <linux/platform_device.h>
  21#include <linux/power_supply.h>
  22#include <linux/completion.h>
  23#include <linux/regulator/consumer.h>
  24#include <linux/err.h>
  25#include <linux/workqueue.h>
  26#include <linux/kobject.h>
  27#include <linux/of.h>
  28#include <linux/mfd/core.h>
  29#include <linux/mfd/abx500/ab8500.h>
  30#include <linux/mfd/abx500.h>
  31#include <linux/mfd/abx500/ab8500-bm.h>
  32#include <linux/mfd/abx500/ab8500-gpadc.h>
  33#include <linux/mfd/abx500/ux500_chargalg.h>
  34#include <linux/usb/otg.h>
  35#include <linux/mutex.h>
  36
  37/* Charger constants */
  38#define NO_PW_CONN                      0
  39#define AC_PW_CONN                      1
  40#define USB_PW_CONN                     2
  41
  42#define MAIN_WDOG_ENA                   0x01
  43#define MAIN_WDOG_KICK                  0x02
  44#define MAIN_WDOG_DIS                   0x00
  45#define CHARG_WD_KICK                   0x01
  46#define MAIN_CH_ENA                     0x01
  47#define MAIN_CH_NO_OVERSHOOT_ENA_N      0x02
  48#define USB_CH_ENA                      0x01
  49#define USB_CHG_NO_OVERSHOOT_ENA_N      0x02
  50#define MAIN_CH_DET                     0x01
  51#define MAIN_CH_CV_ON                   0x04
  52#define USB_CH_CV_ON                    0x08
  53#define VBUS_DET_DBNC100                0x02
  54#define VBUS_DET_DBNC1                  0x01
  55#define OTP_ENABLE_WD                   0x01
  56#define DROP_COUNT_RESET                0x01
  57#define USB_CH_DET                      0x01
  58
  59#define MAIN_CH_INPUT_CURR_SHIFT        4
  60#define VBUS_IN_CURR_LIM_SHIFT          4
  61#define AB8540_VBUS_IN_CURR_LIM_SHIFT   2
  62#define AUTO_VBUS_IN_CURR_LIM_SHIFT     4
  63#define AB8540_AUTO_VBUS_IN_CURR_MASK   0x3F
  64#define VBUS_IN_CURR_LIM_RETRY_SET_TIME 30 /* seconds */
  65
  66#define LED_INDICATOR_PWM_ENA           0x01
  67#define LED_INDICATOR_PWM_DIS           0x00
  68#define LED_IND_CUR_5MA                 0x04
  69#define LED_INDICATOR_PWM_DUTY_252_256  0xBF
  70
  71/* HW failure constants */
  72#define MAIN_CH_TH_PROT                 0x02
  73#define VBUS_CH_NOK                     0x08
  74#define USB_CH_TH_PROT                  0x02
  75#define VBUS_OVV_TH                     0x01
  76#define MAIN_CH_NOK                     0x01
  77#define VBUS_DET                        0x80
  78
  79#define MAIN_CH_STATUS2_MAINCHGDROP             0x80
  80#define MAIN_CH_STATUS2_MAINCHARGERDETDBNC      0x40
  81#define USB_CH_VBUSDROP                         0x40
  82#define USB_CH_VBUSDETDBNC                      0x01
  83
  84/* UsbLineStatus register bit masks */
  85#define AB8500_USB_LINK_STATUS          0x78
  86#define AB8505_USB_LINK_STATUS          0xF8
  87#define AB8500_STD_HOST_SUSP            0x18
  88#define USB_LINK_STATUS_SHIFT           3
  89
  90/* Watchdog timeout constant */
  91#define WD_TIMER                        0x30 /* 4min */
  92#define WD_KICK_INTERVAL                (60 * HZ)
  93
  94/* Lowest charger voltage is 3.39V -> 0x4E */
  95#define LOW_VOLT_REG                    0x4E
  96
  97/* Step up/down delay in us */
  98#define STEP_UDELAY                     1000
  99
 100#define CHARGER_STATUS_POLL 10 /* in ms */
 101
 102#define CHG_WD_INTERVAL                 (60 * HZ)
 103
 104#define AB8500_SW_CONTROL_FALLBACK      0x03
 105/* Wait for enumeration before charing in us */
 106#define WAIT_ACA_RID_ENUMERATION        (5 * 1000)
 107/*External charger control*/
 108#define AB8500_SYS_CHARGER_CONTROL_REG          0x52
 109#define EXTERNAL_CHARGER_DISABLE_REG_VAL        0x03
 110#define EXTERNAL_CHARGER_ENABLE_REG_VAL         0x07
 111
 112/* UsbLineStatus register - usb types */
 113enum ab8500_charger_link_status {
 114        USB_STAT_NOT_CONFIGURED,
 115        USB_STAT_STD_HOST_NC,
 116        USB_STAT_STD_HOST_C_NS,
 117        USB_STAT_STD_HOST_C_S,
 118        USB_STAT_HOST_CHG_NM,
 119        USB_STAT_HOST_CHG_HS,
 120        USB_STAT_HOST_CHG_HS_CHIRP,
 121        USB_STAT_DEDICATED_CHG,
 122        USB_STAT_ACA_RID_A,
 123        USB_STAT_ACA_RID_B,
 124        USB_STAT_ACA_RID_C_NM,
 125        USB_STAT_ACA_RID_C_HS,
 126        USB_STAT_ACA_RID_C_HS_CHIRP,
 127        USB_STAT_HM_IDGND,
 128        USB_STAT_RESERVED,
 129        USB_STAT_NOT_VALID_LINK,
 130        USB_STAT_PHY_EN,
 131        USB_STAT_SUP_NO_IDGND_VBUS,
 132        USB_STAT_SUP_IDGND_VBUS,
 133        USB_STAT_CHARGER_LINE_1,
 134        USB_STAT_CARKIT_1,
 135        USB_STAT_CARKIT_2,
 136        USB_STAT_ACA_DOCK_CHARGER,
 137};
 138
 139enum ab8500_usb_state {
 140        AB8500_BM_USB_STATE_RESET_HS,   /* HighSpeed Reset */
 141        AB8500_BM_USB_STATE_RESET_FS,   /* FullSpeed/LowSpeed Reset */
 142        AB8500_BM_USB_STATE_CONFIGURED,
 143        AB8500_BM_USB_STATE_SUSPEND,
 144        AB8500_BM_USB_STATE_RESUME,
 145        AB8500_BM_USB_STATE_MAX,
 146};
 147
 148/* VBUS input current limits supported in AB8500 in mA */
 149#define USB_CH_IP_CUR_LVL_0P05          50
 150#define USB_CH_IP_CUR_LVL_0P09          98
 151#define USB_CH_IP_CUR_LVL_0P19          193
 152#define USB_CH_IP_CUR_LVL_0P29          290
 153#define USB_CH_IP_CUR_LVL_0P38          380
 154#define USB_CH_IP_CUR_LVL_0P45          450
 155#define USB_CH_IP_CUR_LVL_0P5           500
 156#define USB_CH_IP_CUR_LVL_0P6           600
 157#define USB_CH_IP_CUR_LVL_0P7           700
 158#define USB_CH_IP_CUR_LVL_0P8           800
 159#define USB_CH_IP_CUR_LVL_0P9           900
 160#define USB_CH_IP_CUR_LVL_1P0           1000
 161#define USB_CH_IP_CUR_LVL_1P1           1100
 162#define USB_CH_IP_CUR_LVL_1P3           1300
 163#define USB_CH_IP_CUR_LVL_1P4           1400
 164#define USB_CH_IP_CUR_LVL_1P5           1500
 165
 166#define VBAT_TRESH_IP_CUR_RED           3800
 167
 168#define to_ab8500_charger_usb_device_info(x) container_of((x), \
 169        struct ab8500_charger, usb_chg)
 170#define to_ab8500_charger_ac_device_info(x) container_of((x), \
 171        struct ab8500_charger, ac_chg)
 172
 173/**
 174 * struct ab8500_charger_interrupts - ab8500 interupts
 175 * @name:       name of the interrupt
 176 * @isr         function pointer to the isr
 177 */
 178struct ab8500_charger_interrupts {
 179        char *name;
 180        irqreturn_t (*isr)(int irq, void *data);
 181};
 182
 183struct ab8500_charger_info {
 184        int charger_connected;
 185        int charger_online;
 186        int charger_voltage;
 187        int cv_active;
 188        bool wd_expired;
 189        int charger_current;
 190};
 191
 192struct ab8500_charger_event_flags {
 193        bool mainextchnotok;
 194        bool main_thermal_prot;
 195        bool usb_thermal_prot;
 196        bool vbus_ovv;
 197        bool usbchargernotok;
 198        bool chgwdexp;
 199        bool vbus_collapse;
 200        bool vbus_drop_end;
 201};
 202
 203struct ab8500_charger_usb_state {
 204        int usb_current;
 205        int usb_current_tmp;
 206        enum ab8500_usb_state state;
 207        enum ab8500_usb_state state_tmp;
 208        spinlock_t usb_lock;
 209};
 210
 211struct ab8500_charger_max_usb_in_curr {
 212        int usb_type_max;
 213        int set_max;
 214        int calculated_max;
 215};
 216
 217/**
 218 * struct ab8500_charger - ab8500 Charger device information
 219 * @dev:                Pointer to the structure device
 220 * @vbus_detected:      VBUS detected
 221 * @vbus_detected_start:
 222 *                      VBUS detected during startup
 223 * @ac_conn:            This will be true when the AC charger has been plugged
 224 * @vddadc_en_ac:       Indicate if VDD ADC supply is enabled because AC
 225 *                      charger is enabled
 226 * @vddadc_en_usb:      Indicate if VDD ADC supply is enabled because USB
 227 *                      charger is enabled
 228 * @vbat                Battery voltage
 229 * @old_vbat            Previously measured battery voltage
 230 * @usb_device_is_unrecognised  USB device is unrecognised by the hardware
 231 * @autopower           Indicate if we should have automatic pwron after pwrloss
 232 * @autopower_cfg       platform specific power config support for "pwron after pwrloss"
 233 * @invalid_charger_detect_state State when forcing AB to use invalid charger
 234 * @is_aca_rid:         Incicate if accessory is ACA type
 235 * @current_stepping_sessions:
 236 *                      Counter for current stepping sessions
 237 * @parent:             Pointer to the struct ab8500
 238 * @gpadc:              Pointer to the struct gpadc
 239 * @bm:                 Platform specific battery management information
 240 * @flags:              Structure for information about events triggered
 241 * @usb_state:          Structure for usb stack information
 242 * @max_usb_in_curr:    Max USB charger input current
 243 * @ac_chg:             AC charger power supply
 244 * @usb_chg:            USB charger power supply
 245 * @ac:                 Structure that holds the AC charger properties
 246 * @usb:                Structure that holds the USB charger properties
 247 * @regu:               Pointer to the struct regulator
 248 * @charger_wq:         Work queue for the IRQs and checking HW state
 249 * @usb_ipt_crnt_lock:  Lock to protect VBUS input current setting from mutuals
 250 * @pm_lock:            Lock to prevent system to suspend
 251 * @check_vbat_work     Work for checking vbat threshold to adjust vbus current
 252 * @check_hw_failure_work:      Work for checking HW state
 253 * @check_usbchgnotok_work:     Work for checking USB charger not ok status
 254 * @kick_wd_work:               Work for kicking the charger watchdog in case
 255 *                              of ABB rev 1.* due to the watchog logic bug
 256 * @ac_charger_attached_work:   Work for checking if AC charger is still
 257 *                              connected
 258 * @usb_charger_attached_work:  Work for checking if USB charger is still
 259 *                              connected
 260 * @ac_work:                    Work for checking AC charger connection
 261 * @detect_usb_type_work:       Work for detecting the USB type connected
 262 * @usb_link_status_work:       Work for checking the new USB link status
 263 * @usb_state_changed_work:     Work for checking USB state
 264 * @attach_work:                Work for detecting USB type
 265 * @vbus_drop_end_work:         Work for detecting VBUS drop end
 266 * @check_main_thermal_prot_work:
 267 *                              Work for checking Main thermal status
 268 * @check_usb_thermal_prot_work:
 269 *                              Work for checking USB thermal status
 270 * @charger_attached_mutex:     For controlling the wakelock
 271 */
 272struct ab8500_charger {
 273        struct device *dev;
 274        bool vbus_detected;
 275        bool vbus_detected_start;
 276        bool ac_conn;
 277        bool vddadc_en_ac;
 278        bool vddadc_en_usb;
 279        int vbat;
 280        int old_vbat;
 281        bool usb_device_is_unrecognised;
 282        bool autopower;
 283        bool autopower_cfg;
 284        int invalid_charger_detect_state;
 285        int is_aca_rid;
 286        atomic_t current_stepping_sessions;
 287        struct ab8500 *parent;
 288        struct ab8500_gpadc *gpadc;
 289        struct abx500_bm_data *bm;
 290        struct ab8500_charger_event_flags flags;
 291        struct ab8500_charger_usb_state usb_state;
 292        struct ab8500_charger_max_usb_in_curr max_usb_in_curr;
 293        struct ux500_charger ac_chg;
 294        struct ux500_charger usb_chg;
 295        struct ab8500_charger_info ac;
 296        struct ab8500_charger_info usb;
 297        struct regulator *regu;
 298        struct workqueue_struct *charger_wq;
 299        struct mutex usb_ipt_crnt_lock;
 300        struct delayed_work check_vbat_work;
 301        struct delayed_work check_hw_failure_work;
 302        struct delayed_work check_usbchgnotok_work;
 303        struct delayed_work kick_wd_work;
 304        struct delayed_work usb_state_changed_work;
 305        struct delayed_work attach_work;
 306        struct delayed_work ac_charger_attached_work;
 307        struct delayed_work usb_charger_attached_work;
 308        struct delayed_work vbus_drop_end_work;
 309        struct work_struct ac_work;
 310        struct work_struct detect_usb_type_work;
 311        struct work_struct usb_link_status_work;
 312        struct work_struct check_main_thermal_prot_work;
 313        struct work_struct check_usb_thermal_prot_work;
 314        struct usb_phy *usb_phy;
 315        struct notifier_block nb;
 316        struct mutex charger_attached_mutex;
 317};
 318
 319/* AC properties */
 320static enum power_supply_property ab8500_charger_ac_props[] = {
 321        POWER_SUPPLY_PROP_HEALTH,
 322        POWER_SUPPLY_PROP_PRESENT,
 323        POWER_SUPPLY_PROP_ONLINE,
 324        POWER_SUPPLY_PROP_VOLTAGE_NOW,
 325        POWER_SUPPLY_PROP_VOLTAGE_AVG,
 326        POWER_SUPPLY_PROP_CURRENT_NOW,
 327};
 328
 329/* USB properties */
 330static enum power_supply_property ab8500_charger_usb_props[] = {
 331        POWER_SUPPLY_PROP_HEALTH,
 332        POWER_SUPPLY_PROP_CURRENT_AVG,
 333        POWER_SUPPLY_PROP_PRESENT,
 334        POWER_SUPPLY_PROP_ONLINE,
 335        POWER_SUPPLY_PROP_VOLTAGE_NOW,
 336        POWER_SUPPLY_PROP_VOLTAGE_AVG,
 337        POWER_SUPPLY_PROP_CURRENT_NOW,
 338};
 339
 340/*
 341 * Function for enabling and disabling sw fallback mode
 342 * should always be disabled when no charger is connected.
 343 */
 344static void ab8500_enable_disable_sw_fallback(struct ab8500_charger *di,
 345                bool fallback)
 346{
 347        u8 val;
 348        u8 reg;
 349        u8 bank;
 350        u8 bit;
 351        int ret;
 352
 353        dev_dbg(di->dev, "SW Fallback: %d\n", fallback);
 354
 355        if (is_ab8500(di->parent)) {
 356                bank = 0x15;
 357                reg = 0x0;
 358                bit = 3;
 359        } else {
 360                bank = AB8500_SYS_CTRL1_BLOCK;
 361                reg = AB8500_SW_CONTROL_FALLBACK;
 362                bit = 0;
 363        }
 364
 365        /* read the register containing fallback bit */
 366        ret = abx500_get_register_interruptible(di->dev, bank, reg, &val);
 367        if (ret < 0) {
 368                dev_err(di->dev, "%d read failed\n", __LINE__);
 369                return;
 370        }
 371
 372        if (is_ab8500(di->parent)) {
 373                /* enable the OPT emulation registers */
 374                ret = abx500_set_register_interruptible(di->dev, 0x11, 0x00, 0x2);
 375                if (ret) {
 376                        dev_err(di->dev, "%d write failed\n", __LINE__);
 377                        goto disable_otp;
 378                }
 379        }
 380
 381        if (fallback)
 382                val |= (1 << bit);
 383        else
 384                val &= ~(1 << bit);
 385
 386        /* write back the changed fallback bit value to register */
 387        ret = abx500_set_register_interruptible(di->dev, bank, reg, val);
 388        if (ret) {
 389                dev_err(di->dev, "%d write failed\n", __LINE__);
 390        }
 391
 392disable_otp:
 393        if (is_ab8500(di->parent)) {
 394                /* disable the set OTP registers again */
 395                ret = abx500_set_register_interruptible(di->dev, 0x11, 0x00, 0x0);
 396                if (ret) {
 397                        dev_err(di->dev, "%d write failed\n", __LINE__);
 398                }
 399        }
 400}
 401
 402/**
 403 * ab8500_power_supply_changed - a wrapper with local extentions for
 404 * power_supply_changed
 405 * @di:   pointer to the ab8500_charger structure
 406 * @psy:  pointer to power_supply_that have changed.
 407 *
 408 */
 409static void ab8500_power_supply_changed(struct ab8500_charger *di,
 410                                        struct power_supply *psy)
 411{
 412        if (di->autopower_cfg) {
 413                if (!di->usb.charger_connected &&
 414                    !di->ac.charger_connected &&
 415                    di->autopower) {
 416                        di->autopower = false;
 417                        ab8500_enable_disable_sw_fallback(di, false);
 418                } else if (!di->autopower &&
 419                           (di->ac.charger_connected ||
 420                            di->usb.charger_connected)) {
 421                        di->autopower = true;
 422                        ab8500_enable_disable_sw_fallback(di, true);
 423                }
 424        }
 425        power_supply_changed(psy);
 426}
 427
 428static void ab8500_charger_set_usb_connected(struct ab8500_charger *di,
 429        bool connected)
 430{
 431        if (connected != di->usb.charger_connected) {
 432                dev_dbg(di->dev, "USB connected:%i\n", connected);
 433                di->usb.charger_connected = connected;
 434
 435                if (!connected)
 436                        di->flags.vbus_drop_end = false;
 437
 438                sysfs_notify(&di->usb_chg.psy.dev->kobj, NULL, "present");
 439
 440                if (connected) {
 441                        mutex_lock(&di->charger_attached_mutex);
 442                        mutex_unlock(&di->charger_attached_mutex);
 443
 444                        if (is_ab8500(di->parent))
 445                                queue_delayed_work(di->charger_wq,
 446                                           &di->usb_charger_attached_work,
 447                                           HZ);
 448                } else {
 449                        cancel_delayed_work_sync(&di->usb_charger_attached_work);
 450                        mutex_lock(&di->charger_attached_mutex);
 451                        mutex_unlock(&di->charger_attached_mutex);
 452                }
 453        }
 454}
 455
 456/**
 457 * ab8500_charger_get_ac_voltage() - get ac charger voltage
 458 * @di:         pointer to the ab8500_charger structure
 459 *
 460 * Returns ac charger voltage (on success)
 461 */
 462static int ab8500_charger_get_ac_voltage(struct ab8500_charger *di)
 463{
 464        int vch;
 465
 466        /* Only measure voltage if the charger is connected */
 467        if (di->ac.charger_connected) {
 468                vch = ab8500_gpadc_convert(di->gpadc, MAIN_CHARGER_V);
 469                if (vch < 0)
 470                        dev_err(di->dev, "%s gpadc conv failed,\n", __func__);
 471        } else {
 472                vch = 0;
 473        }
 474        return vch;
 475}
 476
 477/**
 478 * ab8500_charger_ac_cv() - check if the main charger is in CV mode
 479 * @di:         pointer to the ab8500_charger structure
 480 *
 481 * Returns ac charger CV mode (on success) else error code
 482 */
 483static int ab8500_charger_ac_cv(struct ab8500_charger *di)
 484{
 485        u8 val;
 486        int ret = 0;
 487
 488        /* Only check CV mode if the charger is online */
 489        if (di->ac.charger_online) {
 490                ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
 491                        AB8500_CH_STATUS1_REG, &val);
 492                if (ret < 0) {
 493                        dev_err(di->dev, "%s ab8500 read failed\n", __func__);
 494                        return 0;
 495                }
 496
 497                if (val & MAIN_CH_CV_ON)
 498                        ret = 1;
 499                else
 500                        ret = 0;
 501        }
 502
 503        return ret;
 504}
 505
 506/**
 507 * ab8500_charger_get_vbus_voltage() - get vbus voltage
 508 * @di:         pointer to the ab8500_charger structure
 509 *
 510 * This function returns the vbus voltage.
 511 * Returns vbus voltage (on success)
 512 */
 513static int ab8500_charger_get_vbus_voltage(struct ab8500_charger *di)
 514{
 515        int vch;
 516
 517        /* Only measure voltage if the charger is connected */
 518        if (di->usb.charger_connected) {
 519                vch = ab8500_gpadc_convert(di->gpadc, VBUS_V);
 520                if (vch < 0)
 521                        dev_err(di->dev, "%s gpadc conv failed\n", __func__);
 522        } else {
 523                vch = 0;
 524        }
 525        return vch;
 526}
 527
 528/**
 529 * ab8500_charger_get_usb_current() - get usb charger current
 530 * @di:         pointer to the ab8500_charger structure
 531 *
 532 * This function returns the usb charger current.
 533 * Returns usb current (on success) and error code on failure
 534 */
 535static int ab8500_charger_get_usb_current(struct ab8500_charger *di)
 536{
 537        int ich;
 538
 539        /* Only measure current if the charger is online */
 540        if (di->usb.charger_online) {
 541                ich = ab8500_gpadc_convert(di->gpadc, USB_CHARGER_C);
 542                if (ich < 0)
 543                        dev_err(di->dev, "%s gpadc conv failed\n", __func__);
 544        } else {
 545                ich = 0;
 546        }
 547        return ich;
 548}
 549
 550/**
 551 * ab8500_charger_get_ac_current() - get ac charger current
 552 * @di:         pointer to the ab8500_charger structure
 553 *
 554 * This function returns the ac charger current.
 555 * Returns ac current (on success) and error code on failure.
 556 */
 557static int ab8500_charger_get_ac_current(struct ab8500_charger *di)
 558{
 559        int ich;
 560
 561        /* Only measure current if the charger is online */
 562        if (di->ac.charger_online) {
 563                ich = ab8500_gpadc_convert(di->gpadc, MAIN_CHARGER_C);
 564                if (ich < 0)
 565                        dev_err(di->dev, "%s gpadc conv failed\n", __func__);
 566        } else {
 567                ich = 0;
 568        }
 569        return ich;
 570}
 571
 572/**
 573 * ab8500_charger_usb_cv() - check if the usb charger is in CV mode
 574 * @di:         pointer to the ab8500_charger structure
 575 *
 576 * Returns ac charger CV mode (on success) else error code
 577 */
 578static int ab8500_charger_usb_cv(struct ab8500_charger *di)
 579{
 580        int ret;
 581        u8 val;
 582
 583        /* Only check CV mode if the charger is online */
 584        if (di->usb.charger_online) {
 585                ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
 586                        AB8500_CH_USBCH_STAT1_REG, &val);
 587                if (ret < 0) {
 588                        dev_err(di->dev, "%s ab8500 read failed\n", __func__);
 589                        return 0;
 590                }
 591
 592                if (val & USB_CH_CV_ON)
 593                        ret = 1;
 594                else
 595                        ret = 0;
 596        } else {
 597                ret = 0;
 598        }
 599
 600        return ret;
 601}
 602
 603/**
 604 * ab8500_charger_detect_chargers() - Detect the connected chargers
 605 * @di:         pointer to the ab8500_charger structure
 606 * @probe:      if probe, don't delay and wait for HW
 607 *
 608 * Returns the type of charger connected.
 609 * For USB it will not mean we can actually charge from it
 610 * but that there is a USB cable connected that we have to
 611 * identify. This is used during startup when we don't get
 612 * interrupts of the charger detection
 613 *
 614 * Returns an integer value, that means,
 615 * NO_PW_CONN  no power supply is connected
 616 * AC_PW_CONN  if the AC power supply is connected
 617 * USB_PW_CONN  if the USB power supply is connected
 618 * AC_PW_CONN + USB_PW_CONN if USB and AC power supplies are both connected
 619 */
 620static int ab8500_charger_detect_chargers(struct ab8500_charger *di, bool probe)
 621{
 622        int result = NO_PW_CONN;
 623        int ret;
 624        u8 val;
 625
 626        /* Check for AC charger */
 627        ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
 628                AB8500_CH_STATUS1_REG, &val);
 629        if (ret < 0) {
 630                dev_err(di->dev, "%s ab8500 read failed\n", __func__);
 631                return ret;
 632        }
 633
 634        if (val & MAIN_CH_DET)
 635                result = AC_PW_CONN;
 636
 637        /* Check for USB charger */
 638
 639        if (!probe) {
 640                /*
 641                 * AB8500 says VBUS_DET_DBNC1 & VBUS_DET_DBNC100
 642                 * when disconnecting ACA even though no
 643                 * charger was connected. Try waiting a little
 644                 * longer than the 100 ms of VBUS_DET_DBNC100...
 645                 */
 646                msleep(110);
 647        }
 648        ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
 649                AB8500_CH_USBCH_STAT1_REG, &val);
 650        if (ret < 0) {
 651                dev_err(di->dev, "%s ab8500 read failed\n", __func__);
 652                return ret;
 653        }
 654        dev_dbg(di->dev,
 655                "%s AB8500_CH_USBCH_STAT1_REG %x\n", __func__,
 656                val);
 657        if ((val & VBUS_DET_DBNC1) && (val & VBUS_DET_DBNC100))
 658                result |= USB_PW_CONN;
 659
 660        return result;
 661}
 662
 663/**
 664 * ab8500_charger_max_usb_curr() - get the max curr for the USB type
 665 * @di:                 pointer to the ab8500_charger structure
 666 * @link_status:        the identified USB type
 667 *
 668 * Get the maximum current that is allowed to be drawn from the host
 669 * based on the USB type.
 670 * Returns error code in case of failure else 0 on success
 671 */
 672static int ab8500_charger_max_usb_curr(struct ab8500_charger *di,
 673                enum ab8500_charger_link_status link_status)
 674{
 675        int ret = 0;
 676
 677        di->usb_device_is_unrecognised = false;
 678
 679        /*
 680         * Platform only supports USB 2.0.
 681         * This means that charging current from USB source
 682         * is maximum 500 mA. Every occurence of USB_STAT_*_HOST_*
 683         * should set USB_CH_IP_CUR_LVL_0P5.
 684         */
 685
 686        switch (link_status) {
 687        case USB_STAT_STD_HOST_NC:
 688        case USB_STAT_STD_HOST_C_NS:
 689        case USB_STAT_STD_HOST_C_S:
 690                dev_dbg(di->dev, "USB Type - Standard host is "
 691                        "detected through USB driver\n");
 692                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
 693                di->is_aca_rid = 0;
 694                break;
 695        case USB_STAT_HOST_CHG_HS_CHIRP:
 696                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
 697                di->is_aca_rid = 0;
 698                break;
 699        case USB_STAT_HOST_CHG_HS:
 700                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
 701                di->is_aca_rid = 0;
 702                break;
 703        case USB_STAT_ACA_RID_C_HS:
 704                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P9;
 705                di->is_aca_rid = 0;
 706                break;
 707        case USB_STAT_ACA_RID_A:
 708                /*
 709                 * Dedicated charger level minus maximum current accessory
 710                 * can consume (900mA). Closest level is 500mA
 711                 */
 712                dev_dbg(di->dev, "USB_STAT_ACA_RID_A detected\n");
 713                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
 714                di->is_aca_rid = 1;
 715                break;
 716        case USB_STAT_ACA_RID_B:
 717                /*
 718                 * Dedicated charger level minus 120mA (20mA for ACA and
 719                 * 100mA for potential accessory). Closest level is 1300mA
 720                 */
 721                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_1P3;
 722                dev_dbg(di->dev, "USB Type - 0x%02x MaxCurr: %d", link_status,
 723                                di->max_usb_in_curr.usb_type_max);
 724                di->is_aca_rid = 1;
 725                break;
 726        case USB_STAT_HOST_CHG_NM:
 727                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
 728                di->is_aca_rid = 0;
 729                break;
 730        case USB_STAT_DEDICATED_CHG:
 731                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_1P5;
 732                di->is_aca_rid = 0;
 733                break;
 734        case USB_STAT_ACA_RID_C_HS_CHIRP:
 735        case USB_STAT_ACA_RID_C_NM:
 736                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_1P5;
 737                di->is_aca_rid = 1;
 738                break;
 739        case USB_STAT_NOT_CONFIGURED:
 740                if (di->vbus_detected) {
 741                        di->usb_device_is_unrecognised = true;
 742                        dev_dbg(di->dev, "USB Type - Legacy charger.\n");
 743                        di->max_usb_in_curr.usb_type_max =
 744                                                USB_CH_IP_CUR_LVL_1P5;
 745                        break;
 746                }
 747        case USB_STAT_HM_IDGND:
 748                dev_err(di->dev, "USB Type - Charging not allowed\n");
 749                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P05;
 750                ret = -ENXIO;
 751                break;
 752        case USB_STAT_RESERVED:
 753                if (is_ab8500(di->parent)) {
 754                        di->flags.vbus_collapse = true;
 755                        dev_err(di->dev, "USB Type - USB_STAT_RESERVED "
 756                                                "VBUS has collapsed\n");
 757                        ret = -ENXIO;
 758                        break;
 759                } else {
 760                        dev_dbg(di->dev, "USB Type - Charging not allowed\n");
 761                        di->max_usb_in_curr.usb_type_max =
 762                                                USB_CH_IP_CUR_LVL_0P05;
 763                        dev_dbg(di->dev, "USB Type - 0x%02x MaxCurr: %d",
 764                                link_status,
 765                                di->max_usb_in_curr.usb_type_max);
 766                        ret = -ENXIO;
 767                        break;
 768                }
 769                break;
 770        case USB_STAT_CARKIT_1:
 771        case USB_STAT_CARKIT_2:
 772        case USB_STAT_ACA_DOCK_CHARGER:
 773        case USB_STAT_CHARGER_LINE_1:
 774                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
 775                dev_dbg(di->dev, "USB Type - 0x%02x MaxCurr: %d", link_status,
 776                                di->max_usb_in_curr.usb_type_max);
 777                break;
 778        case USB_STAT_NOT_VALID_LINK:
 779                dev_err(di->dev, "USB Type invalid - try charging anyway\n");
 780                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
 781                break;
 782
 783        default:
 784                dev_err(di->dev, "USB Type - Unknown\n");
 785                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P05;
 786                ret = -ENXIO;
 787                break;
 788        };
 789
 790        di->max_usb_in_curr.set_max = di->max_usb_in_curr.usb_type_max;
 791        dev_dbg(di->dev, "USB Type - 0x%02x MaxCurr: %d",
 792                link_status, di->max_usb_in_curr.set_max);
 793
 794        return ret;
 795}
 796
 797/**
 798 * ab8500_charger_read_usb_type() - read the type of usb connected
 799 * @di:         pointer to the ab8500_charger structure
 800 *
 801 * Detect the type of the plugged USB
 802 * Returns error code in case of failure else 0 on success
 803 */
 804static int ab8500_charger_read_usb_type(struct ab8500_charger *di)
 805{
 806        int ret;
 807        u8 val;
 808
 809        ret = abx500_get_register_interruptible(di->dev,
 810                AB8500_INTERRUPT, AB8500_IT_SOURCE21_REG, &val);
 811        if (ret < 0) {
 812                dev_err(di->dev, "%s ab8500 read failed\n", __func__);
 813                return ret;
 814        }
 815        if (is_ab8500(di->parent))
 816                ret = abx500_get_register_interruptible(di->dev, AB8500_USB,
 817                        AB8500_USB_LINE_STAT_REG, &val);
 818        else
 819                ret = abx500_get_register_interruptible(di->dev,
 820                        AB8500_USB, AB8500_USB_LINK1_STAT_REG, &val);
 821        if (ret < 0) {
 822                dev_err(di->dev, "%s ab8500 read failed\n", __func__);
 823                return ret;
 824        }
 825
 826        /* get the USB type */
 827        if (is_ab8500(di->parent))
 828                val = (val & AB8500_USB_LINK_STATUS) >> USB_LINK_STATUS_SHIFT;
 829        else
 830                val = (val & AB8505_USB_LINK_STATUS) >> USB_LINK_STATUS_SHIFT;
 831        ret = ab8500_charger_max_usb_curr(di,
 832                (enum ab8500_charger_link_status) val);
 833
 834        return ret;
 835}
 836
 837/**
 838 * ab8500_charger_detect_usb_type() - get the type of usb connected
 839 * @di:         pointer to the ab8500_charger structure
 840 *
 841 * Detect the type of the plugged USB
 842 * Returns error code in case of failure else 0 on success
 843 */
 844static int ab8500_charger_detect_usb_type(struct ab8500_charger *di)
 845{
 846        int i, ret;
 847        u8 val;
 848
 849        /*
 850         * On getting the VBUS rising edge detect interrupt there
 851         * is a 250ms delay after which the register UsbLineStatus
 852         * is filled with valid data.
 853         */
 854        for (i = 0; i < 10; i++) {
 855                msleep(250);
 856                ret = abx500_get_register_interruptible(di->dev,
 857                        AB8500_INTERRUPT, AB8500_IT_SOURCE21_REG,
 858                        &val);
 859                dev_dbg(di->dev, "%s AB8500_IT_SOURCE21_REG %x\n",
 860                        __func__, val);
 861                if (ret < 0) {
 862                        dev_err(di->dev, "%s ab8500 read failed\n", __func__);
 863                        return ret;
 864                }
 865
 866                if (is_ab8500(di->parent))
 867                        ret = abx500_get_register_interruptible(di->dev,
 868                                AB8500_USB, AB8500_USB_LINE_STAT_REG, &val);
 869                else
 870                        ret = abx500_get_register_interruptible(di->dev,
 871                                AB8500_USB, AB8500_USB_LINK1_STAT_REG, &val);
 872                if (ret < 0) {
 873                        dev_err(di->dev, "%s ab8500 read failed\n", __func__);
 874                        return ret;
 875                }
 876                dev_dbg(di->dev, "%s AB8500_USB_LINE_STAT_REG %x\n", __func__,
 877                        val);
 878                /*
 879                 * Until the IT source register is read the UsbLineStatus
 880                 * register is not updated, hence doing the same
 881                 * Revisit this:
 882                 */
 883
 884                /* get the USB type */
 885                if (is_ab8500(di->parent))
 886                        val = (val & AB8500_USB_LINK_STATUS) >>
 887                                                        USB_LINK_STATUS_SHIFT;
 888                else
 889                        val = (val & AB8505_USB_LINK_STATUS) >>
 890                                                        USB_LINK_STATUS_SHIFT;
 891                if (val)
 892                        break;
 893        }
 894        ret = ab8500_charger_max_usb_curr(di,
 895                (enum ab8500_charger_link_status) val);
 896
 897        return ret;
 898}
 899
 900/*
 901 * This array maps the raw hex value to charger voltage used by the AB8500
 902 * Values taken from the UM0836
 903 */
 904static int ab8500_charger_voltage_map[] = {
 905        3500 ,
 906        3525 ,
 907        3550 ,
 908        3575 ,
 909        3600 ,
 910        3625 ,
 911        3650 ,
 912        3675 ,
 913        3700 ,
 914        3725 ,
 915        3750 ,
 916        3775 ,
 917        3800 ,
 918        3825 ,
 919        3850 ,
 920        3875 ,
 921        3900 ,
 922        3925 ,
 923        3950 ,
 924        3975 ,
 925        4000 ,
 926        4025 ,
 927        4050 ,
 928        4060 ,
 929        4070 ,
 930        4080 ,
 931        4090 ,
 932        4100 ,
 933        4110 ,
 934        4120 ,
 935        4130 ,
 936        4140 ,
 937        4150 ,
 938        4160 ,
 939        4170 ,
 940        4180 ,
 941        4190 ,
 942        4200 ,
 943        4210 ,
 944        4220 ,
 945        4230 ,
 946        4240 ,
 947        4250 ,
 948        4260 ,
 949        4270 ,
 950        4280 ,
 951        4290 ,
 952        4300 ,
 953        4310 ,
 954        4320 ,
 955        4330 ,
 956        4340 ,
 957        4350 ,
 958        4360 ,
 959        4370 ,
 960        4380 ,
 961        4390 ,
 962        4400 ,
 963        4410 ,
 964        4420 ,
 965        4430 ,
 966        4440 ,
 967        4450 ,
 968        4460 ,
 969        4470 ,
 970        4480 ,
 971        4490 ,
 972        4500 ,
 973        4510 ,
 974        4520 ,
 975        4530 ,
 976        4540 ,
 977        4550 ,
 978        4560 ,
 979        4570 ,
 980        4580 ,
 981        4590 ,
 982        4600 ,
 983};
 984
 985static int ab8500_voltage_to_regval(int voltage)
 986{
 987        int i;
 988
 989        /* Special case for voltage below 3.5V */
 990        if (voltage < ab8500_charger_voltage_map[0])
 991                return LOW_VOLT_REG;
 992
 993        for (i = 1; i < ARRAY_SIZE(ab8500_charger_voltage_map); i++) {
 994                if (voltage < ab8500_charger_voltage_map[i])
 995                        return i - 1;
 996        }
 997
 998        /* If not last element, return error */
 999        i = ARRAY_SIZE(ab8500_charger_voltage_map) - 1;
1000        if (voltage == ab8500_charger_voltage_map[i])
1001                return i;
1002        else
1003                return -1;
1004}
1005
1006static int ab8500_current_to_regval(struct ab8500_charger *di, int curr)
1007{
1008        int i;
1009
1010        if (curr < di->bm->chg_output_curr[0])
1011                return 0;
1012
1013        for (i = 0; i < di->bm->n_chg_out_curr; i++) {
1014                if (curr < di->bm->chg_output_curr[i])
1015                        return i - 1;
1016        }
1017
1018        /* If not last element, return error */
1019        i = di->bm->n_chg_out_curr - 1;
1020        if (curr == di->bm->chg_output_curr[i])
1021                return i;
1022        else
1023                return -1;
1024}
1025
1026static int ab8500_vbus_in_curr_to_regval(struct ab8500_charger *di, int curr)
1027{
1028        int i;
1029
1030        if (curr < di->bm->chg_input_curr[0])
1031                return 0;
1032
1033        for (i = 0; i < di->bm->n_chg_in_curr; i++) {
1034                if (curr < di->bm->chg_input_curr[i])
1035                        return i - 1;
1036        }
1037
1038        /* If not last element, return error */
1039        i = di->bm->n_chg_in_curr - 1;
1040        if (curr == di->bm->chg_input_curr[i])
1041                return i;
1042        else
1043                return -1;
1044}
1045
1046/**
1047 * ab8500_charger_get_usb_cur() - get usb current
1048 * @di:         pointer to the ab8500_charger structre
1049 *
1050 * The usb stack provides the maximum current that can be drawn from
1051 * the standard usb host. This will be in mA.
1052 * This function converts current in mA to a value that can be written
1053 * to the register. Returns -1 if charging is not allowed
1054 */
1055static int ab8500_charger_get_usb_cur(struct ab8500_charger *di)
1056{
1057        int ret = 0;
1058        switch (di->usb_state.usb_current) {
1059        case 100:
1060                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P09;
1061                break;
1062        case 200:
1063                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P19;
1064                break;
1065        case 300:
1066                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P29;
1067                break;
1068        case 400:
1069                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P38;
1070                break;
1071        case 500:
1072                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P5;
1073                break;
1074        default:
1075                di->max_usb_in_curr.usb_type_max = USB_CH_IP_CUR_LVL_0P05;
1076                ret = -EPERM;
1077                break;
1078        };
1079        di->max_usb_in_curr.set_max = di->max_usb_in_curr.usb_type_max;
1080        return ret;
1081}
1082
1083/**
1084 * ab8500_charger_check_continue_stepping() - Check to allow stepping
1085 * @di:         pointer to the ab8500_charger structure
1086 * @reg:        select what charger register to check
1087 *
1088 * Check if current stepping should be allowed to continue.
1089 * Checks if charger source has not collapsed. If it has, further stepping
1090 * is not allowed.
1091 */
1092static bool ab8500_charger_check_continue_stepping(struct ab8500_charger *di,
1093                                                   int reg)
1094{
1095        if (reg == AB8500_USBCH_IPT_CRNTLVL_REG)
1096                return !di->flags.vbus_drop_end;
1097        else
1098                return true;
1099}
1100
1101/**
1102 * ab8500_charger_set_current() - set charger current
1103 * @di:         pointer to the ab8500_charger structure
1104 * @ich:        charger current, in mA
1105 * @reg:        select what charger register to set
1106 *
1107 * Set charger current.
1108 * There is no state machine in the AB to step up/down the charger
1109 * current to avoid dips and spikes on MAIN, VBUS and VBAT when
1110 * charging is started. Instead we need to implement
1111 * this charger current step-up/down here.
1112 * Returns error code in case of failure else 0(on success)
1113 */
1114static int ab8500_charger_set_current(struct ab8500_charger *di,
1115        int ich, int reg)
1116{
1117        int ret = 0;
1118        int curr_index, prev_curr_index, shift_value, i;
1119        u8 reg_value;
1120        u32 step_udelay;
1121        bool no_stepping = false;
1122
1123        atomic_inc(&di->current_stepping_sessions);
1124
1125        ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
1126                reg, &reg_value);
1127        if (ret < 0) {
1128                dev_err(di->dev, "%s read failed\n", __func__);
1129                goto exit_set_current;
1130        }
1131
1132        switch (reg) {
1133        case AB8500_MCH_IPT_CURLVL_REG:
1134                shift_value = MAIN_CH_INPUT_CURR_SHIFT;
1135                prev_curr_index = (reg_value >> shift_value);
1136                curr_index = ab8500_current_to_regval(di, ich);
1137                step_udelay = STEP_UDELAY;
1138                if (!di->ac.charger_connected)
1139                        no_stepping = true;
1140                break;
1141        case AB8500_USBCH_IPT_CRNTLVL_REG:
1142                if (is_ab8540(di->parent))
1143                        shift_value = AB8540_VBUS_IN_CURR_LIM_SHIFT;
1144                else
1145                        shift_value = VBUS_IN_CURR_LIM_SHIFT;
1146                prev_curr_index = (reg_value >> shift_value);
1147                curr_index = ab8500_vbus_in_curr_to_regval(di, ich);
1148                step_udelay = STEP_UDELAY * 100;
1149
1150                if (!di->usb.charger_connected)
1151                        no_stepping = true;
1152                break;
1153        case AB8500_CH_OPT_CRNTLVL_REG:
1154                shift_value = 0;
1155                prev_curr_index = (reg_value >> shift_value);
1156                curr_index = ab8500_current_to_regval(di, ich);
1157                step_udelay = STEP_UDELAY;
1158                if (curr_index && (curr_index - prev_curr_index) > 1)
1159                        step_udelay *= 100;
1160
1161                if (!di->usb.charger_connected && !di->ac.charger_connected)
1162                        no_stepping = true;
1163
1164                break;
1165        default:
1166                dev_err(di->dev, "%s current register not valid\n", __func__);
1167                ret = -ENXIO;
1168                goto exit_set_current;
1169        }
1170
1171        if (curr_index < 0) {
1172                dev_err(di->dev, "requested current limit out-of-range\n");
1173                ret = -ENXIO;
1174                goto exit_set_current;
1175        }
1176
1177        /* only update current if it's been changed */
1178        if (prev_curr_index == curr_index) {
1179                dev_dbg(di->dev, "%s current not changed for reg: 0x%02x\n",
1180                        __func__, reg);
1181                ret = 0;
1182                goto exit_set_current;
1183        }
1184
1185        dev_dbg(di->dev, "%s set charger current: %d mA for reg: 0x%02x\n",
1186                __func__, ich, reg);
1187
1188        if (no_stepping) {
1189                ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1190                                        reg, (u8)curr_index << shift_value);
1191                if (ret)
1192                        dev_err(di->dev, "%s write failed\n", __func__);
1193        } else if (prev_curr_index > curr_index) {
1194                for (i = prev_curr_index - 1; i >= curr_index; i--) {
1195                        dev_dbg(di->dev, "curr change_1 to: %x for 0x%02x\n",
1196                                (u8) i << shift_value, reg);
1197                        ret = abx500_set_register_interruptible(di->dev,
1198                                AB8500_CHARGER, reg, (u8)i << shift_value);
1199                        if (ret) {
1200                                dev_err(di->dev, "%s write failed\n", __func__);
1201                                goto exit_set_current;
1202                        }
1203                        if (i != curr_index)
1204                                usleep_range(step_udelay, step_udelay * 2);
1205                }
1206        } else {
1207                bool allow = true;
1208                for (i = prev_curr_index + 1; i <= curr_index && allow; i++) {
1209                        dev_dbg(di->dev, "curr change_2 to: %x for 0x%02x\n",
1210                                (u8)i << shift_value, reg);
1211                        ret = abx500_set_register_interruptible(di->dev,
1212                                AB8500_CHARGER, reg, (u8)i << shift_value);
1213                        if (ret) {
1214                                dev_err(di->dev, "%s write failed\n", __func__);
1215                                goto exit_set_current;
1216                        }
1217                        if (i != curr_index)
1218                                usleep_range(step_udelay, step_udelay * 2);
1219
1220                        allow = ab8500_charger_check_continue_stepping(di, reg);
1221                }
1222        }
1223
1224exit_set_current:
1225        atomic_dec(&di->current_stepping_sessions);
1226
1227        return ret;
1228}
1229
1230/**
1231 * ab8500_charger_set_vbus_in_curr() - set VBUS input current limit
1232 * @di:         pointer to the ab8500_charger structure
1233 * @ich_in:     charger input current limit
1234 *
1235 * Sets the current that can be drawn from the USB host
1236 * Returns error code in case of failure else 0(on success)
1237 */
1238static int ab8500_charger_set_vbus_in_curr(struct ab8500_charger *di,
1239                int ich_in)
1240{
1241        int min_value;
1242        int ret;
1243
1244        /* We should always use to lowest current limit */
1245        min_value = min(di->bm->chg_params->usb_curr_max, ich_in);
1246        if (di->max_usb_in_curr.set_max > 0)
1247                min_value = min(di->max_usb_in_curr.set_max, min_value);
1248
1249        if (di->usb_state.usb_current >= 0)
1250                min_value = min(di->usb_state.usb_current, min_value);
1251
1252        switch (min_value) {
1253        case 100:
1254                if (di->vbat < VBAT_TRESH_IP_CUR_RED)
1255                        min_value = USB_CH_IP_CUR_LVL_0P05;
1256                break;
1257        case 500:
1258                if (di->vbat < VBAT_TRESH_IP_CUR_RED)
1259                        min_value = USB_CH_IP_CUR_LVL_0P45;
1260                break;
1261        default:
1262                break;
1263        }
1264
1265        dev_info(di->dev, "VBUS input current limit set to %d mA\n", min_value);
1266
1267        mutex_lock(&di->usb_ipt_crnt_lock);
1268        ret = ab8500_charger_set_current(di, min_value,
1269                AB8500_USBCH_IPT_CRNTLVL_REG);
1270        mutex_unlock(&di->usb_ipt_crnt_lock);
1271
1272        return ret;
1273}
1274
1275/**
1276 * ab8500_charger_set_main_in_curr() - set main charger input current
1277 * @di:         pointer to the ab8500_charger structure
1278 * @ich_in:     input charger current, in mA
1279 *
1280 * Set main charger input current.
1281 * Returns error code in case of failure else 0(on success)
1282 */
1283static int ab8500_charger_set_main_in_curr(struct ab8500_charger *di,
1284        int ich_in)
1285{
1286        return ab8500_charger_set_current(di, ich_in,
1287                AB8500_MCH_IPT_CURLVL_REG);
1288}
1289
1290/**
1291 * ab8500_charger_set_output_curr() - set charger output current
1292 * @di:         pointer to the ab8500_charger structure
1293 * @ich_out:    output charger current, in mA
1294 *
1295 * Set charger output current.
1296 * Returns error code in case of failure else 0(on success)
1297 */
1298static int ab8500_charger_set_output_curr(struct ab8500_charger *di,
1299        int ich_out)
1300{
1301        return ab8500_charger_set_current(di, ich_out,
1302                AB8500_CH_OPT_CRNTLVL_REG);
1303}
1304
1305/**
1306 * ab8500_charger_led_en() - turn on/off chargign led
1307 * @di:         pointer to the ab8500_charger structure
1308 * @on:         flag to turn on/off the chargign led
1309 *
1310 * Power ON/OFF charging LED indication
1311 * Returns error code in case of failure else 0(on success)
1312 */
1313static int ab8500_charger_led_en(struct ab8500_charger *di, int on)
1314{
1315        int ret;
1316
1317        if (on) {
1318                /* Power ON charging LED indicator, set LED current to 5mA */
1319                ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1320                        AB8500_LED_INDICATOR_PWM_CTRL,
1321                        (LED_IND_CUR_5MA | LED_INDICATOR_PWM_ENA));
1322                if (ret) {
1323                        dev_err(di->dev, "Power ON LED failed\n");
1324                        return ret;
1325                }
1326                /* LED indicator PWM duty cycle 252/256 */
1327                ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1328                        AB8500_LED_INDICATOR_PWM_DUTY,
1329                        LED_INDICATOR_PWM_DUTY_252_256);
1330                if (ret) {
1331                        dev_err(di->dev, "Set LED PWM duty cycle failed\n");
1332                        return ret;
1333                }
1334        } else {
1335                /* Power off charging LED indicator */
1336                ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1337                        AB8500_LED_INDICATOR_PWM_CTRL,
1338                        LED_INDICATOR_PWM_DIS);
1339                if (ret) {
1340                        dev_err(di->dev, "Power-off LED failed\n");
1341                        return ret;
1342                }
1343        }
1344
1345        return ret;
1346}
1347
1348/**
1349 * ab8500_charger_ac_en() - enable or disable ac charging
1350 * @di:         pointer to the ab8500_charger structure
1351 * @enable:     enable/disable flag
1352 * @vset:       charging voltage
1353 * @iset:       charging current
1354 *
1355 * Enable/Disable AC/Mains charging and turns on/off the charging led
1356 * respectively.
1357 **/
1358static int ab8500_charger_ac_en(struct ux500_charger *charger,
1359        int enable, int vset, int iset)
1360{
1361        int ret;
1362        int volt_index;
1363        int curr_index;
1364        int input_curr_index;
1365        u8 overshoot = 0;
1366
1367        struct ab8500_charger *di = to_ab8500_charger_ac_device_info(charger);
1368
1369        if (enable) {
1370                /* Check if AC is connected */
1371                if (!di->ac.charger_connected) {
1372                        dev_err(di->dev, "AC charger not connected\n");
1373                        return -ENXIO;
1374                }
1375
1376                /* Enable AC charging */
1377                dev_dbg(di->dev, "Enable AC: %dmV %dmA\n", vset, iset);
1378
1379                /*
1380                 * Due to a bug in AB8500, BTEMP_HIGH/LOW interrupts
1381                 * will be triggered everytime we enable the VDD ADC supply.
1382                 * This will turn off charging for a short while.
1383                 * It can be avoided by having the supply on when
1384                 * there is a charger enabled. Normally the VDD ADC supply
1385                 * is enabled everytime a GPADC conversion is triggered. We will
1386                 * force it to be enabled from this driver to have
1387                 * the GPADC module independant of the AB8500 chargers
1388                 */
1389                if (!di->vddadc_en_ac) {
1390                        regulator_enable(di->regu);
1391                        di->vddadc_en_ac = true;
1392                }
1393
1394                /* Check if the requested voltage or current is valid */
1395                volt_index = ab8500_voltage_to_regval(vset);
1396                curr_index = ab8500_current_to_regval(di, iset);
1397                input_curr_index = ab8500_current_to_regval(di,
1398                        di->bm->chg_params->ac_curr_max);
1399                if (volt_index < 0 || curr_index < 0 || input_curr_index < 0) {
1400                        dev_err(di->dev,
1401                                "Charger voltage or current too high, "
1402                                "charging not started\n");
1403                        return -ENXIO;
1404                }
1405
1406                /* ChVoltLevel: maximum battery charging voltage */
1407                ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1408                        AB8500_CH_VOLT_LVL_REG, (u8) volt_index);
1409                if (ret) {
1410                        dev_err(di->dev, "%s write failed\n", __func__);
1411                        return ret;
1412                }
1413                /* MainChInputCurr: current that can be drawn from the charger*/
1414                ret = ab8500_charger_set_main_in_curr(di,
1415                        di->bm->chg_params->ac_curr_max);
1416                if (ret) {
1417                        dev_err(di->dev, "%s Failed to set MainChInputCurr\n",
1418                                __func__);
1419                        return ret;
1420                }
1421                /* ChOutputCurentLevel: protected output current */
1422                ret = ab8500_charger_set_output_curr(di, iset);
1423                if (ret) {
1424                        dev_err(di->dev, "%s "
1425                                "Failed to set ChOutputCurentLevel\n",
1426                                __func__);
1427                        return ret;
1428                }
1429
1430                /* Check if VBAT overshoot control should be enabled */
1431                if (!di->bm->enable_overshoot)
1432                        overshoot = MAIN_CH_NO_OVERSHOOT_ENA_N;
1433
1434                /* Enable Main Charger */
1435                ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1436                        AB8500_MCH_CTRL1, MAIN_CH_ENA | overshoot);
1437                if (ret) {
1438                        dev_err(di->dev, "%s write failed\n", __func__);
1439                        return ret;
1440                }
1441
1442                /* Power on charging LED indication */
1443                ret = ab8500_charger_led_en(di, true);
1444                if (ret < 0)
1445                        dev_err(di->dev, "failed to enable LED\n");
1446
1447                di->ac.charger_online = 1;
1448        } else {
1449                /* Disable AC charging */
1450                if (is_ab8500_1p1_or_earlier(di->parent)) {
1451                        /*
1452                         * For ABB revision 1.0 and 1.1 there is a bug in the
1453                         * watchdog logic. That means we have to continously
1454                         * kick the charger watchdog even when no charger is
1455                         * connected. This is only valid once the AC charger
1456                         * has been enabled. This is a bug that is not handled
1457                         * by the algorithm and the watchdog have to be kicked
1458                         * by the charger driver when the AC charger
1459                         * is disabled
1460                         */
1461                        if (di->ac_conn) {
1462                                queue_delayed_work(di->charger_wq,
1463                                        &di->kick_wd_work,
1464                                        round_jiffies(WD_KICK_INTERVAL));
1465                        }
1466
1467                        /*
1468                         * We can't turn off charging completely
1469                         * due to a bug in AB8500 cut1.
1470                         * If we do, charging will not start again.
1471                         * That is why we set the lowest voltage
1472                         * and current possible
1473                         */
1474                        ret = abx500_set_register_interruptible(di->dev,
1475                                AB8500_CHARGER,
1476                                AB8500_CH_VOLT_LVL_REG, CH_VOL_LVL_3P5);
1477                        if (ret) {
1478                                dev_err(di->dev,
1479                                        "%s write failed\n", __func__);
1480                                return ret;
1481                        }
1482
1483                        ret = ab8500_charger_set_output_curr(di, 0);
1484                        if (ret) {
1485                                dev_err(di->dev, "%s "
1486                                        "Failed to set ChOutputCurentLevel\n",
1487                                        __func__);
1488                                return ret;
1489                        }
1490                } else {
1491                        ret = abx500_set_register_interruptible(di->dev,
1492                                AB8500_CHARGER,
1493                                AB8500_MCH_CTRL1, 0);
1494                        if (ret) {
1495                                dev_err(di->dev,
1496                                        "%s write failed\n", __func__);
1497                                return ret;
1498                        }
1499                }
1500
1501                ret = ab8500_charger_led_en(di, false);
1502                if (ret < 0)
1503                        dev_err(di->dev, "failed to disable LED\n");
1504
1505                di->ac.charger_online = 0;
1506                di->ac.wd_expired = false;
1507
1508                /* Disable regulator if enabled */
1509                if (di->vddadc_en_ac) {
1510                        regulator_disable(di->regu);
1511                        di->vddadc_en_ac = false;
1512                }
1513
1514                dev_dbg(di->dev, "%s Disabled AC charging\n", __func__);
1515        }
1516        ab8500_power_supply_changed(di, &di->ac_chg.psy);
1517
1518        return ret;
1519}
1520
1521/**
1522 * ab8500_charger_usb_en() - enable usb charging
1523 * @di:         pointer to the ab8500_charger structure
1524 * @enable:     enable/disable flag
1525 * @vset:       charging voltage
1526 * @ich_out:    charger output current
1527 *
1528 * Enable/Disable USB charging and turns on/off the charging led respectively.
1529 * Returns error code in case of failure else 0(on success)
1530 */
1531static int ab8500_charger_usb_en(struct ux500_charger *charger,
1532        int enable, int vset, int ich_out)
1533{
1534        int ret;
1535        int volt_index;
1536        int curr_index;
1537        u8 overshoot = 0;
1538
1539        struct ab8500_charger *di = to_ab8500_charger_usb_device_info(charger);
1540
1541        if (enable) {
1542                /* Check if USB is connected */
1543                if (!di->usb.charger_connected) {
1544                        dev_err(di->dev, "USB charger not connected\n");
1545                        return -ENXIO;
1546                }
1547
1548                /*
1549                 * Due to a bug in AB8500, BTEMP_HIGH/LOW interrupts
1550                 * will be triggered everytime we enable the VDD ADC supply.
1551                 * This will turn off charging for a short while.
1552                 * It can be avoided by having the supply on when
1553                 * there is a charger enabled. Normally the VDD ADC supply
1554                 * is enabled everytime a GPADC conversion is triggered. We will
1555                 * force it to be enabled from this driver to have
1556                 * the GPADC module independant of the AB8500 chargers
1557                 */
1558                if (!di->vddadc_en_usb) {
1559                        regulator_enable(di->regu);
1560                        di->vddadc_en_usb = true;
1561                }
1562
1563                /* Enable USB charging */
1564                dev_dbg(di->dev, "Enable USB: %dmV %dmA\n", vset, ich_out);
1565
1566                /* Check if the requested voltage or current is valid */
1567                volt_index = ab8500_voltage_to_regval(vset);
1568                curr_index = ab8500_current_to_regval(di, ich_out);
1569                if (volt_index < 0 || curr_index < 0) {
1570                        dev_err(di->dev,
1571                                "Charger voltage or current too high, "
1572                                "charging not started\n");
1573                        return -ENXIO;
1574                }
1575
1576                /* ChVoltLevel: max voltage upto which battery can be charged */
1577                ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1578                        AB8500_CH_VOLT_LVL_REG, (u8) volt_index);
1579                if (ret) {
1580                        dev_err(di->dev, "%s write failed\n", __func__);
1581                        return ret;
1582                }
1583                /* Check if VBAT overshoot control should be enabled */
1584                if (!di->bm->enable_overshoot)
1585                        overshoot = USB_CHG_NO_OVERSHOOT_ENA_N;
1586
1587                /* Enable USB Charger */
1588                dev_dbg(di->dev,
1589                        "Enabling USB with write to AB8500_USBCH_CTRL1_REG\n");
1590                ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1591                        AB8500_USBCH_CTRL1_REG, USB_CH_ENA | overshoot);
1592                if (ret) {
1593                        dev_err(di->dev, "%s write failed\n", __func__);
1594                        return ret;
1595                }
1596
1597                /* If success power on charging LED indication */
1598                ret = ab8500_charger_led_en(di, true);
1599                if (ret < 0)
1600                        dev_err(di->dev, "failed to enable LED\n");
1601
1602                di->usb.charger_online = 1;
1603
1604                /* USBChInputCurr: current that can be drawn from the usb */
1605                ret = ab8500_charger_set_vbus_in_curr(di,
1606                                        di->max_usb_in_curr.usb_type_max);
1607                if (ret) {
1608                        dev_err(di->dev, "setting USBChInputCurr failed\n");
1609                        return ret;
1610                }
1611
1612                /* ChOutputCurentLevel: protected output current */
1613                ret = ab8500_charger_set_output_curr(di, ich_out);
1614                if (ret) {
1615                        dev_err(di->dev, "%s "
1616                                "Failed to set ChOutputCurentLevel\n",
1617                                __func__);
1618                        return ret;
1619                }
1620
1621                queue_delayed_work(di->charger_wq, &di->check_vbat_work, HZ);
1622
1623        } else {
1624                /* Disable USB charging */
1625                dev_dbg(di->dev, "%s Disabled USB charging\n", __func__);
1626                ret = abx500_set_register_interruptible(di->dev,
1627                        AB8500_CHARGER,
1628                        AB8500_USBCH_CTRL1_REG, 0);
1629                if (ret) {
1630                        dev_err(di->dev,
1631                                "%s write failed\n", __func__);
1632                        return ret;
1633                }
1634
1635                ret = ab8500_charger_led_en(di, false);
1636                if (ret < 0)
1637                        dev_err(di->dev, "failed to disable LED\n");
1638                /* USBChInputCurr: current that can be drawn from the usb */
1639                ret = ab8500_charger_set_vbus_in_curr(di, 0);
1640                if (ret) {
1641                        dev_err(di->dev, "setting USBChInputCurr failed\n");
1642                        return ret;
1643                }
1644
1645                /* ChOutputCurentLevel: protected output current */
1646                ret = ab8500_charger_set_output_curr(di, 0);
1647                if (ret) {
1648                        dev_err(di->dev, "%s "
1649                                "Failed to reset ChOutputCurentLevel\n",
1650                                __func__);
1651                        return ret;
1652                }
1653                di->usb.charger_online = 0;
1654                di->usb.wd_expired = false;
1655
1656                /* Disable regulator if enabled */
1657                if (di->vddadc_en_usb) {
1658                        regulator_disable(di->regu);
1659                        di->vddadc_en_usb = false;
1660                }
1661
1662                dev_dbg(di->dev, "%s Disabled USB charging\n", __func__);
1663
1664                /* Cancel any pending Vbat check work */
1665                cancel_delayed_work(&di->check_vbat_work);
1666
1667        }
1668        ab8500_power_supply_changed(di, &di->usb_chg.psy);
1669
1670        return ret;
1671}
1672
1673static int ab8500_external_charger_prepare(struct notifier_block *charger_nb,
1674                                unsigned long event, void *data)
1675{
1676        int ret;
1677        struct device *dev = data;
1678        /*Toggle External charger control pin*/
1679        ret = abx500_set_register_interruptible(dev, AB8500_SYS_CTRL1_BLOCK,
1680                                  AB8500_SYS_CHARGER_CONTROL_REG,
1681                                  EXTERNAL_CHARGER_DISABLE_REG_VAL);
1682        if (ret < 0) {
1683                dev_err(dev, "write reg failed %d\n", ret);
1684                goto out;
1685        }
1686        ret = abx500_set_register_interruptible(dev, AB8500_SYS_CTRL1_BLOCK,
1687                                  AB8500_SYS_CHARGER_CONTROL_REG,
1688                                  EXTERNAL_CHARGER_ENABLE_REG_VAL);
1689        if (ret < 0)
1690                dev_err(dev, "Write reg failed %d\n", ret);
1691
1692out:
1693        return ret;
1694}
1695
1696/**
1697 * ab8500_charger_usb_check_enable() - enable usb charging
1698 * @charger:    pointer to the ux500_charger structure
1699 * @vset:       charging voltage
1700 * @iset:       charger output current
1701 *
1702 * Check if the VBUS charger has been disconnected and reconnected without
1703 * AB8500 rising an interrupt. Returns 0 on success.
1704 */
1705static int ab8500_charger_usb_check_enable(struct ux500_charger *charger,
1706        int vset, int iset)
1707{
1708        u8 usbch_ctrl1 = 0;
1709        int ret = 0;
1710
1711        struct ab8500_charger *di = to_ab8500_charger_usb_device_info(charger);
1712
1713        if (!di->usb.charger_connected)
1714                return ret;
1715
1716        ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
1717                                AB8500_USBCH_CTRL1_REG, &usbch_ctrl1);
1718        if (ret < 0) {
1719                dev_err(di->dev, "ab8500 read failed %d\n", __LINE__);
1720                return ret;
1721        }
1722        dev_dbg(di->dev, "USB charger ctrl: 0x%02x\n", usbch_ctrl1);
1723
1724        if (!(usbch_ctrl1 & USB_CH_ENA)) {
1725                dev_info(di->dev, "Charging has been disabled abnormally and will be re-enabled\n");
1726
1727                ret = abx500_mask_and_set_register_interruptible(di->dev,
1728                                        AB8500_CHARGER, AB8500_CHARGER_CTRL,
1729                                        DROP_COUNT_RESET, DROP_COUNT_RESET);
1730                if (ret < 0) {
1731                        dev_err(di->dev, "ab8500 write failed %d\n", __LINE__);
1732                        return ret;
1733                }
1734
1735                ret = ab8500_charger_usb_en(&di->usb_chg, true, vset, iset);
1736                if (ret < 0) {
1737                        dev_err(di->dev, "Failed to enable VBUS charger %d\n",
1738                                        __LINE__);
1739                        return ret;
1740                }
1741        }
1742        return ret;
1743}
1744
1745/**
1746 * ab8500_charger_ac_check_enable() - enable usb charging
1747 * @charger:    pointer to the ux500_charger structure
1748 * @vset:       charging voltage
1749 * @iset:       charger output current
1750 *
1751 * Check if the AC charger has been disconnected and reconnected without
1752 * AB8500 rising an interrupt. Returns 0 on success.
1753 */
1754static int ab8500_charger_ac_check_enable(struct ux500_charger *charger,
1755        int vset, int iset)
1756{
1757        u8 mainch_ctrl1 = 0;
1758        int ret = 0;
1759
1760        struct ab8500_charger *di = to_ab8500_charger_ac_device_info(charger);
1761
1762        if (!di->ac.charger_connected)
1763                return ret;
1764
1765        ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
1766                                AB8500_MCH_CTRL1, &mainch_ctrl1);
1767        if (ret < 0) {
1768                dev_err(di->dev, "ab8500 read failed %d\n", __LINE__);
1769                return ret;
1770        }
1771        dev_dbg(di->dev, "AC charger ctrl: 0x%02x\n", mainch_ctrl1);
1772
1773        if (!(mainch_ctrl1 & MAIN_CH_ENA)) {
1774                dev_info(di->dev, "Charging has been disabled abnormally and will be re-enabled\n");
1775
1776                ret = abx500_mask_and_set_register_interruptible(di->dev,
1777                                        AB8500_CHARGER, AB8500_CHARGER_CTRL,
1778                                        DROP_COUNT_RESET, DROP_COUNT_RESET);
1779
1780                if (ret < 0) {
1781                        dev_err(di->dev, "ab8500 write failed %d\n", __LINE__);
1782                        return ret;
1783                }
1784
1785                ret = ab8500_charger_ac_en(&di->usb_chg, true, vset, iset);
1786                if (ret < 0) {
1787                        dev_err(di->dev, "failed to enable AC charger %d\n",
1788                                __LINE__);
1789                        return ret;
1790                }
1791        }
1792        return ret;
1793}
1794
1795/**
1796 * ab8500_charger_watchdog_kick() - kick charger watchdog
1797 * @di:         pointer to the ab8500_charger structure
1798 *
1799 * Kick charger watchdog
1800 * Returns error code in case of failure else 0(on success)
1801 */
1802static int ab8500_charger_watchdog_kick(struct ux500_charger *charger)
1803{
1804        int ret;
1805        struct ab8500_charger *di;
1806
1807        if (charger->psy.type == POWER_SUPPLY_TYPE_MAINS)
1808                di = to_ab8500_charger_ac_device_info(charger);
1809        else if (charger->psy.type == POWER_SUPPLY_TYPE_USB)
1810                di = to_ab8500_charger_usb_device_info(charger);
1811        else
1812                return -ENXIO;
1813
1814        ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1815                AB8500_CHARG_WD_CTRL, CHARG_WD_KICK);
1816        if (ret)
1817                dev_err(di->dev, "Failed to kick WD!\n");
1818
1819        return ret;
1820}
1821
1822/**
1823 * ab8500_charger_update_charger_current() - update charger current
1824 * @di:         pointer to the ab8500_charger structure
1825 *
1826 * Update the charger output current for the specified charger
1827 * Returns error code in case of failure else 0(on success)
1828 */
1829static int ab8500_charger_update_charger_current(struct ux500_charger *charger,
1830                int ich_out)
1831{
1832        int ret;
1833        struct ab8500_charger *di;
1834
1835        if (charger->psy.type == POWER_SUPPLY_TYPE_MAINS)
1836                di = to_ab8500_charger_ac_device_info(charger);
1837        else if (charger->psy.type == POWER_SUPPLY_TYPE_USB)
1838                di = to_ab8500_charger_usb_device_info(charger);
1839        else
1840                return -ENXIO;
1841
1842        ret = ab8500_charger_set_output_curr(di, ich_out);
1843        if (ret) {
1844                dev_err(di->dev, "%s "
1845                        "Failed to set ChOutputCurentLevel\n",
1846                        __func__);
1847                return ret;
1848        }
1849
1850        /* Reset the main and usb drop input current measurement counter */
1851        ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
1852                                AB8500_CHARGER_CTRL, DROP_COUNT_RESET);
1853        if (ret) {
1854                dev_err(di->dev, "%s write failed\n", __func__);
1855                return ret;
1856        }
1857
1858        return ret;
1859}
1860
1861/**
1862 * ab8540_charger_power_path_enable() - enable usb power path mode
1863 * @charger:    pointer to the ux500_charger structure
1864 * @enable:     enable/disable flag
1865 *
1866 * Enable or disable the power path for usb mode
1867 * Returns error code in case of failure else 0(on success)
1868 */
1869static int ab8540_charger_power_path_enable(struct ux500_charger *charger,
1870                bool enable)
1871{
1872        int ret;
1873        struct ab8500_charger *di;
1874
1875        if (charger->psy.type == POWER_SUPPLY_TYPE_USB)
1876                di = to_ab8500_charger_usb_device_info(charger);
1877        else
1878                return -ENXIO;
1879
1880        ret = abx500_mask_and_set_register_interruptible(di->dev,
1881                                AB8500_CHARGER, AB8540_USB_PP_MODE_REG,
1882                                BUS_POWER_PATH_MODE_ENA, enable);
1883        if (ret) {
1884                dev_err(di->dev, "%s write failed\n", __func__);
1885                return ret;
1886        }
1887
1888        return ret;
1889}
1890
1891
1892/**
1893 * ab8540_charger_usb_pre_chg_enable() - enable usb pre change
1894 * @charger:    pointer to the ux500_charger structure
1895 * @enable:     enable/disable flag
1896 *
1897 * Enable or disable the pre-chage for usb mode
1898 * Returns error code in case of failure else 0(on success)
1899 */
1900static int ab8540_charger_usb_pre_chg_enable(struct ux500_charger *charger,
1901                bool enable)
1902{
1903        int ret;
1904        struct ab8500_charger *di;
1905
1906        if (charger->psy.type == POWER_SUPPLY_TYPE_USB)
1907                di = to_ab8500_charger_usb_device_info(charger);
1908        else
1909                return -ENXIO;
1910
1911        ret = abx500_mask_and_set_register_interruptible(di->dev,
1912                                AB8500_CHARGER, AB8540_USB_PP_CHR_REG,
1913                                BUS_POWER_PATH_PRECHG_ENA, enable);
1914        if (ret) {
1915                dev_err(di->dev, "%s write failed\n", __func__);
1916                return ret;
1917        }
1918
1919        return ret;
1920}
1921
1922static int ab8500_charger_get_ext_psy_data(struct device *dev, void *data)
1923{
1924        struct power_supply *psy;
1925        struct power_supply *ext;
1926        struct ab8500_charger *di;
1927        union power_supply_propval ret;
1928        int i, j;
1929        bool psy_found = false;
1930        struct ux500_charger *usb_chg;
1931
1932        usb_chg = (struct ux500_charger *)data;
1933        psy = &usb_chg->psy;
1934
1935        di = to_ab8500_charger_usb_device_info(usb_chg);
1936
1937        ext = dev_get_drvdata(dev);
1938
1939        /* For all psy where the driver name appears in any supplied_to */
1940        for (i = 0; i < ext->num_supplicants; i++) {
1941                if (!strcmp(ext->supplied_to[i], psy->name))
1942                        psy_found = true;
1943        }
1944
1945        if (!psy_found)
1946                return 0;
1947
1948        /* Go through all properties for the psy */
1949        for (j = 0; j < ext->num_properties; j++) {
1950                enum power_supply_property prop;
1951                prop = ext->properties[j];
1952
1953                if (ext->get_property(ext, prop, &ret))
1954                        continue;
1955
1956                switch (prop) {
1957                case POWER_SUPPLY_PROP_VOLTAGE_NOW:
1958                        switch (ext->type) {
1959                        case POWER_SUPPLY_TYPE_BATTERY:
1960                                di->vbat = ret.intval / 1000;
1961                                break;
1962                        default:
1963                                break;
1964                        }
1965                        break;
1966                default:
1967                        break;
1968                }
1969        }
1970        return 0;
1971}
1972
1973/**
1974 * ab8500_charger_check_vbat_work() - keep vbus current within spec
1975 * @work        pointer to the work_struct structure
1976 *
1977 * Due to a asic bug it is necessary to lower the input current to the vbus
1978 * charger when charging with at some specific levels. This issue is only valid
1979 * for below a certain battery voltage. This function makes sure that the
1980 * the allowed current limit isn't exceeded.
1981 */
1982static void ab8500_charger_check_vbat_work(struct work_struct *work)
1983{
1984        int t = 10;
1985        struct ab8500_charger *di = container_of(work,
1986                struct ab8500_charger, check_vbat_work.work);
1987
1988        class_for_each_device(power_supply_class, NULL,
1989                &di->usb_chg.psy, ab8500_charger_get_ext_psy_data);
1990
1991        /* First run old_vbat is 0. */
1992        if (di->old_vbat == 0)
1993                di->old_vbat = di->vbat;
1994
1995        if (!((di->old_vbat <= VBAT_TRESH_IP_CUR_RED &&
1996                di->vbat <= VBAT_TRESH_IP_CUR_RED) ||
1997                (di->old_vbat > VBAT_TRESH_IP_CUR_RED &&
1998                di->vbat > VBAT_TRESH_IP_CUR_RED))) {
1999
2000                dev_dbg(di->dev, "Vbat did cross threshold, curr: %d, new: %d,"
2001                        " old: %d\n", di->max_usb_in_curr.usb_type_max,
2002                        di->vbat, di->old_vbat);
2003                ab8500_charger_set_vbus_in_curr(di,
2004                                        di->max_usb_in_curr.usb_type_max);
2005                power_supply_changed(&di->usb_chg.psy);
2006        }
2007
2008        di->old_vbat = di->vbat;
2009
2010        /*
2011         * No need to check the battery voltage every second when not close to
2012         * the threshold.
2013         */
2014        if (di->vbat < (VBAT_TRESH_IP_CUR_RED + 100) &&
2015                (di->vbat > (VBAT_TRESH_IP_CUR_RED - 100)))
2016                        t = 1;
2017
2018        queue_delayed_work(di->charger_wq, &di->check_vbat_work, t * HZ);
2019}
2020
2021/**
2022 * ab8500_charger_check_hw_failure_work() - check main charger failure
2023 * @work:       pointer to the work_struct structure
2024 *
2025 * Work queue function for checking the main charger status
2026 */
2027static void ab8500_charger_check_hw_failure_work(struct work_struct *work)
2028{
2029        int ret;
2030        u8 reg_value;
2031
2032        struct ab8500_charger *di = container_of(work,
2033                struct ab8500_charger, check_hw_failure_work.work);
2034
2035        /* Check if the status bits for HW failure is still active */
2036        if (di->flags.mainextchnotok) {
2037                ret = abx500_get_register_interruptible(di->dev,
2038                        AB8500_CHARGER, AB8500_CH_STATUS2_REG, &reg_value);
2039                if (ret < 0) {
2040                        dev_err(di->dev, "%s ab8500 read failed\n", __func__);
2041                        return;
2042                }
2043                if (!(reg_value & MAIN_CH_NOK)) {
2044                        di->flags.mainextchnotok = false;
2045                        ab8500_power_supply_changed(di, &di->ac_chg.psy);
2046                }
2047        }
2048        if (di->flags.vbus_ovv) {
2049                ret = abx500_get_register_interruptible(di->dev,
2050                        AB8500_CHARGER, AB8500_CH_USBCH_STAT2_REG,
2051                        &reg_value);
2052                if (ret < 0) {
2053                        dev_err(di->dev, "%s ab8500 read failed\n", __func__);
2054                        return;
2055                }
2056                if (!(reg_value & VBUS_OVV_TH)) {
2057                        di->flags.vbus_ovv = false;
2058                        ab8500_power_supply_changed(di, &di->usb_chg.psy);
2059                }
2060        }
2061        /* If we still have a failure, schedule a new check */
2062        if (di->flags.mainextchnotok || di->flags.vbus_ovv) {
2063                queue_delayed_work(di->charger_wq,
2064                        &di->check_hw_failure_work, round_jiffies(HZ));
2065        }
2066}
2067
2068/**
2069 * ab8500_charger_kick_watchdog_work() - kick the watchdog
2070 * @work:       pointer to the work_struct structure
2071 *
2072 * Work queue function for kicking the charger watchdog.
2073 *
2074 * For ABB revision 1.0 and 1.1 there is a bug in the watchdog
2075 * logic. That means we have to continously kick the charger
2076 * watchdog even when no charger is connected. This is only
2077 * valid once the AC charger has been enabled. This is
2078 * a bug that is not handled by the algorithm and the
2079 * watchdog have to be kicked by the charger driver
2080 * when the AC charger is disabled
2081 */
2082static void ab8500_charger_kick_watchdog_work(struct work_struct *work)
2083{
2084        int ret;
2085
2086        struct ab8500_charger *di = container_of(work,
2087                struct ab8500_charger, kick_wd_work.work);
2088
2089        ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
2090                AB8500_CHARG_WD_CTRL, CHARG_WD_KICK);
2091        if (ret)
2092                dev_err(di->dev, "Failed to kick WD!\n");
2093
2094        /* Schedule a new watchdog kick */
2095        queue_delayed_work(di->charger_wq,
2096                &di->kick_wd_work, round_jiffies(WD_KICK_INTERVAL));
2097}
2098
2099/**
2100 * ab8500_charger_ac_work() - work to get and set main charger status
2101 * @work:       pointer to the work_struct structure
2102 *
2103 * Work queue function for checking the main charger status
2104 */
2105static void ab8500_charger_ac_work(struct work_struct *work)
2106{
2107        int ret;
2108
2109        struct ab8500_charger *di = container_of(work,
2110                struct ab8500_charger, ac_work);
2111
2112        /*
2113         * Since we can't be sure that the events are received
2114         * synchronously, we have the check if the main charger is
2115         * connected by reading the status register
2116         */
2117        ret = ab8500_charger_detect_chargers(di, false);
2118        if (ret < 0)
2119                return;
2120
2121        if (ret & AC_PW_CONN) {
2122                di->ac.charger_connected = 1;
2123                di->ac_conn = true;
2124        } else {
2125                di->ac.charger_connected = 0;
2126        }
2127
2128        ab8500_power_supply_changed(di, &di->ac_chg.psy);
2129        sysfs_notify(&di->ac_chg.psy.dev->kobj, NULL, "present");
2130}
2131
2132static void ab8500_charger_usb_attached_work(struct work_struct *work)
2133{
2134        struct ab8500_charger *di = container_of(work,
2135                                                 struct ab8500_charger,
2136                                                 usb_charger_attached_work.work);
2137        int usbch = (USB_CH_VBUSDROP | USB_CH_VBUSDETDBNC);
2138        int ret, i;
2139        u8 statval;
2140
2141        for (i = 0; i < 10; i++) {
2142                ret = abx500_get_register_interruptible(di->dev,
2143                                                        AB8500_CHARGER,
2144                                                        AB8500_CH_USBCH_STAT1_REG,
2145                                                        &statval);
2146                if (ret < 0) {
2147                        dev_err(di->dev, "ab8500 read failed %d\n", __LINE__);
2148                        goto reschedule;
2149                }
2150                if ((statval & usbch) != usbch)
2151                        goto reschedule;
2152
2153                msleep(CHARGER_STATUS_POLL);
2154        }
2155
2156        ab8500_charger_usb_en(&di->usb_chg, 0, 0, 0);
2157
2158        mutex_lock(&di->charger_attached_mutex);
2159        mutex_unlock(&di->charger_attached_mutex);
2160
2161        return;
2162
2163reschedule:
2164        queue_delayed_work(di->charger_wq,
2165                           &di->usb_charger_attached_work,
2166                           HZ);
2167}
2168
2169static void ab8500_charger_ac_attached_work(struct work_struct *work)
2170{
2171
2172        struct ab8500_charger *di = container_of(work,
2173                                                 struct ab8500_charger,
2174                                                 ac_charger_attached_work.work);
2175        int mainch = (MAIN_CH_STATUS2_MAINCHGDROP |
2176                      MAIN_CH_STATUS2_MAINCHARGERDETDBNC);
2177        int ret, i;
2178        u8 statval;
2179
2180        for (i = 0; i < 10; i++) {
2181                ret = abx500_get_register_interruptible(di->dev,
2182                                                        AB8500_CHARGER,
2183                                                        AB8500_CH_STATUS2_REG,
2184                                                        &statval);
2185                if (ret < 0) {
2186                        dev_err(di->dev, "ab8500 read failed %d\n", __LINE__);
2187                        goto reschedule;
2188                }
2189
2190                if ((statval & mainch) != mainch)
2191                        goto reschedule;
2192
2193                msleep(CHARGER_STATUS_POLL);
2194        }
2195
2196        ab8500_charger_ac_en(&di->ac_chg, 0, 0, 0);
2197        queue_work(di->charger_wq, &di->ac_work);
2198
2199        mutex_lock(&di->charger_attached_mutex);
2200        mutex_unlock(&di->charger_attached_mutex);
2201
2202        return;
2203
2204reschedule:
2205        queue_delayed_work(di->charger_wq,
2206                           &di->ac_charger_attached_work,
2207                           HZ);
2208}
2209
2210/**
2211 * ab8500_charger_detect_usb_type_work() - work to detect USB type
2212 * @work:       Pointer to the work_struct structure
2213 *
2214 * Detect the type of USB plugged
2215 */
2216static void ab8500_charger_detect_usb_type_work(struct work_struct *work)
2217{
2218        int ret;
2219
2220        struct ab8500_charger *di = container_of(work,
2221                struct ab8500_charger, detect_usb_type_work);
2222
2223        /*
2224         * Since we can't be sure that the events are received
2225         * synchronously, we have the check if is
2226         * connected by reading the status register
2227         */
2228        ret = ab8500_charger_detect_chargers(di, false);
2229        if (ret < 0)
2230                return;
2231
2232        if (!(ret & USB_PW_CONN)) {
2233                dev_dbg(di->dev, "%s di->vbus_detected = false\n", __func__);
2234                di->vbus_detected = false;
2235                ab8500_charger_set_usb_connected(di, false);
2236                ab8500_power_supply_changed(di, &di->usb_chg.psy);
2237        } else {
2238                dev_dbg(di->dev, "%s di->vbus_detected = true\n", __func__);
2239                di->vbus_detected = true;
2240
2241                if (is_ab8500_1p1_or_earlier(di->parent)) {
2242                        ret = ab8500_charger_detect_usb_type(di);
2243                        if (!ret) {
2244                                ab8500_charger_set_usb_connected(di, true);
2245                                ab8500_power_supply_changed(di,
2246                                                            &di->usb_chg.psy);
2247                        }
2248                } else {
2249                        /*
2250                         * For ABB cut2.0 and onwards we have an IRQ,
2251                         * USB_LINK_STATUS that will be triggered when the USB
2252                         * link status changes. The exception is USB connected
2253                         * during startup. Then we don't get a
2254                         * USB_LINK_STATUS IRQ
2255                         */
2256                        if (di->vbus_detected_start) {
2257                                di->vbus_detected_start = false;
2258                                ret = ab8500_charger_detect_usb_type(di);
2259                                if (!ret) {
2260                                        ab8500_charger_set_usb_connected(di,
2261                                                true);
2262                                        ab8500_power_supply_changed(di,
2263                                                &di->usb_chg.psy);
2264                                }
2265                        }
2266                }
2267        }
2268}
2269
2270/**
2271 * ab8500_charger_usb_link_attach_work() - work to detect USB type
2272 * @work:       pointer to the work_struct structure
2273 *
2274 * Detect the type of USB plugged
2275 */
2276static void ab8500_charger_usb_link_attach_work(struct work_struct *work)
2277{
2278        struct ab8500_charger *di =
2279                container_of(work, struct ab8500_charger, attach_work.work);
2280        int ret;
2281
2282        /* Update maximum input current if USB enumeration is not detected */
2283        if (!di->usb.charger_online) {
2284                ret = ab8500_charger_set_vbus_in_curr(di,
2285                                        di->max_usb_in_curr.usb_type_max);
2286                if (ret)
2287                        return;
2288        }
2289
2290        ab8500_charger_set_usb_connected(di, true);
2291        ab8500_power_supply_changed(di, &di->usb_chg.psy);
2292}
2293
2294/**
2295 * ab8500_charger_usb_link_status_work() - work to detect USB type
2296 * @work:       pointer to the work_struct structure
2297 *
2298 * Detect the type of USB plugged
2299 */
2300static void ab8500_charger_usb_link_status_work(struct work_struct *work)
2301{
2302        int detected_chargers;
2303        int ret;
2304        u8 val;
2305        u8 link_status;
2306
2307        struct ab8500_charger *di = container_of(work,
2308                struct ab8500_charger, usb_link_status_work);
2309
2310        /*
2311         * Since we can't be sure that the events are received
2312         * synchronously, we have the check if  is
2313         * connected by reading the status register
2314         */
2315        detected_chargers = ab8500_charger_detect_chargers(di, false);
2316        if (detected_chargers < 0)
2317                return;
2318
2319        /*
2320         * Some chargers that breaks the USB spec is
2321         * identified as invalid by AB8500 and it refuse
2322         * to start the charging process. but by jumping
2323         * thru a few hoops it can be forced to start.
2324         */
2325        if (is_ab8500(di->parent))
2326                ret = abx500_get_register_interruptible(di->dev, AB8500_USB,
2327                                        AB8500_USB_LINE_STAT_REG, &val);
2328        else
2329                ret = abx500_get_register_interruptible(di->dev, AB8500_USB,
2330                                        AB8500_USB_LINK1_STAT_REG, &val);
2331
2332        if (ret >= 0)
2333                dev_dbg(di->dev, "UsbLineStatus register = 0x%02x\n", val);
2334        else
2335                dev_dbg(di->dev, "Error reading USB link status\n");
2336
2337        if (is_ab8500(di->parent))
2338                link_status = AB8500_USB_LINK_STATUS;
2339        else
2340                link_status = AB8505_USB_LINK_STATUS;
2341
2342        if (detected_chargers & USB_PW_CONN) {
2343                if (((val & link_status) >> USB_LINK_STATUS_SHIFT) ==
2344                                USB_STAT_NOT_VALID_LINK &&
2345                                di->invalid_charger_detect_state == 0) {
2346                        dev_dbg(di->dev,
2347                                        "Invalid charger detected, state= 0\n");
2348                        /*Enable charger*/
2349                        abx500_mask_and_set_register_interruptible(di->dev,
2350                                        AB8500_CHARGER, AB8500_USBCH_CTRL1_REG,
2351                                        USB_CH_ENA, USB_CH_ENA);
2352                        /*Enable charger detection*/
2353                        abx500_mask_and_set_register_interruptible(di->dev,
2354                                        AB8500_USB, AB8500_USB_LINE_CTRL2_REG,
2355                                        USB_CH_DET, USB_CH_DET);
2356                        di->invalid_charger_detect_state = 1;
2357                        /*exit and wait for new link status interrupt.*/
2358                        return;
2359
2360                }
2361                if (di->invalid_charger_detect_state == 1) {
2362                        dev_dbg(di->dev,
2363                                        "Invalid charger detected, state= 1\n");
2364                        /*Stop charger detection*/
2365                        abx500_mask_and_set_register_interruptible(di->dev,
2366                                        AB8500_USB, AB8500_USB_LINE_CTRL2_REG,
2367                                        USB_CH_DET, 0x00);
2368                        /*Check link status*/
2369                        if (is_ab8500(di->parent))
2370                                ret = abx500_get_register_interruptible(di->dev,
2371                                        AB8500_USB, AB8500_USB_LINE_STAT_REG,
2372                                        &val);
2373                        else
2374                                ret = abx500_get_register_interruptible(di->dev,
2375                                        AB8500_USB, AB8500_USB_LINK1_STAT_REG,
2376                                        &val);
2377
2378                        dev_dbg(di->dev, "USB link status= 0x%02x\n",
2379                                (val & link_status) >> USB_LINK_STATUS_SHIFT);
2380                        di->invalid_charger_detect_state = 2;
2381                }
2382        } else {
2383                di->invalid_charger_detect_state = 0;
2384        }
2385
2386        if (!(detected_chargers & USB_PW_CONN)) {
2387                di->vbus_detected = false;
2388                ab8500_charger_set_usb_connected(di, false);
2389                ab8500_power_supply_changed(di, &di->usb_chg.psy);
2390                return;
2391        }
2392
2393        dev_dbg(di->dev,"%s di->vbus_detected = true\n",__func__);
2394        di->vbus_detected = true;
2395        ret = ab8500_charger_read_usb_type(di);
2396        if (ret) {
2397                if (ret == -ENXIO) {
2398                        /* No valid charger type detected */
2399                        ab8500_charger_set_usb_connected(di, false);
2400                        ab8500_power_supply_changed(di, &di->usb_chg.psy);
2401                }
2402                return;
2403        }
2404
2405        if (di->usb_device_is_unrecognised) {
2406                dev_dbg(di->dev,
2407                        "Potential Legacy Charger device. "
2408                        "Delay work for %d msec for USB enum "
2409                        "to finish",
2410                        WAIT_ACA_RID_ENUMERATION);
2411                queue_delayed_work(di->charger_wq,
2412                                   &di->attach_work,
2413                                   msecs_to_jiffies(WAIT_ACA_RID_ENUMERATION));
2414        } else if (di->is_aca_rid == 1) {
2415                /* Only wait once */
2416                di->is_aca_rid++;
2417                dev_dbg(di->dev,
2418                        "%s Wait %d msec for USB enum to finish",
2419                        __func__, WAIT_ACA_RID_ENUMERATION);
2420                queue_delayed_work(di->charger_wq,
2421                                   &di->attach_work,
2422                                   msecs_to_jiffies(WAIT_ACA_RID_ENUMERATION));
2423        } else {
2424                queue_delayed_work(di->charger_wq,
2425                                   &di->attach_work,
2426                                   0);
2427        }
2428}
2429
2430static void ab8500_charger_usb_state_changed_work(struct work_struct *work)
2431{
2432        int ret;
2433        unsigned long flags;
2434
2435        struct ab8500_charger *di = container_of(work,
2436                struct ab8500_charger, usb_state_changed_work.work);
2437
2438        if (!di->vbus_detected) {
2439                dev_dbg(di->dev,
2440                        "%s !di->vbus_detected\n",
2441                        __func__);
2442                return;
2443        }
2444
2445        spin_lock_irqsave(&di->usb_state.usb_lock, flags);
2446        di->usb_state.state = di->usb_state.state_tmp;
2447        di->usb_state.usb_current = di->usb_state.usb_current_tmp;
2448        spin_unlock_irqrestore(&di->usb_state.usb_lock, flags);
2449
2450        dev_dbg(di->dev, "%s USB state: 0x%02x mA: %d\n",
2451                __func__, di->usb_state.state, di->usb_state.usb_current);
2452
2453        switch (di->usb_state.state) {
2454        case AB8500_BM_USB_STATE_RESET_HS:
2455        case AB8500_BM_USB_STATE_RESET_FS:
2456        case AB8500_BM_USB_STATE_SUSPEND:
2457        case AB8500_BM_USB_STATE_MAX:
2458                ab8500_charger_set_usb_connected(di, false);
2459                ab8500_power_supply_changed(di, &di->usb_chg.psy);
2460                break;
2461
2462        case AB8500_BM_USB_STATE_RESUME:
2463                /*
2464                 * when suspend->resume there should be delay
2465                 * of 1sec for enabling charging
2466                 */
2467                msleep(1000);
2468                /* Intentional fall through */
2469        case AB8500_BM_USB_STATE_CONFIGURED:
2470                /*
2471                 * USB is configured, enable charging with the charging
2472                 * input current obtained from USB driver
2473                 */
2474                if (!ab8500_charger_get_usb_cur(di)) {
2475                        /* Update maximum input current */
2476                        ret = ab8500_charger_set_vbus_in_curr(di,
2477                                        di->max_usb_in_curr.usb_type_max);
2478                        if (ret)
2479                                return;
2480
2481                        ab8500_charger_set_usb_connected(di, true);
2482                        ab8500_power_supply_changed(di, &di->usb_chg.psy);
2483                }
2484                break;
2485
2486        default:
2487                break;
2488        };
2489}
2490
2491/**
2492 * ab8500_charger_check_usbchargernotok_work() - check USB chg not ok status
2493 * @work:       pointer to the work_struct structure
2494 *
2495 * Work queue function for checking the USB charger Not OK status
2496 */
2497static void ab8500_charger_check_usbchargernotok_work(struct work_struct *work)
2498{
2499        int ret;
2500        u8 reg_value;
2501        bool prev_status;
2502
2503        struct ab8500_charger *di = container_of(work,
2504                struct ab8500_charger, check_usbchgnotok_work.work);
2505
2506        /* Check if the status bit for usbchargernotok is still active */
2507        ret = abx500_get_register_interruptible(di->dev,
2508                AB8500_CHARGER, AB8500_CH_USBCH_STAT2_REG, &reg_value);
2509        if (ret < 0) {
2510                dev_err(di->dev, "%s ab8500 read failed\n", __func__);
2511                return;
2512        }
2513        prev_status = di->flags.usbchargernotok;
2514
2515        if (reg_value & VBUS_CH_NOK) {
2516                di->flags.usbchargernotok = true;
2517                /* Check again in 1sec */
2518                queue_delayed_work(di->charger_wq,
2519                        &di->check_usbchgnotok_work, HZ);
2520        } else {
2521                di->flags.usbchargernotok = false;
2522                di->flags.vbus_collapse = false;
2523        }
2524
2525        if (prev_status != di->flags.usbchargernotok)
2526                ab8500_power_supply_changed(di, &di->usb_chg.psy);
2527}
2528
2529/**
2530 * ab8500_charger_check_main_thermal_prot_work() - check main thermal status
2531 * @work:       pointer to the work_struct structure
2532 *
2533 * Work queue function for checking the Main thermal prot status
2534 */
2535static void ab8500_charger_check_main_thermal_prot_work(
2536        struct work_struct *work)
2537{
2538        int ret;
2539        u8 reg_value;
2540
2541        struct ab8500_charger *di = container_of(work,
2542                struct ab8500_charger, check_main_thermal_prot_work);
2543
2544        /* Check if the status bit for main_thermal_prot is still active */
2545        ret = abx500_get_register_interruptible(di->dev,
2546                AB8500_CHARGER, AB8500_CH_STATUS2_REG, &reg_value);
2547        if (ret < 0) {
2548                dev_err(di->dev, "%s ab8500 read failed\n", __func__);
2549                return;
2550        }
2551        if (reg_value & MAIN_CH_TH_PROT)
2552                di->flags.main_thermal_prot = true;
2553        else
2554                di->flags.main_thermal_prot = false;
2555
2556        ab8500_power_supply_changed(di, &di->ac_chg.psy);
2557}
2558
2559/**
2560 * ab8500_charger_check_usb_thermal_prot_work() - check usb thermal status
2561 * @work:       pointer to the work_struct structure
2562 *
2563 * Work queue function for checking the USB thermal prot status
2564 */
2565static void ab8500_charger_check_usb_thermal_prot_work(
2566        struct work_struct *work)
2567{
2568        int ret;
2569        u8 reg_value;
2570
2571        struct ab8500_charger *di = container_of(work,
2572                struct ab8500_charger, check_usb_thermal_prot_work);
2573
2574        /* Check if the status bit for usb_thermal_prot is still active */
2575        ret = abx500_get_register_interruptible(di->dev,
2576                AB8500_CHARGER, AB8500_CH_USBCH_STAT2_REG, &reg_value);
2577        if (ret < 0) {
2578                dev_err(di->dev, "%s ab8500 read failed\n", __func__);
2579                return;
2580        }
2581        if (reg_value & USB_CH_TH_PROT)
2582                di->flags.usb_thermal_prot = true;
2583        else
2584                di->flags.usb_thermal_prot = false;
2585
2586        ab8500_power_supply_changed(di, &di->usb_chg.psy);
2587}
2588
2589/**
2590 * ab8500_charger_mainchunplugdet_handler() - main charger unplugged
2591 * @irq:       interrupt number
2592 * @_di:       pointer to the ab8500_charger structure
2593 *
2594 * Returns IRQ status(IRQ_HANDLED)
2595 */
2596static irqreturn_t ab8500_charger_mainchunplugdet_handler(int irq, void *_di)
2597{
2598        struct ab8500_charger *di = _di;
2599
2600        dev_dbg(di->dev, "Main charger unplugged\n");
2601        queue_work(di->charger_wq, &di->ac_work);
2602
2603        cancel_delayed_work_sync(&di->ac_charger_attached_work);
2604        mutex_lock(&di->charger_attached_mutex);
2605        mutex_unlock(&di->charger_attached_mutex);
2606
2607        return IRQ_HANDLED;
2608}
2609
2610/**
2611 * ab8500_charger_mainchplugdet_handler() - main charger plugged
2612 * @irq:       interrupt number
2613 * @_di:       pointer to the ab8500_charger structure
2614 *
2615 * Returns IRQ status(IRQ_HANDLED)
2616 */
2617static irqreturn_t ab8500_charger_mainchplugdet_handler(int irq, void *_di)
2618{
2619        struct ab8500_charger *di = _di;
2620
2621        dev_dbg(di->dev, "Main charger plugged\n");
2622        queue_work(di->charger_wq, &di->ac_work);
2623
2624        mutex_lock(&di->charger_attached_mutex);
2625        mutex_unlock(&di->charger_attached_mutex);
2626
2627        if (is_ab8500(di->parent))
2628                queue_delayed_work(di->charger_wq,
2629                           &di->ac_charger_attached_work,
2630                           HZ);
2631        return IRQ_HANDLED;
2632}
2633
2634/**
2635 * ab8500_charger_mainextchnotok_handler() - main charger not ok
2636 * @irq:       interrupt number
2637 * @_di:       pointer to the ab8500_charger structure
2638 *
2639 * Returns IRQ status(IRQ_HANDLED)
2640 */
2641static irqreturn_t ab8500_charger_mainextchnotok_handler(int irq, void *_di)
2642{
2643        struct ab8500_charger *di = _di;
2644
2645        dev_dbg(di->dev, "Main charger not ok\n");
2646        di->flags.mainextchnotok = true;
2647        ab8500_power_supply_changed(di, &di->ac_chg.psy);
2648
2649        /* Schedule a new HW failure check */
2650        queue_delayed_work(di->charger_wq, &di->check_hw_failure_work, 0);
2651
2652        return IRQ_HANDLED;
2653}
2654
2655/**
2656 * ab8500_charger_mainchthprotr_handler() - Die temp is above main charger
2657 * thermal protection threshold
2658 * @irq:       interrupt number
2659 * @_di:       pointer to the ab8500_charger structure
2660 *
2661 * Returns IRQ status(IRQ_HANDLED)
2662 */
2663static irqreturn_t ab8500_charger_mainchthprotr_handler(int irq, void *_di)
2664{
2665        struct ab8500_charger *di = _di;
2666
2667        dev_dbg(di->dev,
2668                "Die temp above Main charger thermal protection threshold\n");
2669        queue_work(di->charger_wq, &di->check_main_thermal_prot_work);
2670
2671        return IRQ_HANDLED;
2672}
2673
2674/**
2675 * ab8500_charger_mainchthprotf_handler() - Die temp is below main charger
2676 * thermal protection threshold
2677 * @irq:       interrupt number
2678 * @_di:       pointer to the ab8500_charger structure
2679 *
2680 * Returns IRQ status(IRQ_HANDLED)
2681 */
2682static irqreturn_t ab8500_charger_mainchthprotf_handler(int irq, void *_di)
2683{
2684        struct ab8500_charger *di = _di;
2685
2686        dev_dbg(di->dev,
2687                "Die temp ok for Main charger thermal protection threshold\n");
2688        queue_work(di->charger_wq, &di->check_main_thermal_prot_work);
2689
2690        return IRQ_HANDLED;
2691}
2692
2693static void ab8500_charger_vbus_drop_end_work(struct work_struct *work)
2694{
2695        struct ab8500_charger *di = container_of(work,
2696                struct ab8500_charger, vbus_drop_end_work.work);
2697        int ret, curr;
2698        u8 reg_value;
2699
2700        di->flags.vbus_drop_end = false;
2701
2702        /* Reset the drop counter */
2703        abx500_set_register_interruptible(di->dev,
2704                                  AB8500_CHARGER, AB8500_CHARGER_CTRL, 0x01);
2705
2706        if (is_ab8540(di->parent))
2707                ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
2708                                AB8540_CH_USBCH_STAT3_REG, &reg_value);
2709        else
2710                ret = abx500_get_register_interruptible(di->dev, AB8500_CHARGER,
2711                                AB8500_CH_USBCH_STAT2_REG, &reg_value);
2712        if (ret < 0) {
2713                dev_err(di->dev, "%s read failed\n", __func__);
2714                return;
2715        }
2716
2717        if (is_ab8540(di->parent))
2718                curr = di->bm->chg_input_curr[
2719                        reg_value & AB8540_AUTO_VBUS_IN_CURR_MASK];
2720        else
2721                curr = di->bm->chg_input_curr[
2722                        reg_value >> AUTO_VBUS_IN_CURR_LIM_SHIFT];
2723
2724        if (di->max_usb_in_curr.calculated_max != curr) {
2725                /* USB source is collapsing */
2726                di->max_usb_in_curr.calculated_max = curr;
2727                dev_dbg(di->dev,
2728                         "VBUS input current limiting to %d mA\n",
2729                         di->max_usb_in_curr.calculated_max);
2730        } else {
2731                /*
2732                 * USB source can not give more than this amount.
2733                 * Taking more will collapse the source.
2734                 */
2735                di->max_usb_in_curr.set_max =
2736                        di->max_usb_in_curr.calculated_max;
2737                dev_dbg(di->dev,
2738                         "VBUS input current limited to %d mA\n",
2739                         di->max_usb_in_curr.set_max);
2740        }
2741
2742        if (di->usb.charger_connected)
2743                ab8500_charger_set_vbus_in_curr(di,
2744                                        di->max_usb_in_curr.usb_type_max);
2745}
2746
2747/**
2748 * ab8500_charger_vbusdetf_handler() - VBUS falling detected
2749 * @irq:       interrupt number
2750 * @_di:       pointer to the ab8500_charger structure
2751 *
2752 * Returns IRQ status(IRQ_HANDLED)
2753 */
2754static irqreturn_t ab8500_charger_vbusdetf_handler(int irq, void *_di)
2755{
2756        struct ab8500_charger *di = _di;
2757
2758        di->vbus_detected = false;
2759        dev_dbg(di->dev, "VBUS falling detected\n");
2760        queue_work(di->charger_wq, &di->detect_usb_type_work);
2761
2762        return IRQ_HANDLED;
2763}
2764
2765/**
2766 * ab8500_charger_vbusdetr_handler() - VBUS rising detected
2767 * @irq:       interrupt number
2768 * @_di:       pointer to the ab8500_charger structure
2769 *
2770 * Returns IRQ status(IRQ_HANDLED)
2771 */
2772static irqreturn_t ab8500_charger_vbusdetr_handler(int irq, void *_di)
2773{
2774        struct ab8500_charger *di = _di;
2775
2776        di->vbus_detected = true;
2777        dev_dbg(di->dev, "VBUS rising detected\n");
2778
2779        queue_work(di->charger_wq, &di->detect_usb_type_work);
2780
2781        return IRQ_HANDLED;
2782}
2783
2784/**
2785 * ab8500_charger_usblinkstatus_handler() - USB link status has changed
2786 * @irq:       interrupt number
2787 * @_di:       pointer to the ab8500_charger structure
2788 *
2789 * Returns IRQ status(IRQ_HANDLED)
2790 */
2791static irqreturn_t ab8500_charger_usblinkstatus_handler(int irq, void *_di)
2792{
2793        struct ab8500_charger *di = _di;
2794
2795        dev_dbg(di->dev, "USB link status changed\n");
2796
2797        queue_work(di->charger_wq, &di->usb_link_status_work);
2798
2799        return IRQ_HANDLED;
2800}
2801
2802/**
2803 * ab8500_charger_usbchthprotr_handler() - Die temp is above usb charger
2804 * thermal protection threshold
2805 * @irq:       interrupt number
2806 * @_di:       pointer to the ab8500_charger structure
2807 *
2808 * Returns IRQ status(IRQ_HANDLED)
2809 */
2810static irqreturn_t ab8500_charger_usbchthprotr_handler(int irq, void *_di)
2811{
2812        struct ab8500_charger *di = _di;
2813
2814        dev_dbg(di->dev,
2815                "Die temp above USB charger thermal protection threshold\n");
2816        queue_work(di->charger_wq, &di->check_usb_thermal_prot_work);
2817
2818        return IRQ_HANDLED;
2819}
2820
2821/**
2822 * ab8500_charger_usbchthprotf_handler() - Die temp is below usb charger
2823 * thermal protection threshold
2824 * @irq:       interrupt number
2825 * @_di:       pointer to the ab8500_charger structure
2826 *
2827 * Returns IRQ status(IRQ_HANDLED)
2828 */
2829static irqreturn_t ab8500_charger_usbchthprotf_handler(int irq, void *_di)
2830{
2831        struct ab8500_charger *di = _di;
2832
2833        dev_dbg(di->dev,
2834                "Die temp ok for USB charger thermal protection threshold\n");
2835        queue_work(di->charger_wq, &di->check_usb_thermal_prot_work);
2836
2837        return IRQ_HANDLED;
2838}
2839
2840/**
2841 * ab8500_charger_usbchargernotokr_handler() - USB charger not ok detected
2842 * @irq:       interrupt number
2843 * @_di:       pointer to the ab8500_charger structure
2844 *
2845 * Returns IRQ status(IRQ_HANDLED)
2846 */
2847static irqreturn_t ab8500_charger_usbchargernotokr_handler(int irq, void *_di)
2848{
2849        struct ab8500_charger *di = _di;
2850
2851        dev_dbg(di->dev, "Not allowed USB charger detected\n");
2852        queue_delayed_work(di->charger_wq, &di->check_usbchgnotok_work, 0);
2853
2854        return IRQ_HANDLED;
2855}
2856
2857/**
2858 * ab8500_charger_chwdexp_handler() - Charger watchdog expired
2859 * @irq:       interrupt number
2860 * @_di:       pointer to the ab8500_charger structure
2861 *
2862 * Returns IRQ status(IRQ_HANDLED)
2863 */
2864static irqreturn_t ab8500_charger_chwdexp_handler(int irq, void *_di)
2865{
2866        struct ab8500_charger *di = _di;
2867
2868        dev_dbg(di->dev, "Charger watchdog expired\n");
2869
2870        /*
2871         * The charger that was online when the watchdog expired
2872         * needs to be restarted for charging to start again
2873         */
2874        if (di->ac.charger_online) {
2875                di->ac.wd_expired = true;
2876                ab8500_power_supply_changed(di, &di->ac_chg.psy);
2877        }
2878        if (di->usb.charger_online) {
2879                di->usb.wd_expired = true;
2880                ab8500_power_supply_changed(di, &di->usb_chg.psy);
2881        }
2882
2883        return IRQ_HANDLED;
2884}
2885
2886/**
2887 * ab8500_charger_vbuschdropend_handler() - VBUS drop removed
2888 * @irq:       interrupt number
2889 * @_di:       pointer to the ab8500_charger structure
2890 *
2891 * Returns IRQ status(IRQ_HANDLED)
2892 */
2893static irqreturn_t ab8500_charger_vbuschdropend_handler(int irq, void *_di)
2894{
2895        struct ab8500_charger *di = _di;
2896
2897        dev_dbg(di->dev, "VBUS charger drop ended\n");
2898        di->flags.vbus_drop_end = true;
2899
2900        /*
2901         * VBUS might have dropped due to bad connection.
2902         * Schedule a new input limit set to the value SW requests.
2903         */
2904        queue_delayed_work(di->charger_wq, &di->vbus_drop_end_work,
2905                           round_jiffies(VBUS_IN_CURR_LIM_RETRY_SET_TIME * HZ));
2906
2907        return IRQ_HANDLED;
2908}
2909
2910/**
2911 * ab8500_charger_vbusovv_handler() - VBUS overvoltage detected
2912 * @irq:       interrupt number
2913 * @_di:       pointer to the ab8500_charger structure
2914 *
2915 * Returns IRQ status(IRQ_HANDLED)
2916 */
2917static irqreturn_t ab8500_charger_vbusovv_handler(int irq, void *_di)
2918{
2919        struct ab8500_charger *di = _di;
2920
2921        dev_dbg(di->dev, "VBUS overvoltage detected\n");
2922        di->flags.vbus_ovv = true;
2923        ab8500_power_supply_changed(di, &di->usb_chg.psy);
2924
2925        /* Schedule a new HW failure check */
2926        queue_delayed_work(di->charger_wq, &di->check_hw_failure_work, 0);
2927
2928        return IRQ_HANDLED;
2929}
2930
2931/**
2932 * ab8500_charger_ac_get_property() - get the ac/mains properties
2933 * @psy:       pointer to the power_supply structure
2934 * @psp:       pointer to the power_supply_property structure
2935 * @val:       pointer to the power_supply_propval union
2936 *
2937 * This function gets called when an application tries to get the ac/mains
2938 * properties by reading the sysfs files.
2939 * AC/Mains properties are online, present and voltage.
2940 * online:     ac/mains charging is in progress or not
2941 * present:    presence of the ac/mains
2942 * voltage:    AC/Mains voltage
2943 * Returns error code in case of failure else 0(on success)
2944 */
2945static int ab8500_charger_ac_get_property(struct power_supply *psy,
2946        enum power_supply_property psp,
2947        union power_supply_propval *val)
2948{
2949        struct ab8500_charger *di;
2950        int ret;
2951
2952        di = to_ab8500_charger_ac_device_info(psy_to_ux500_charger(psy));
2953
2954        switch (psp) {
2955        case POWER_SUPPLY_PROP_HEALTH:
2956                if (di->flags.mainextchnotok)
2957                        val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
2958                else if (di->ac.wd_expired || di->usb.wd_expired)
2959                        val->intval = POWER_SUPPLY_HEALTH_DEAD;
2960                else if (di->flags.main_thermal_prot)
2961                        val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
2962                else
2963                        val->intval = POWER_SUPPLY_HEALTH_GOOD;
2964                break;
2965        case POWER_SUPPLY_PROP_ONLINE:
2966                val->intval = di->ac.charger_online;
2967                break;
2968        case POWER_SUPPLY_PROP_PRESENT:
2969                val->intval = di->ac.charger_connected;
2970                break;
2971        case POWER_SUPPLY_PROP_VOLTAGE_NOW:
2972                ret = ab8500_charger_get_ac_voltage(di);
2973                if (ret >= 0)
2974                        di->ac.charger_voltage = ret;
2975                /* On error, use previous value */
2976                val->intval = di->ac.charger_voltage * 1000;
2977                break;
2978        case POWER_SUPPLY_PROP_VOLTAGE_AVG:
2979                /*
2980                 * This property is used to indicate when CV mode is entered
2981                 * for the AC charger
2982                 */
2983                di->ac.cv_active = ab8500_charger_ac_cv(di);
2984                val->intval = di->ac.cv_active;
2985                break;
2986        case POWER_SUPPLY_PROP_CURRENT_NOW:
2987                ret = ab8500_charger_get_ac_current(di);
2988                if (ret >= 0)
2989                        di->ac.charger_current = ret;
2990                val->intval = di->ac.charger_current * 1000;
2991                break;
2992        default:
2993                return -EINVAL;
2994        }
2995        return 0;
2996}
2997
2998/**
2999 * ab8500_charger_usb_get_property() - get the usb properties
3000 * @psy:        pointer to the power_supply structure
3001 * @psp:        pointer to the power_supply_property structure
3002 * @val:        pointer to the power_supply_propval union
3003 *
3004 * This function gets called when an application tries to get the usb
3005 * properties by reading the sysfs files.
3006 * USB properties are online, present and voltage.
3007 * online:     usb charging is in progress or not
3008 * present:    presence of the usb
3009 * voltage:    vbus voltage
3010 * Returns error code in case of failure else 0(on success)
3011 */
3012static int ab8500_charger_usb_get_property(struct power_supply *psy,
3013        enum power_supply_property psp,
3014        union power_supply_propval *val)
3015{
3016        struct ab8500_charger *di;
3017        int ret;
3018
3019        di = to_ab8500_charger_usb_device_info(psy_to_ux500_charger(psy));
3020
3021        switch (psp) {
3022        case POWER_SUPPLY_PROP_HEALTH:
3023                if (di->flags.usbchargernotok)
3024                        val->intval = POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
3025                else if (di->ac.wd_expired || di->usb.wd_expired)
3026                        val->intval = POWER_SUPPLY_HEALTH_DEAD;
3027                else if (di->flags.usb_thermal_prot)
3028                        val->intval = POWER_SUPPLY_HEALTH_OVERHEAT;
3029                else if (di->flags.vbus_ovv)
3030                        val->intval = POWER_SUPPLY_HEALTH_OVERVOLTAGE;
3031                else
3032                        val->intval = POWER_SUPPLY_HEALTH_GOOD;
3033                break;
3034        case POWER_SUPPLY_PROP_ONLINE:
3035                val->intval = di->usb.charger_online;
3036                break;
3037        case POWER_SUPPLY_PROP_PRESENT:
3038                val->intval = di->usb.charger_connected;
3039                break;
3040        case POWER_SUPPLY_PROP_VOLTAGE_NOW:
3041                ret = ab8500_charger_get_vbus_voltage(di);
3042                if (ret >= 0)
3043                        di->usb.charger_voltage = ret;
3044                val->intval = di->usb.charger_voltage * 1000;
3045                break;
3046        case POWER_SUPPLY_PROP_VOLTAGE_AVG:
3047                /*
3048                 * This property is used to indicate when CV mode is entered
3049                 * for the USB charger
3050                 */
3051                di->usb.cv_active = ab8500_charger_usb_cv(di);
3052                val->intval = di->usb.cv_active;
3053                break;
3054        case POWER_SUPPLY_PROP_CURRENT_NOW:
3055                ret = ab8500_charger_get_usb_current(di);
3056                if (ret >= 0)
3057                        di->usb.charger_current = ret;
3058                val->intval = di->usb.charger_current * 1000;
3059                break;
3060        case POWER_SUPPLY_PROP_CURRENT_AVG:
3061                /*
3062                 * This property is used to indicate when VBUS has collapsed
3063                 * due to too high output current from the USB charger
3064                 */
3065                if (di->flags.vbus_collapse)
3066                        val->intval = 1;
3067                else
3068                        val->intval = 0;
3069                break;
3070        default:
3071                return -EINVAL;
3072        }
3073        return 0;
3074}
3075
3076/**
3077 * ab8500_charger_init_hw_registers() - Set up charger related registers
3078 * @di:         pointer to the ab8500_charger structure
3079 *
3080 * Set up charger OVV, watchdog and maximum voltage registers as well as
3081 * charging of the backup battery
3082 */
3083static int ab8500_charger_init_hw_registers(struct ab8500_charger *di)
3084{
3085        int ret = 0;
3086        u8 bup_vch_range = 0, vbup33_vrtcn = 0;
3087
3088        /* Setup maximum charger current and voltage for ABB cut2.0 */
3089        if (!is_ab8500_1p1_or_earlier(di->parent)) {
3090                ret = abx500_set_register_interruptible(di->dev,
3091                        AB8500_CHARGER,
3092                        AB8500_CH_VOLT_LVL_MAX_REG, CH_VOL_LVL_4P6);
3093                if (ret) {
3094                        dev_err(di->dev,
3095                                "failed to set CH_VOLT_LVL_MAX_REG\n");
3096                        goto out;
3097                }
3098
3099                if (is_ab8540(di->parent))
3100                        ret = abx500_set_register_interruptible(di->dev,
3101                                AB8500_CHARGER, AB8500_CH_OPT_CRNTLVL_MAX_REG,
3102                                CH_OP_CUR_LVL_2P);
3103                else
3104                        ret = abx500_set_register_interruptible(di->dev,
3105                                AB8500_CHARGER, AB8500_CH_OPT_CRNTLVL_MAX_REG,
3106                                CH_OP_CUR_LVL_1P6);
3107                if (ret) {
3108                        dev_err(di->dev,
3109                                "failed to set CH_OPT_CRNTLVL_MAX_REG\n");
3110                        goto out;
3111                }
3112        }
3113
3114        if (is_ab9540_2p0(di->parent) || is_ab9540_3p0(di->parent)
3115         || is_ab8505_2p0(di->parent) || is_ab8540(di->parent))
3116                ret = abx500_mask_and_set_register_interruptible(di->dev,
3117                        AB8500_CHARGER,
3118                        AB8500_USBCH_CTRL2_REG,
3119                        VBUS_AUTO_IN_CURR_LIM_ENA,
3120                        VBUS_AUTO_IN_CURR_LIM_ENA);
3121        else
3122                /*
3123                 * VBUS OVV set to 6.3V and enable automatic current limitation
3124                 */
3125                ret = abx500_set_register_interruptible(di->dev,
3126                        AB8500_CHARGER,
3127                        AB8500_USBCH_CTRL2_REG,
3128                        VBUS_OVV_SELECT_6P3V | VBUS_AUTO_IN_CURR_LIM_ENA);
3129        if (ret) {
3130                dev_err(di->dev,
3131                        "failed to set automatic current limitation\n");
3132                goto out;
3133        }
3134
3135        /* Enable main watchdog in OTP */
3136        ret = abx500_set_register_interruptible(di->dev,
3137                AB8500_OTP_EMUL, AB8500_OTP_CONF_15, OTP_ENABLE_WD);
3138        if (ret) {
3139                dev_err(di->dev, "failed to enable main WD in OTP\n");
3140                goto out;
3141        }
3142
3143        /* Enable main watchdog */
3144        ret = abx500_set_register_interruptible(di->dev,
3145                AB8500_SYS_CTRL2_BLOCK,
3146                AB8500_MAIN_WDOG_CTRL_REG, MAIN_WDOG_ENA);
3147        if (ret) {
3148                dev_err(di->dev, "faile to enable main watchdog\n");
3149                goto out;
3150        }
3151
3152        /*
3153         * Due to internal synchronisation, Enable and Kick watchdog bits
3154         * cannot be enabled in a single write.
3155         * A minimum delay of 2*32 kHz period (62.5┬Ás) must be inserted
3156         * between writing Enable then Kick bits.
3157         */
3158        udelay(63);
3159
3160        /* Kick main watchdog */
3161        ret = abx500_set_register_interruptible(di->dev,
3162                AB8500_SYS_CTRL2_BLOCK,
3163                AB8500_MAIN_WDOG_CTRL_REG,
3164                (MAIN_WDOG_ENA | MAIN_WDOG_KICK));
3165        if (ret) {
3166                dev_err(di->dev, "failed to kick main watchdog\n");
3167                goto out;
3168        }
3169
3170        /* Disable main watchdog */
3171        ret = abx500_set_register_interruptible(di->dev,
3172                AB8500_SYS_CTRL2_BLOCK,
3173                AB8500_MAIN_WDOG_CTRL_REG, MAIN_WDOG_DIS);
3174        if (ret) {
3175                dev_err(di->dev, "failed to disable main watchdog\n");
3176                goto out;
3177        }
3178
3179        /* Set watchdog timeout */
3180        ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
3181                AB8500_CH_WD_TIMER_REG, WD_TIMER);
3182        if (ret) {
3183                dev_err(di->dev, "failed to set charger watchdog timeout\n");
3184                goto out;
3185        }
3186
3187        ret = ab8500_charger_led_en(di, false);
3188        if (ret < 0) {
3189                dev_err(di->dev, "failed to disable LED\n");
3190                goto out;
3191        }
3192
3193        /* Backup battery voltage and current */
3194        if (di->bm->bkup_bat_v > BUP_VCH_SEL_3P1V)
3195                bup_vch_range = BUP_VCH_RANGE;
3196        if (di->bm->bkup_bat_v == BUP_VCH_SEL_3P3V)
3197                vbup33_vrtcn = VBUP33_VRTCN;
3198
3199        ret = abx500_set_register_interruptible(di->dev,
3200                AB8500_RTC,
3201                AB8500_RTC_BACKUP_CHG_REG,
3202                (di->bm->bkup_bat_v & 0x3) | di->bm->bkup_bat_i);
3203        if (ret) {
3204                dev_err(di->dev, "failed to setup backup battery charging\n");
3205                goto out;
3206        }
3207        if (is_ab8540(di->parent)) {
3208                ret = abx500_set_register_interruptible(di->dev,
3209                        AB8500_RTC,
3210                        AB8500_RTC_CTRL1_REG,
3211                        bup_vch_range | vbup33_vrtcn);
3212                if (ret) {
3213                        dev_err(di->dev,
3214                                "failed to setup backup battery charging\n");
3215                        goto out;
3216                }
3217        }
3218
3219        /* Enable backup battery charging */
3220        abx500_mask_and_set_register_interruptible(di->dev,
3221                AB8500_RTC, AB8500_RTC_CTRL_REG,
3222                RTC_BUP_CH_ENA, RTC_BUP_CH_ENA);
3223        if (ret < 0)
3224                dev_err(di->dev, "%s mask and set failed\n", __func__);
3225
3226        if (is_ab8540(di->parent)) {
3227                ret = abx500_mask_and_set_register_interruptible(di->dev,
3228                        AB8500_CHARGER, AB8540_USB_PP_MODE_REG,
3229                        BUS_VSYS_VOL_SELECT_MASK, BUS_VSYS_VOL_SELECT_3P6V);
3230                if (ret) {
3231                        dev_err(di->dev,
3232                                "failed to setup usb power path vsys voltage\n");
3233                        goto out;
3234                }
3235                ret = abx500_mask_and_set_register_interruptible(di->dev,
3236                        AB8500_CHARGER, AB8540_USB_PP_CHR_REG,
3237                        BUS_PP_PRECHG_CURRENT_MASK, 0);
3238                if (ret) {
3239                        dev_err(di->dev,
3240                                "failed to setup usb power path prechage current\n");
3241                        goto out;
3242                }
3243        }
3244
3245out:
3246        return ret;
3247}
3248
3249/*
3250 * ab8500 charger driver interrupts and their respective isr
3251 */
3252static struct ab8500_charger_interrupts ab8500_charger_irq[] = {
3253        {"MAIN_CH_UNPLUG_DET", ab8500_charger_mainchunplugdet_handler},
3254        {"MAIN_CHARGE_PLUG_DET", ab8500_charger_mainchplugdet_handler},
3255        {"MAIN_EXT_CH_NOT_OK", ab8500_charger_mainextchnotok_handler},
3256        {"MAIN_CH_TH_PROT_R", ab8500_charger_mainchthprotr_handler},
3257        {"MAIN_CH_TH_PROT_F", ab8500_charger_mainchthprotf_handler},
3258        {"VBUS_DET_F", ab8500_charger_vbusdetf_handler},
3259        {"VBUS_DET_R", ab8500_charger_vbusdetr_handler},
3260        {"USB_LINK_STATUS", ab8500_charger_usblinkstatus_handler},
3261        {"USB_CH_TH_PROT_R", ab8500_charger_usbchthprotr_handler},
3262        {"USB_CH_TH_PROT_F", ab8500_charger_usbchthprotf_handler},
3263        {"USB_CHARGER_NOT_OKR", ab8500_charger_usbchargernotokr_handler},
3264        {"VBUS_OVV", ab8500_charger_vbusovv_handler},
3265        {"CH_WD_EXP", ab8500_charger_chwdexp_handler},
3266        {"VBUS_CH_DROP_END", ab8500_charger_vbuschdropend_handler},
3267};
3268
3269static int ab8500_charger_usb_notifier_call(struct notifier_block *nb,
3270                unsigned long event, void *power)
3271{
3272        struct ab8500_charger *di =
3273                container_of(nb, struct ab8500_charger, nb);
3274        enum ab8500_usb_state bm_usb_state;
3275        unsigned mA = *((unsigned *)power);
3276
3277        if (!di)
3278                return NOTIFY_DONE;
3279
3280        if (event != USB_EVENT_VBUS) {
3281                dev_dbg(di->dev, "not a standard host, returning\n");
3282                return NOTIFY_DONE;
3283        }
3284
3285        /* TODO: State is fabricate  here. See if charger really needs USB
3286         * state or if mA is enough
3287         */
3288        if ((di->usb_state.usb_current == 2) && (mA > 2))
3289                bm_usb_state = AB8500_BM_USB_STATE_RESUME;
3290        else if (mA == 0)
3291                bm_usb_state = AB8500_BM_USB_STATE_RESET_HS;
3292        else if (mA == 2)
3293                bm_usb_state = AB8500_BM_USB_STATE_SUSPEND;
3294        else if (mA >= 8) /* 8, 100, 500 */
3295                bm_usb_state = AB8500_BM_USB_STATE_CONFIGURED;
3296        else /* Should never occur */
3297                bm_usb_state = AB8500_BM_USB_STATE_RESET_FS;
3298
3299        dev_dbg(di->dev, "%s usb_state: 0x%02x mA: %d\n",
3300                __func__, bm_usb_state, mA);
3301
3302        spin_lock(&di->usb_state.usb_lock);
3303        di->usb_state.state_tmp = bm_usb_state;
3304        di->usb_state.usb_current_tmp = mA;
3305        spin_unlock(&di->usb_state.usb_lock);
3306
3307        /*
3308         * wait for some time until you get updates from the usb stack
3309         * and negotiations are completed
3310         */
3311        queue_delayed_work(di->charger_wq, &di->usb_state_changed_work, HZ/2);
3312
3313        return NOTIFY_OK;
3314}
3315
3316#if defined(CONFIG_PM)
3317static int ab8500_charger_resume(struct platform_device *pdev)
3318{
3319        int ret;
3320        struct ab8500_charger *di = platform_get_drvdata(pdev);
3321
3322        /*
3323         * For ABB revision 1.0 and 1.1 there is a bug in the watchdog
3324         * logic. That means we have to continously kick the charger
3325         * watchdog even when no charger is connected. This is only
3326         * valid once the AC charger has been enabled. This is
3327         * a bug that is not handled by the algorithm and the
3328         * watchdog have to be kicked by the charger driver
3329         * when the AC charger is disabled
3330         */
3331        if (di->ac_conn && is_ab8500_1p1_or_earlier(di->parent)) {
3332                ret = abx500_set_register_interruptible(di->dev, AB8500_CHARGER,
3333                        AB8500_CHARG_WD_CTRL, CHARG_WD_KICK);
3334                if (ret)
3335                        dev_err(di->dev, "Failed to kick WD!\n");
3336
3337                /* If not already pending start a new timer */
3338                queue_delayed_work(di->charger_wq, &di->kick_wd_work,
3339                                   round_jiffies(WD_KICK_INTERVAL));
3340        }
3341
3342        /* If we still have a HW failure, schedule a new check */
3343        if (di->flags.mainextchnotok || di->flags.vbus_ovv) {
3344                queue_delayed_work(di->charger_wq,
3345                        &di->check_hw_failure_work, 0);
3346        }
3347
3348        if (di->flags.vbus_drop_end)
3349                queue_delayed_work(di->charger_wq, &di->vbus_drop_end_work, 0);
3350
3351        return 0;
3352}
3353
3354static int ab8500_charger_suspend(struct platform_device *pdev,
3355        pm_message_t state)
3356{
3357        struct ab8500_charger *di = platform_get_drvdata(pdev);
3358
3359        /* Cancel any pending jobs */
3360        cancel_delayed_work(&di->check_hw_failure_work);
3361        cancel_delayed_work(&di->vbus_drop_end_work);
3362
3363        flush_delayed_work(&di->attach_work);
3364        flush_delayed_work(&di->usb_charger_attached_work);
3365        flush_delayed_work(&di->ac_charger_attached_work);
3366        flush_delayed_work(&di->check_usbchgnotok_work);
3367        flush_delayed_work(&di->check_vbat_work);
3368        flush_delayed_work(&di->kick_wd_work);
3369
3370        flush_work(&di->usb_link_status_work);
3371        flush_work(&di->ac_work);
3372        flush_work(&di->detect_usb_type_work);
3373
3374        if (atomic_read(&di->current_stepping_sessions))
3375                return -EAGAIN;
3376
3377        return 0;
3378}
3379#else
3380#define ab8500_charger_suspend      NULL
3381#define ab8500_charger_resume       NULL
3382#endif
3383
3384static struct notifier_block charger_nb = {
3385        .notifier_call = ab8500_external_charger_prepare,
3386};
3387
3388static int ab8500_charger_remove(struct platform_device *pdev)
3389{
3390        struct ab8500_charger *di = platform_get_drvdata(pdev);
3391        int i, irq, ret;
3392
3393        /* Disable AC charging */
3394        ab8500_charger_ac_en(&di->ac_chg, false, 0, 0);
3395
3396        /* Disable USB charging */
3397        ab8500_charger_usb_en(&di->usb_chg, false, 0, 0);
3398
3399        /* Disable interrupts */
3400        for (i = 0; i < ARRAY_SIZE(ab8500_charger_irq); i++) {
3401                irq = platform_get_irq_byname(pdev, ab8500_charger_irq[i].name);
3402                free_irq(irq, di);
3403        }
3404
3405        /* Backup battery voltage and current disable */
3406        ret = abx500_mask_and_set_register_interruptible(di->dev,
3407                AB8500_RTC, AB8500_RTC_CTRL_REG, RTC_BUP_CH_ENA, 0);
3408        if (ret < 0)
3409                dev_err(di->dev, "%s mask and set failed\n", __func__);
3410
3411        usb_unregister_notifier(di->usb_phy, &di->nb);
3412        usb_put_phy(di->usb_phy);
3413
3414        /* Delete the work queue */
3415        destroy_workqueue(di->charger_wq);
3416
3417        /* Unregister external charger enable notifier */
3418        if (!di->ac_chg.enabled)
3419                blocking_notifier_chain_unregister(
3420                        &charger_notifier_list, &charger_nb);
3421
3422        flush_scheduled_work();
3423        if (di->usb_chg.enabled)
3424                power_supply_unregister(&di->usb_chg.psy);
3425
3426        if (di->ac_chg.enabled && !di->ac_chg.external)
3427                power_supply_unregister(&di->ac_chg.psy);
3428
3429        return 0;
3430}
3431
3432static char *supply_interface[] = {
3433        "ab8500_chargalg",
3434        "ab8500_fg",
3435        "ab8500_btemp",
3436};
3437
3438static int ab8500_charger_probe(struct platform_device *pdev)
3439{
3440        struct device_node *np = pdev->dev.of_node;
3441        struct abx500_bm_data *plat = pdev->dev.platform_data;
3442        struct ab8500_charger *di;
3443        int irq, i, charger_status, ret = 0, ch_stat;
3444
3445        di = devm_kzalloc(&pdev->dev, sizeof(*di), GFP_KERNEL);
3446        if (!di) {
3447                dev_err(&pdev->dev, "%s no mem for ab8500_charger\n", __func__);
3448                return -ENOMEM;
3449        }
3450
3451        if (!plat) {
3452                dev_err(&pdev->dev, "no battery management data supplied\n");
3453                return -EINVAL;
3454        }
3455        di->bm = plat;
3456
3457        if (np) {
3458                ret = ab8500_bm_of_probe(&pdev->dev, np, di->bm);
3459                if (ret) {
3460                        dev_err(&pdev->dev, "failed to get battery information\n");
3461                        return ret;
3462                }
3463                di->autopower_cfg = of_property_read_bool(np, "autopower_cfg");
3464        } else
3465                di->autopower_cfg = false;
3466
3467        /* get parent data */
3468        di->dev = &pdev->dev;
3469        di->parent = dev_get_drvdata(pdev->dev.parent);
3470        di->gpadc = ab8500_gpadc_get("ab8500-gpadc.0");
3471
3472        /* initialize lock */
3473        spin_lock_init(&di->usb_state.usb_lock);
3474        mutex_init(&di->usb_ipt_crnt_lock);
3475
3476        di->autopower = false;
3477        di->invalid_charger_detect_state = 0;
3478
3479        /* AC supply */
3480        /* power_supply base class */
3481        di->ac_chg.psy.name = "ab8500_ac";
3482        di->ac_chg.psy.type = POWER_SUPPLY_TYPE_MAINS;
3483        di->ac_chg.psy.properties = ab8500_charger_ac_props;
3484        di->ac_chg.psy.num_properties = ARRAY_SIZE(ab8500_charger_ac_props);
3485        di->ac_chg.psy.get_property = ab8500_charger_ac_get_property;
3486        di->ac_chg.psy.supplied_to = supply_interface;
3487        di->ac_chg.psy.num_supplicants = ARRAY_SIZE(supply_interface),
3488        /* ux500_charger sub-class */
3489        di->ac_chg.ops.enable = &ab8500_charger_ac_en;
3490        di->ac_chg.ops.check_enable = &ab8500_charger_ac_check_enable;
3491        di->ac_chg.ops.kick_wd = &ab8500_charger_watchdog_kick;
3492        di->ac_chg.ops.update_curr = &ab8500_charger_update_charger_current;
3493        di->ac_chg.max_out_volt = ab8500_charger_voltage_map[
3494                ARRAY_SIZE(ab8500_charger_voltage_map) - 1];
3495        di->ac_chg.max_out_curr =
3496                di->bm->chg_output_curr[di->bm->n_chg_out_curr - 1];
3497        di->ac_chg.wdt_refresh = CHG_WD_INTERVAL;
3498        di->ac_chg.enabled = di->bm->ac_enabled;
3499        di->ac_chg.external = false;
3500
3501        /*notifier for external charger enabling*/
3502        if (!di->ac_chg.enabled)
3503                blocking_notifier_chain_register(
3504                        &charger_notifier_list, &charger_nb);
3505
3506        /* USB supply */
3507        /* power_supply base class */
3508        di->usb_chg.psy.name = "ab8500_usb";
3509        di->usb_chg.psy.type = POWER_SUPPLY_TYPE_USB;
3510        di->usb_chg.psy.properties = ab8500_charger_usb_props;
3511        di->usb_chg.psy.num_properties = ARRAY_SIZE(ab8500_charger_usb_props);
3512        di->usb_chg.psy.get_property = ab8500_charger_usb_get_property;
3513        di->usb_chg.psy.supplied_to = supply_interface;
3514        di->usb_chg.psy.num_supplicants = ARRAY_SIZE(supply_interface),
3515        /* ux500_charger sub-class */
3516        di->usb_chg.ops.enable = &ab8500_charger_usb_en;
3517        di->usb_chg.ops.check_enable = &ab8500_charger_usb_check_enable;
3518        di->usb_chg.ops.kick_wd = &ab8500_charger_watchdog_kick;
3519        di->usb_chg.ops.update_curr = &ab8500_charger_update_charger_current;
3520        di->usb_chg.ops.pp_enable = &ab8540_charger_power_path_enable;
3521        di->usb_chg.ops.pre_chg_enable = &ab8540_charger_usb_pre_chg_enable;
3522        di->usb_chg.max_out_volt = ab8500_charger_voltage_map[
3523                ARRAY_SIZE(ab8500_charger_voltage_map) - 1];
3524        di->usb_chg.max_out_curr =
3525                di->bm->chg_output_curr[di->bm->n_chg_out_curr - 1];
3526        di->usb_chg.wdt_refresh = CHG_WD_INTERVAL;
3527        di->usb_chg.enabled = di->bm->usb_enabled;
3528        di->usb_chg.external = false;
3529        di->usb_chg.power_path = di->bm->usb_power_path;
3530        di->usb_state.usb_current = -1;
3531
3532        /* Create a work queue for the charger */
3533        di->charger_wq =
3534                create_singlethread_workqueue("ab8500_charger_wq");
3535        if (di->charger_wq == NULL) {
3536                dev_err(di->dev, "failed to create work queue\n");
3537                return -ENOMEM;
3538        }
3539
3540        mutex_init(&di->charger_attached_mutex);
3541
3542        /* Init work for HW failure check */
3543        INIT_DEFERRABLE_WORK(&di->check_hw_failure_work,
3544                ab8500_charger_check_hw_failure_work);
3545        INIT_DEFERRABLE_WORK(&di->check_usbchgnotok_work,
3546                ab8500_charger_check_usbchargernotok_work);
3547
3548        INIT_DELAYED_WORK(&di->ac_charger_attached_work,
3549                          ab8500_charger_ac_attached_work);
3550        INIT_DELAYED_WORK(&di->usb_charger_attached_work,
3551                          ab8500_charger_usb_attached_work);
3552
3553        /*
3554         * For ABB revision 1.0 and 1.1 there is a bug in the watchdog
3555         * logic. That means we have to continously kick the charger
3556         * watchdog even when no charger is connected. This is only
3557         * valid once the AC charger has been enabled. This is
3558         * a bug that is not handled by the algorithm and the
3559         * watchdog have to be kicked by the charger driver
3560         * when the AC charger is disabled
3561         */
3562        INIT_DEFERRABLE_WORK(&di->kick_wd_work,
3563                ab8500_charger_kick_watchdog_work);
3564
3565        INIT_DEFERRABLE_WORK(&di->check_vbat_work,
3566                ab8500_charger_check_vbat_work);
3567
3568        INIT_DELAYED_WORK(&di->attach_work,
3569                ab8500_charger_usb_link_attach_work);
3570
3571        INIT_DELAYED_WORK(&di->usb_state_changed_work,
3572                ab8500_charger_usb_state_changed_work);
3573
3574        INIT_DELAYED_WORK(&di->vbus_drop_end_work,
3575                ab8500_charger_vbus_drop_end_work);
3576
3577        /* Init work for charger detection */
3578        INIT_WORK(&di->usb_link_status_work,
3579                ab8500_charger_usb_link_status_work);
3580        INIT_WORK(&di->ac_work, ab8500_charger_ac_work);
3581        INIT_WORK(&di->detect_usb_type_work,
3582                ab8500_charger_detect_usb_type_work);
3583
3584        /* Init work for checking HW status */
3585        INIT_WORK(&di->check_main_thermal_prot_work,
3586                ab8500_charger_check_main_thermal_prot_work);
3587        INIT_WORK(&di->check_usb_thermal_prot_work,
3588                ab8500_charger_check_usb_thermal_prot_work);
3589
3590        /*
3591         * VDD ADC supply needs to be enabled from this driver when there
3592         * is a charger connected to avoid erroneous BTEMP_HIGH/LOW
3593         * interrupts during charging
3594         */
3595        di->regu = devm_regulator_get(di->dev, "vddadc");
3596        if (IS_ERR(di->regu)) {
3597                ret = PTR_ERR(di->regu);
3598                dev_err(di->dev, "failed to get vddadc regulator\n");
3599                goto free_charger_wq;
3600        }
3601
3602
3603        /* Initialize OVV, and other registers */
3604        ret = ab8500_charger_init_hw_registers(di);
3605        if (ret) {
3606                dev_err(di->dev, "failed to initialize ABB registers\n");
3607                goto free_charger_wq;
3608        }
3609
3610        /* Register AC charger class */
3611        if (di->ac_chg.enabled) {
3612                ret = power_supply_register(di->dev, &di->ac_chg.psy);
3613                if (ret) {
3614                        dev_err(di->dev, "failed to register AC charger\n");
3615                        goto free_charger_wq;
3616                }
3617        }
3618
3619        /* Register USB charger class */
3620        if (di->usb_chg.enabled) {
3621                ret = power_supply_register(di->dev, &di->usb_chg.psy);
3622                if (ret) {
3623                        dev_err(di->dev, "failed to register USB charger\n");
3624                        goto free_ac;
3625                }
3626        }
3627
3628        di->usb_phy = usb_get_phy(USB_PHY_TYPE_USB2);
3629        if (IS_ERR_OR_NULL(di->usb_phy)) {
3630                dev_err(di->dev, "failed to get usb transceiver\n");
3631                ret = -EINVAL;
3632                goto free_usb;
3633        }
3634        di->nb.notifier_call = ab8500_charger_usb_notifier_call;
3635        ret = usb_register_notifier(di->usb_phy, &di->nb);
3636        if (ret) {
3637                dev_err(di->dev, "failed to register usb notifier\n");
3638                goto put_usb_phy;
3639        }
3640
3641        /* Identify the connected charger types during startup */
3642        charger_status = ab8500_charger_detect_chargers(di, true);
3643        if (charger_status & AC_PW_CONN) {
3644                di->ac.charger_connected = 1;
3645                di->ac_conn = true;
3646                ab8500_power_supply_changed(di, &di->ac_chg.psy);
3647                sysfs_notify(&di->ac_chg.psy.dev->kobj, NULL, "present");
3648        }
3649
3650        if (charger_status & USB_PW_CONN) {
3651                di->vbus_detected = true;
3652                di->vbus_detected_start = true;
3653                queue_work(di->charger_wq,
3654                        &di->detect_usb_type_work);
3655        }
3656
3657        /* Register interrupts */
3658        for (i = 0; i < ARRAY_SIZE(ab8500_charger_irq); i++) {
3659                irq = platform_get_irq_byname(pdev, ab8500_charger_irq[i].name);
3660                ret = request_threaded_irq(irq, NULL, ab8500_charger_irq[i].isr,
3661                        IRQF_SHARED | IRQF_NO_SUSPEND,
3662                        ab8500_charger_irq[i].name, di);
3663
3664                if (ret != 0) {
3665                        dev_err(di->dev, "failed to request %s IRQ %d: %d\n"
3666                                , ab8500_charger_irq[i].name, irq, ret);
3667                        goto free_irq;
3668                }
3669                dev_dbg(di->dev, "Requested %s IRQ %d: %d\n",
3670                        ab8500_charger_irq[i].name, irq, ret);
3671        }
3672
3673        platform_set_drvdata(pdev, di);
3674
3675        mutex_lock(&di->charger_attached_mutex);
3676
3677        ch_stat = ab8500_charger_detect_chargers(di, false);
3678
3679        if ((ch_stat & AC_PW_CONN) == AC_PW_CONN) {
3680                if (is_ab8500(di->parent))
3681                        queue_delayed_work(di->charger_wq,
3682                                           &di->ac_charger_attached_work,
3683                                           HZ);
3684        }
3685        if ((ch_stat & USB_PW_CONN) == USB_PW_CONN) {
3686                if (is_ab8500(di->parent))
3687                        queue_delayed_work(di->charger_wq,
3688                                           &di->usb_charger_attached_work,
3689                                           HZ);
3690        }
3691
3692        mutex_unlock(&di->charger_attached_mutex);
3693
3694        return ret;
3695
3696free_irq:
3697        usb_unregister_notifier(di->usb_phy, &di->nb);
3698
3699        /* We also have to free all successfully registered irqs */
3700        for (i = i - 1; i >= 0; i--) {
3701                irq = platform_get_irq_byname(pdev, ab8500_charger_irq[i].name);
3702                free_irq(irq, di);
3703        }
3704put_usb_phy:
3705        usb_put_phy(di->usb_phy);
3706free_usb:
3707        if (di->usb_chg.enabled)
3708                power_supply_unregister(&di->usb_chg.psy);
3709free_ac:
3710        if (di->ac_chg.enabled)
3711                power_supply_unregister(&di->ac_chg.psy);
3712free_charger_wq:
3713        destroy_workqueue(di->charger_wq);
3714        return ret;
3715}
3716
3717static const struct of_device_id ab8500_charger_match[] = {
3718        { .compatible = "stericsson,ab8500-charger", },
3719        { },
3720};
3721
3722static struct platform_driver ab8500_charger_driver = {
3723        .probe = ab8500_charger_probe,
3724        .remove = ab8500_charger_remove,
3725        .suspend = ab8500_charger_suspend,
3726        .resume = ab8500_charger_resume,
3727        .driver = {
3728                .name = "ab8500-charger",
3729                .owner = THIS_MODULE,
3730                .of_match_table = ab8500_charger_match,
3731        },
3732};
3733
3734static int __init ab8500_charger_init(void)
3735{
3736        return platform_driver_register(&ab8500_charger_driver);
3737}
3738
3739static void __exit ab8500_charger_exit(void)
3740{
3741        platform_driver_unregister(&ab8500_charger_driver);
3742}
3743
3744subsys_initcall_sync(ab8500_charger_init);
3745module_exit(ab8500_charger_exit);
3746
3747MODULE_LICENSE("GPL v2");
3748MODULE_AUTHOR("Johan Palsson, Karl Komierowski, Arun R Murthy");
3749MODULE_ALIAS("platform:ab8500-charger");
3750MODULE_DESCRIPTION("AB8500 charger management driver");
3751
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.