root/drivers/mfd/tps65010.c
// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * tps65010 - driver for tps6501x power management chips
 *
 * Copyright (C) 2004 Texas Instruments
 * Copyright (C) 2004-2005 David Brownell
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/interrupt.h>
#include <linux/i2c.h>
#include <linux/delay.h>
#include <linux/workqueue.h>
#include <linux/debugfs.h>
#include <linux/seq_file.h>
#include <linux/string_choices.h>
#include <linux/mutex.h>
#include <linux/platform_device.h>

#include <linux/mfd/tps65010.h>

#include <linux/gpio/driver.h>


/*-------------------------------------------------------------------------*/

#define DRIVER_VERSION  "2 May 2005"
#define DRIVER_NAME     (tps65010_driver.driver.name)

MODULE_DESCRIPTION("TPS6501x Power Management Driver");
MODULE_LICENSE("GPL");

static struct i2c_driver tps65010_driver;

/*-------------------------------------------------------------------------*/

/* This driver handles a family of multipurpose chips, which incorporate
 * voltage regulators, lithium ion/polymer battery charging, GPIOs, LEDs,
 * and other features often needed in portable devices like cell phones
 * or digital cameras.
 *
 * The tps65011 and tps65013 have different voltage settings compared
 * to tps65010 and tps65012.  The tps65013 has a NO_CHG status/irq.
 * All except tps65010 have "wait" mode, possibly defaulted so that
 * battery-insert != device-on.
 *
 * We could distinguish between some models by checking VDCDC1.UVLO or
 * other registers, unless they've been changed already after powerup
 * as part of board setup by a bootloader.
 */
enum tps_model {
        TPS65010,
        TPS65011,
        TPS65012,
        TPS65013,
};

struct tps65010 {
        struct i2c_client       *client;
        struct mutex            lock;
        struct delayed_work     work;
        struct dentry           *file;
        unsigned                charging:1;
        unsigned                por:1;
        unsigned                model:8;
        u16                     vbus;
        unsigned long           flags;
#define FLAG_VBUS_CHANGED       0
#define FLAG_IRQ_ENABLE         1

        /* copies of last register state */
        u8                      chgstatus, regstatus, chgconf;
        u8                      nmask1, nmask2;

        u8                      outmask;
        struct gpio_chip        chip;
        struct platform_device  *leds;
};

#define POWER_POLL_DELAY        msecs_to_jiffies(5000)

/*-------------------------------------------------------------------------*/

#if     defined(DEBUG) || defined(CONFIG_DEBUG_FS)

static void dbg_chgstat(char *buf, size_t len, u8 chgstatus)
{
        snprintf(buf, len, "%02x%s%s%s%s%s%s%s%s\n",
                chgstatus,
                (chgstatus & TPS_CHG_USB) ? " USB" : "",
                (chgstatus & TPS_CHG_AC) ? " AC" : "",
                (chgstatus & TPS_CHG_THERM) ? " therm" : "",
                (chgstatus & TPS_CHG_TERM) ? " done" :
                        ((chgstatus & (TPS_CHG_USB|TPS_CHG_AC))
                                ? " (charging)" : ""),
                (chgstatus & TPS_CHG_TAPER_TMO) ? " taper_tmo" : "",
                (chgstatus & TPS_CHG_CHG_TMO) ? " charge_tmo" : "",
                (chgstatus & TPS_CHG_PRECHG_TMO) ? " prechg_tmo" : "",
                (chgstatus & TPS_CHG_TEMP_ERR) ? " temp_err" : "");
}

static void dbg_regstat(char *buf, size_t len, u8 regstatus)
{
        snprintf(buf, len, "%02x %s%s%s%s%s%s%s%s\n",
                regstatus,
                (regstatus & TPS_REG_ONOFF) ? "off" : "(on)",
                (regstatus & TPS_REG_COVER) ? " uncover" : "",
                (regstatus & TPS_REG_UVLO) ? " UVLO" : "",
                (regstatus & TPS_REG_NO_CHG) ? " NO_CHG" : "",
                (regstatus & TPS_REG_PG_LD02) ? " ld02_bad" : "",
                (regstatus & TPS_REG_PG_LD01) ? " ld01_bad" : "",
                (regstatus & TPS_REG_PG_MAIN) ? " main_bad" : "",
                (regstatus & TPS_REG_PG_CORE) ? " core_bad" : "");
}

static void dbg_chgconf(int por, char *buf, size_t len, u8 chgconfig)
{
        const char *hibit;

        if (por)
                hibit = (chgconfig & TPS_CHARGE_POR)
                                ? "POR=69ms" : "POR=1sec";
        else
                hibit = (chgconfig & TPS65013_AUA) ? "AUA" : "";

        snprintf(buf, len, "%02x %s%s%s AC=%d%% USB=%dmA %sCharge\n",
                chgconfig, hibit,
                (chgconfig & TPS_CHARGE_RESET) ? " reset" : "",
                (chgconfig & TPS_CHARGE_FAST) ? " fast" : "",
                ({int p; switch ((chgconfig >> 3) & 3) {
                case 3:         p = 100; break;
                case 2:         p = 75; break;
                case 1:         p = 50; break;
                default:        p = 25; break;
                }; p; }),
                (chgconfig & TPS_VBUS_CHARGING)
                        ? ((chgconfig & TPS_VBUS_500MA) ? 500 : 100)
                        : 0,
                (chgconfig & TPS_CHARGE_ENABLE) ? "" : "No");
}

#endif

#ifdef  DEBUG

static void show_chgstatus(const char *label, u8 chgstatus)
{
        char buf [100];

        dbg_chgstat(buf, sizeof buf, chgstatus);
        pr_debug("%s: %s %s", DRIVER_NAME, label, buf);
}

static void show_regstatus(const char *label, u8 regstatus)
{
        char buf [100];

        dbg_regstat(buf, sizeof buf, regstatus);
        pr_debug("%s: %s %s", DRIVER_NAME, label, buf);
}

static void show_chgconfig(int por, const char *label, u8 chgconfig)
{
        char buf [100];

        dbg_chgconf(por, buf, sizeof buf, chgconfig);
        pr_debug("%s: %s %s", DRIVER_NAME, label, buf);
}

#else

static inline void show_chgstatus(const char *label, u8 chgstatus) { }
static inline void show_regstatus(const char *label, u8 chgstatus) { }
static inline void show_chgconfig(int por, const char *label, u8 chgconfig) { }

#endif

#ifdef  CONFIG_DEBUG_FS

static int dbg_show(struct seq_file *s, void *_)
{
        struct tps65010 *tps = s->private;
        u8              value, v2;
        unsigned        i;
        char            buf[100];
        const char      *chip;

        switch (tps->model) {
        case TPS65010:  chip = "tps65010"; break;
        case TPS65011:  chip = "tps65011"; break;
        case TPS65012:  chip = "tps65012"; break;
        case TPS65013:  chip = "tps65013"; break;
        default:        chip = NULL; break;
        }
        seq_printf(s, "driver  %s\nversion %s\nchip    %s\n\n",
                        DRIVER_NAME, DRIVER_VERSION, chip);

        mutex_lock(&tps->lock);

        /* FIXME how can we tell whether a battery is present?
         * likely involves a charge gauging chip (like BQ26501).
         */

        seq_printf(s, "%scharging\n\n", tps->charging ? "" : "(not) ");


        /* registers for monitoring battery charging and status; note
         * that reading chgstat and regstat may ack IRQs...
         */
        value = i2c_smbus_read_byte_data(tps->client, TPS_CHGCONFIG);
        dbg_chgconf(tps->por, buf, sizeof buf, value);
        seq_printf(s, "chgconfig %s", buf);

        value = i2c_smbus_read_byte_data(tps->client, TPS_CHGSTATUS);
        dbg_chgstat(buf, sizeof buf, value);
        seq_printf(s, "chgstat   %s", buf);
        value = i2c_smbus_read_byte_data(tps->client, TPS_MASK1);
        dbg_chgstat(buf, sizeof buf, value);
        seq_printf(s, "mask1     %s", buf);
        /* ignore ackint1 */

        value = i2c_smbus_read_byte_data(tps->client, TPS_REGSTATUS);
        dbg_regstat(buf, sizeof buf, value);
        seq_printf(s, "regstat   %s", buf);
        value = i2c_smbus_read_byte_data(tps->client, TPS_MASK2);
        dbg_regstat(buf, sizeof buf, value);
        seq_printf(s, "mask2     %s\n", buf);
        /* ignore ackint2 */

        queue_delayed_work(system_power_efficient_wq, &tps->work,
                           POWER_POLL_DELAY);

        /* VMAIN voltage, enable lowpower, etc */
        value = i2c_smbus_read_byte_data(tps->client, TPS_VDCDC1);
        seq_printf(s, "vdcdc1    %02x\n", value);

        /* VCORE voltage, vibrator on/off */
        value = i2c_smbus_read_byte_data(tps->client, TPS_VDCDC2);
        seq_printf(s, "vdcdc2    %02x\n", value);

        /* both LD0s, and their lowpower behavior */
        value = i2c_smbus_read_byte_data(tps->client, TPS_VREGS1);
        seq_printf(s, "vregs1    %02x\n\n", value);


        /* LEDs and GPIOs */
        value = i2c_smbus_read_byte_data(tps->client, TPS_LED1_ON);
        v2 = i2c_smbus_read_byte_data(tps->client, TPS_LED1_PER);
        seq_printf(s, "led1 %s, on=%02x, per=%02x, %d/%d msec\n",
                (value & 0x80)
                        ? str_on_off(v2 & 0x80)
                        : ((v2 & 0x80) ? "blink" : "(nPG)"),
                value, v2,
                (value & 0x7f) * 10, (v2 & 0x7f) * 100);

        value = i2c_smbus_read_byte_data(tps->client, TPS_LED2_ON);
        v2 = i2c_smbus_read_byte_data(tps->client, TPS_LED2_PER);
        seq_printf(s, "led2 %s, on=%02x, per=%02x, %d/%d msec\n",
                (value & 0x80)
                        ? str_on_off(v2 & 0x80)
                        : ((v2 & 0x80) ? "blink" : "off"),
                value, v2,
                (value & 0x7f) * 10, (v2 & 0x7f) * 100);

        value = i2c_smbus_read_byte_data(tps->client, TPS_DEFGPIO);
        v2 = i2c_smbus_read_byte_data(tps->client, TPS_MASK3);
        seq_printf(s, "defgpio %02x mask3 %02x\n", value, v2);

        for (i = 0; i < 4; i++) {
                if (value & (1 << (4 + i)))
                        seq_printf(s, "  gpio%d-out %s\n", i + 1,
                                (value & (1 << i)) ? "low" : "hi ");
                else
                        seq_printf(s, "  gpio%d-in  %s %s %s\n", i + 1,
                                (value & (1 << i)) ? "hi " : "low",
                                (v2 & (1 << i)) ? "no-irq" : "irq",
                                (v2 & (1 << (4 + i))) ? "rising" : "falling");
        }

        mutex_unlock(&tps->lock);
        return 0;
}

static int dbg_tps_open(struct inode *inode, struct file *file)
{
        return single_open(file, dbg_show, inode->i_private);
}

static const struct file_operations debug_fops = {
        .open           = dbg_tps_open,
        .read           = seq_read,
        .llseek         = seq_lseek,
        .release        = single_release,
};

#define DEBUG_FOPS      &debug_fops

#else
#define DEBUG_FOPS      NULL
#endif

/*-------------------------------------------------------------------------*/

/* handle IRQS in a task context, so we can use I2C calls */
static void tps65010_interrupt(struct tps65010 *tps)
{
        u8 tmp = 0, mask, poll;

        /* IRQs won't trigger for certain events, but we can get
         * others by polling (normally, with external power applied).
         */
        poll = 0;

        /* regstatus irqs */
        if (tps->nmask2) {
                tmp = i2c_smbus_read_byte_data(tps->client, TPS_REGSTATUS);
                mask = tmp ^ tps->regstatus;
                tps->regstatus = tmp;
                mask &= tps->nmask2;
        } else
                mask = 0;
        if (mask) {
                tps->regstatus =  tmp;
                /* may need to shut something down ... */

                /* "off" usually means deep sleep */
                if (tmp & TPS_REG_ONOFF) {
                        pr_info("%s: power off button\n", DRIVER_NAME);
#if 0
                        /* REVISIT:  this might need its own workqueue
                         * plus tweaks including deadlock avoidance ...
                         * also needs to get error handling and probably
                         * an #ifdef CONFIG_HIBERNATION
                         */
                        hibernate();
#endif
                        poll = 1;
                }
        }

        /* chgstatus irqs */
        if (tps->nmask1) {
                tmp = i2c_smbus_read_byte_data(tps->client, TPS_CHGSTATUS);
                mask = tmp ^ tps->chgstatus;
                tps->chgstatus = tmp;
                mask &= tps->nmask1;
        } else
                mask = 0;
        if (mask) {
                unsigned        charging = 0;

                show_chgstatus("chg/irq", tmp);
                if (tmp & (TPS_CHG_USB|TPS_CHG_AC))
                        show_chgconfig(tps->por, "conf", tps->chgconf);

                /* Unless it was turned off or disabled, we charge any
                 * battery whenever there's power available for it
                 * and the charger hasn't been disabled.
                 */
                if (!(tps->chgstatus & ~(TPS_CHG_USB|TPS_CHG_AC))
                                && (tps->chgstatus & (TPS_CHG_USB|TPS_CHG_AC))
                                && (tps->chgconf & TPS_CHARGE_ENABLE)
                                ) {
                        if (tps->chgstatus & TPS_CHG_USB) {
                                /* VBUS options are readonly until reconnect */
                                if (mask & TPS_CHG_USB)
                                        set_bit(FLAG_VBUS_CHANGED, &tps->flags);
                                charging = 1;
                        } else if (tps->chgstatus & TPS_CHG_AC)
                                charging = 1;
                }
                if (charging != tps->charging) {
                        tps->charging = charging;
                        pr_info("%s: battery %scharging\n",
                                DRIVER_NAME, charging ? "" :
                                ((tps->chgstatus & (TPS_CHG_USB|TPS_CHG_AC))
                                        ? "NOT " : "dis"));
                }
        }

        /* always poll to detect (a) power removal, without tps65013
         * NO_CHG IRQ; or (b) restart of charging after stop.
         */
        if ((tps->model != TPS65013 || !tps->charging)
                        && (tps->chgstatus & (TPS_CHG_USB|TPS_CHG_AC)))
                poll = 1;
        if (poll)
                queue_delayed_work(system_power_efficient_wq, &tps->work,
                                   POWER_POLL_DELAY);

        /* also potentially gpio-in rise or fall */
}

/* handle IRQs and polling using keventd for now */
static void tps65010_work(struct work_struct *work)
{
        struct tps65010         *tps;

        tps = container_of(to_delayed_work(work), struct tps65010, work);
        mutex_lock(&tps->lock);

        tps65010_interrupt(tps);

        if (test_and_clear_bit(FLAG_VBUS_CHANGED, &tps->flags)) {
                u8      chgconfig, tmp;

                chgconfig = i2c_smbus_read_byte_data(tps->client,
                                        TPS_CHGCONFIG);
                chgconfig &= ~(TPS_VBUS_500MA | TPS_VBUS_CHARGING);
                if (tps->vbus == 500)
                        chgconfig |= TPS_VBUS_500MA | TPS_VBUS_CHARGING;
                else if (tps->vbus >= 100)
                        chgconfig |= TPS_VBUS_CHARGING;

                i2c_smbus_write_byte_data(tps->client,
                                          TPS_CHGCONFIG, chgconfig);

                /* vbus update fails unless VBUS is connected! */
                tmp = i2c_smbus_read_byte_data(tps->client, TPS_CHGCONFIG);
                tps->chgconf = tmp;
                show_chgconfig(tps->por, "update vbus", tmp);
        }

        if (test_and_clear_bit(FLAG_IRQ_ENABLE, &tps->flags))
                enable_irq(tps->client->irq);

        mutex_unlock(&tps->lock);
}

static irqreturn_t tps65010_irq(int irq, void *_tps)
{
        struct tps65010         *tps = _tps;

        disable_irq_nosync(irq);
        set_bit(FLAG_IRQ_ENABLE, &tps->flags);
        queue_delayed_work(system_power_efficient_wq, &tps->work, 0);
        return IRQ_HANDLED;
}

/*-------------------------------------------------------------------------*/

/* offsets 0..3 == GPIO1..GPIO4
 * offsets 4..5 == LED1/nPG, LED2 (we set one of the non-BLINK modes)
 * offset 6 == vibrator motor driver
 */
static int
tps65010_gpio_set(struct gpio_chip *chip, unsigned offset, int value)
{
        if (offset < 4)
                tps65010_set_gpio_out_value(offset + 1, value);
        else if (offset < 6)
                tps65010_set_led(offset - 3, value ? ON : OFF);
        else
                tps65010_set_vib(value);

        return 0;
}

static int
tps65010_output(struct gpio_chip *chip, unsigned offset, int value)
{
        /* GPIOs may be input-only */
        if (offset < 4) {
                struct tps65010         *tps;

                tps = gpiochip_get_data(chip);
                if (!(tps->outmask & (1 << offset)))
                        return -EINVAL;
                tps65010_set_gpio_out_value(offset + 1, value);
        } else if (offset < 6)
                tps65010_set_led(offset - 3, value ? ON : OFF);
        else
                tps65010_set_vib(value);

        return 0;
}

static int tps65010_gpio_get(struct gpio_chip *chip, unsigned offset)
{
        int                     value;
        struct tps65010         *tps;

        tps = gpiochip_get_data(chip);

        if (offset < 4) {
                value = i2c_smbus_read_byte_data(tps->client, TPS_DEFGPIO);
                if (value < 0)
                        return value;
                if (value & (1 << (offset + 4)))        /* output */
                        return !(value & (1 << offset));
                else                                    /* input */
                        return !!(value & (1 << offset));
        }

        /* REVISIT we *could* report LED1/nPG and LED2 state ... */
        return 0;
}


/*-------------------------------------------------------------------------*/

static struct tps65010 *the_tps;

static void tps65010_remove(struct i2c_client *client)
{
        struct tps65010         *tps = i2c_get_clientdata(client);
        struct tps65010_board   *board = dev_get_platdata(&client->dev);

        if (board && board->teardown)
                board->teardown(client, &tps->chip);
        if (client->irq > 0)
                free_irq(client->irq, tps);
        cancel_delayed_work_sync(&tps->work);
        the_tps = NULL;
}

static int tps65010_probe(struct i2c_client *client)
{
        const struct i2c_device_id *id = i2c_client_get_device_id(client);
        struct tps65010         *tps;
        int                     status;
        struct tps65010_board   *board = dev_get_platdata(&client->dev);

        if (the_tps) {
                dev_dbg(&client->dev, "only one tps6501x chip allowed\n");
                return -ENODEV;
        }

        if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
                return -EINVAL;

        tps = devm_kzalloc(&client->dev, sizeof(*tps), GFP_KERNEL);
        if (!tps)
                return -ENOMEM;

        mutex_init(&tps->lock);
        INIT_DELAYED_WORK(&tps->work, tps65010_work);
        tps->client = client;
        tps->model = id->driver_data;

        /* the IRQ is active low, but many gpio lines can't support that
         * so this driver uses falling-edge triggers instead.
         */
        if (client->irq > 0) {
                status = request_irq(client->irq, tps65010_irq,
                                     IRQF_TRIGGER_FALLING | IRQF_NO_AUTOEN,
                                     DRIVER_NAME, tps);
                if (status < 0) {
                        dev_dbg(&client->dev, "can't get IRQ %d, err %d\n",
                                        client->irq, status);
                        return status;
                }
                set_bit(FLAG_IRQ_ENABLE, &tps->flags);
        } else
                dev_warn(&client->dev, "IRQ not configured!\n");


        switch (tps->model) {
        case TPS65010:
        case TPS65012:
                tps->por = 1;
                break;
        /* else CHGCONFIG.POR is replaced by AUA, enabling a WAIT mode */
        }
        tps->chgconf = i2c_smbus_read_byte_data(client, TPS_CHGCONFIG);
        show_chgconfig(tps->por, "conf/init", tps->chgconf);

        show_chgstatus("chg/init",
                i2c_smbus_read_byte_data(client, TPS_CHGSTATUS));
        show_regstatus("reg/init",
                i2c_smbus_read_byte_data(client, TPS_REGSTATUS));

        pr_debug("%s: vdcdc1 0x%02x, vdcdc2 %02x, vregs1 %02x\n", DRIVER_NAME,
                i2c_smbus_read_byte_data(client, TPS_VDCDC1),
                i2c_smbus_read_byte_data(client, TPS_VDCDC2),
                i2c_smbus_read_byte_data(client, TPS_VREGS1));
        pr_debug("%s: defgpio 0x%02x, mask3 0x%02x\n", DRIVER_NAME,
                i2c_smbus_read_byte_data(client, TPS_DEFGPIO),
                i2c_smbus_read_byte_data(client, TPS_MASK3));

        i2c_set_clientdata(client, tps);
        the_tps = tps;

#if     defined(CONFIG_USB_GADGET) && !defined(CONFIG_USB_OTG)
        /* USB hosts can't draw VBUS.  OTG devices could, later
         * when OTG infrastructure enables it.  USB peripherals
         * could be relying on VBUS while booting, though.
         */
        tps->vbus = 100;
#endif

        /* unmask the "interesting" irqs, then poll once to
         * kickstart monitoring, initialize shadowed status
         * registers, and maybe disable VBUS draw.
         */
        tps->nmask1 = ~0;
        (void) i2c_smbus_write_byte_data(client, TPS_MASK1, ~tps->nmask1);

        tps->nmask2 = TPS_REG_ONOFF;
        if (tps->model == TPS65013)
                tps->nmask2 |= TPS_REG_NO_CHG;
        (void) i2c_smbus_write_byte_data(client, TPS_MASK2, ~tps->nmask2);

        (void) i2c_smbus_write_byte_data(client, TPS_MASK3, 0x0f
                | i2c_smbus_read_byte_data(client, TPS_MASK3));

        tps65010_work(&tps->work.work);

        tps->file = debugfs_create_file(DRIVER_NAME, S_IRUGO, client->debugfs,
                                tps, DEBUG_FOPS);

        /* optionally register GPIOs */
        if (board) {
                tps->outmask = board->outmask;

                tps->chip.label = client->name;
                tps->chip.parent = &client->dev;
                tps->chip.owner = THIS_MODULE;

                tps->chip.set = tps65010_gpio_set;
                tps->chip.direction_output = tps65010_output;

                /* NOTE:  only partial support for inputs; nyet IRQs */
                tps->chip.get = tps65010_gpio_get;

                tps->chip.base = -1;
                tps->chip.ngpio = 7;
                tps->chip.can_sleep = 1;

                status = gpiochip_add_data(&tps->chip, tps);
                if (status < 0)
                        dev_err(&client->dev, "can't add gpiochip, err %d\n",
                                        status);
                else if (board->setup) {
                        status = board->setup(client, &tps->chip);
                        if (status < 0) {
                                dev_dbg(&client->dev,
                                        "board %s %s err %d\n",
                                        "setup", client->name, status);
                                status = 0;
                        }
                }
        }

        return 0;
}

static const struct i2c_device_id tps65010_id[] = {
        { "tps65010", TPS65010 },
        { "tps65011", TPS65011 },
        { "tps65012", TPS65012 },
        { "tps65013", TPS65013 },
        { "tps65014", TPS65011 },       /* tps65011 charging at 6.5V max */
        { }
};
MODULE_DEVICE_TABLE(i2c, tps65010_id);

static struct i2c_driver tps65010_driver = {
        .driver = {
                .name   = "tps65010",
        },
        .probe = tps65010_probe,
        .remove = tps65010_remove,
        .id_table = tps65010_id,
};

/*-------------------------------------------------------------------------*/

/* Draw from VBUS:
 *   0 mA -- DON'T DRAW (might supply power instead)
 * 100 mA -- usb unit load (slowest charge rate)
 * 500 mA -- usb high power (fast battery charge)
 */
int tps65010_set_vbus_draw(unsigned mA)
{
        unsigned long   flags;

        if (!the_tps)
                return -ENODEV;

        /* assumes non-SMP */
        local_irq_save(flags);
        if (mA >= 500)
                mA = 500;
        else if (mA >= 100)
                mA = 100;
        else
                mA = 0;
        the_tps->vbus = mA;
        if ((the_tps->chgstatus & TPS_CHG_USB)
                        && test_and_set_bit(
                                FLAG_VBUS_CHANGED, &the_tps->flags)) {
                /* gadget drivers call this in_irq() */
                queue_delayed_work(system_power_efficient_wq, &the_tps->work,
                                   0);
        }
        local_irq_restore(flags);

        return 0;
}
EXPORT_SYMBOL(tps65010_set_vbus_draw);

/*-------------------------------------------------------------------------*/
/* tps65010_set_gpio_out_value parameter:
 * gpio:  GPIO1, GPIO2, GPIO3 or GPIO4
 * value: LOW or HIGH
 */
int tps65010_set_gpio_out_value(unsigned gpio, unsigned value)
{
        int      status;
        unsigned defgpio;

        if (!the_tps)
                return -ENODEV;
        if ((gpio < GPIO1) || (gpio > GPIO4))
                return -EINVAL;

        mutex_lock(&the_tps->lock);

        defgpio = i2c_smbus_read_byte_data(the_tps->client, TPS_DEFGPIO);

        /* Configure GPIO for output */
        defgpio |= 1 << (gpio + 3);

        /* Writing 1 forces a logic 0 on that GPIO and vice versa */
        switch (value) {
        case LOW:
                defgpio |= 1 << (gpio - 1);    /* set GPIO low by writing 1 */
                break;
        /* case HIGH: */
        default:
                defgpio &= ~(1 << (gpio - 1)); /* set GPIO high by writing 0 */
                break;
        }

        status = i2c_smbus_write_byte_data(the_tps->client,
                TPS_DEFGPIO, defgpio);

        pr_debug("%s: gpio%dout = %s, defgpio 0x%02x\n", DRIVER_NAME,
                gpio, str_high_low(value),
                i2c_smbus_read_byte_data(the_tps->client, TPS_DEFGPIO));

        mutex_unlock(&the_tps->lock);
        return status;
}
EXPORT_SYMBOL(tps65010_set_gpio_out_value);

/*-------------------------------------------------------------------------*/
/* tps65010_set_led parameter:
 * led:  LED1 or LED2
 * mode: ON, OFF or BLINK
 */
int tps65010_set_led(unsigned led, unsigned mode)
{
        int      status;
        unsigned led_on, led_per, offs;

        if (!the_tps)
                return -ENODEV;

        if (led == LED1)
                offs = 0;
        else {
                offs = 2;
                led = LED2;
        }

        mutex_lock(&the_tps->lock);

        pr_debug("%s: led%i_on   0x%02x\n", DRIVER_NAME, led,
                i2c_smbus_read_byte_data(the_tps->client,
                                TPS_LED1_ON + offs));

        pr_debug("%s: led%i_per  0x%02x\n", DRIVER_NAME, led,
                i2c_smbus_read_byte_data(the_tps->client,
                                TPS_LED1_PER + offs));

        switch (mode) {
        case OFF:
                led_on  = 1 << 7;
                led_per = 0 << 7;
                break;
        case ON:
                led_on  = 1 << 7;
                led_per = 1 << 7;
                break;
        case BLINK:
                led_on  = 0x30 | (0 << 7);
                led_per = 0x08 | (1 << 7);
                break;
        default:
                printk(KERN_ERR "%s: Wrong mode parameter for set_led()\n",
                       DRIVER_NAME);
                mutex_unlock(&the_tps->lock);
                return -EINVAL;
        }

        status = i2c_smbus_write_byte_data(the_tps->client,
                        TPS_LED1_ON + offs, led_on);

        if (status != 0) {
                printk(KERN_ERR "%s: Failed to write led%i_on register\n",
                       DRIVER_NAME, led);
                mutex_unlock(&the_tps->lock);
                return status;
        }

        pr_debug("%s: led%i_on   0x%02x\n", DRIVER_NAME, led,
                i2c_smbus_read_byte_data(the_tps->client, TPS_LED1_ON + offs));

        status = i2c_smbus_write_byte_data(the_tps->client,
                        TPS_LED1_PER + offs, led_per);

        if (status != 0) {
                printk(KERN_ERR "%s: Failed to write led%i_per register\n",
                       DRIVER_NAME, led);
                mutex_unlock(&the_tps->lock);
                return status;
        }

        pr_debug("%s: led%i_per  0x%02x\n", DRIVER_NAME, led,
                i2c_smbus_read_byte_data(the_tps->client,
                                TPS_LED1_PER + offs));

        mutex_unlock(&the_tps->lock);

        return status;
}
EXPORT_SYMBOL(tps65010_set_led);

/*-------------------------------------------------------------------------*/
/* tps65010_set_vib parameter:
 * value: ON or OFF
 */
int tps65010_set_vib(unsigned value)
{
        int      status;
        unsigned vdcdc2;

        if (!the_tps)
                return -ENODEV;

        mutex_lock(&the_tps->lock);

        vdcdc2 = i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC2);
        vdcdc2 &= ~(1 << 1);
        if (value)
                vdcdc2 |= (1 << 1);
        status = i2c_smbus_write_byte_data(the_tps->client,
                TPS_VDCDC2, vdcdc2);

        pr_debug("%s: vibrator %s\n", DRIVER_NAME, str_on_off(value));

        mutex_unlock(&the_tps->lock);
        return status;
}
EXPORT_SYMBOL(tps65010_set_vib);

/*-------------------------------------------------------------------------*/
/* tps65010_set_low_pwr parameter:
 * mode: ON or OFF
 */
int tps65010_set_low_pwr(unsigned mode)
{
        int      status;
        unsigned vdcdc1;

        if (!the_tps)
                return -ENODEV;

        mutex_lock(&the_tps->lock);

        pr_debug("%s: %s low_pwr, vdcdc1 0x%02x\n", DRIVER_NAME,
                str_enable_disable(mode),
                i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));

        vdcdc1 = i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1);

        switch (mode) {
        case OFF:
                vdcdc1 &= ~TPS_ENABLE_LP; /* disable ENABLE_LP bit */
                break;
        /* case ON: */
        default:
                vdcdc1 |= TPS_ENABLE_LP;  /* enable ENABLE_LP bit */
                break;
        }

        status = i2c_smbus_write_byte_data(the_tps->client,
                        TPS_VDCDC1, vdcdc1);

        if (status != 0)
                printk(KERN_ERR "%s: Failed to write vdcdc1 register\n",
                        DRIVER_NAME);
        else
                pr_debug("%s: vdcdc1 0x%02x\n", DRIVER_NAME,
                        i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));

        mutex_unlock(&the_tps->lock);

        return status;
}
EXPORT_SYMBOL(tps65010_set_low_pwr);

/*-------------------------------------------------------------------------*/
/* tps65010_config_vregs1 parameter:
 * value to be written to VREGS1 register
 * Note: The complete register is written, set all bits you need
 */
int tps65010_config_vregs1(unsigned value)
{
        int      status;

        if (!the_tps)
                return -ENODEV;

        mutex_lock(&the_tps->lock);

        pr_debug("%s: vregs1 0x%02x\n", DRIVER_NAME,
                        i2c_smbus_read_byte_data(the_tps->client, TPS_VREGS1));

        status = i2c_smbus_write_byte_data(the_tps->client,
                        TPS_VREGS1, value);

        if (status != 0)
                printk(KERN_ERR "%s: Failed to write vregs1 register\n",
                        DRIVER_NAME);
        else
                pr_debug("%s: vregs1 0x%02x\n", DRIVER_NAME,
                        i2c_smbus_read_byte_data(the_tps->client, TPS_VREGS1));

        mutex_unlock(&the_tps->lock);

        return status;
}
EXPORT_SYMBOL(tps65010_config_vregs1);

int tps65010_config_vdcdc2(unsigned value)
{
        struct i2c_client *c;
        int      status;

        if (!the_tps)
                return -ENODEV;

        c = the_tps->client;
        mutex_lock(&the_tps->lock);

        pr_debug("%s: vdcdc2 0x%02x\n", DRIVER_NAME,
                 i2c_smbus_read_byte_data(c, TPS_VDCDC2));

        status = i2c_smbus_write_byte_data(c, TPS_VDCDC2, value);

        if (status != 0)
                printk(KERN_ERR "%s: Failed to write vdcdc2 register\n",
                        DRIVER_NAME);
        else
                pr_debug("%s: vregs1 0x%02x\n", DRIVER_NAME,
                         i2c_smbus_read_byte_data(c, TPS_VDCDC2));

        mutex_unlock(&the_tps->lock);
        return status;
}
EXPORT_SYMBOL(tps65010_config_vdcdc2);

/*-------------------------------------------------------------------------*/
/* tps65013_set_low_pwr parameter:
 * mode: ON or OFF
 */

/* FIXME: Assumes AC or USB power is present. Setting AUA bit is not
        required if power supply is through a battery */

int tps65013_set_low_pwr(unsigned mode)
{
        int      status;
        unsigned vdcdc1, chgconfig;

        if (!the_tps || the_tps->por)
                return -ENODEV;

        mutex_lock(&the_tps->lock);

        pr_debug("%s: %s low_pwr, chgconfig 0x%02x vdcdc1 0x%02x\n",
                DRIVER_NAME,
                str_enable_disable(mode),
                i2c_smbus_read_byte_data(the_tps->client, TPS_CHGCONFIG),
                i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));

        chgconfig = i2c_smbus_read_byte_data(the_tps->client, TPS_CHGCONFIG);
        vdcdc1 = i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1);

        switch (mode) {
        case OFF:
                chgconfig &= ~TPS65013_AUA; /* disable AUA bit */
                vdcdc1 &= ~TPS_ENABLE_LP; /* disable ENABLE_LP bit */
                break;
        /* case ON: */
        default:
                chgconfig |= TPS65013_AUA;  /* enable AUA bit */
                vdcdc1 |= TPS_ENABLE_LP;  /* enable ENABLE_LP bit */
                break;
        }

        status = i2c_smbus_write_byte_data(the_tps->client,
                        TPS_CHGCONFIG, chgconfig);
        if (status != 0) {
                printk(KERN_ERR "%s: Failed to write chconfig register\n",
         DRIVER_NAME);
                mutex_unlock(&the_tps->lock);
                return status;
        }

        chgconfig = i2c_smbus_read_byte_data(the_tps->client, TPS_CHGCONFIG);
        the_tps->chgconf = chgconfig;
        show_chgconfig(0, "chgconf", chgconfig);

        status = i2c_smbus_write_byte_data(the_tps->client,
                        TPS_VDCDC1, vdcdc1);

        if (status != 0)
                printk(KERN_ERR "%s: Failed to write vdcdc1 register\n",
         DRIVER_NAME);
        else
                pr_debug("%s: vdcdc1 0x%02x\n", DRIVER_NAME,
                        i2c_smbus_read_byte_data(the_tps->client, TPS_VDCDC1));

        mutex_unlock(&the_tps->lock);

        return status;
}
EXPORT_SYMBOL(tps65013_set_low_pwr);

/*-------------------------------------------------------------------------*/

static int __init tps_init(void)
{
        return i2c_add_driver(&tps65010_driver);
}
/* NOTE:  this MUST be initialized before the other parts of the system
 * that rely on it ... but after the i2c bus on which this relies.
 * That is, much earlier than on PC-type systems, which don't often use
 * I2C as a core system bus.
 */
subsys_initcall(tps_init);

static void __exit tps_exit(void)
{
        i2c_del_driver(&tps65010_driver);
}
module_exit(tps_exit);