tps65912-core.c

Go to the documentation of this file.

/*
 * tps65912-core.c  --  TI TPS65912x
 *
 * Copyright 2011 Texas Instruments Inc.
 *
 * Author: Margarita Olaya Cabrera <[email protected]>
 *
 *  This program is free software; you can redistribute it and/or modify it
 *  under  the terms of the GNU General  Public License as published by the
 *  Free Software Foundation;  either version 2 of the License, or (at your
 *  option) any later version.
 *
 *  This driver is based on wm8350 implementation.
 */

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/gpio.h>
#include <linux/mfd/core.h>
#include <linux/mfd/tps65912.h>

static struct mfd_cell tps65912s[] = {
    {
        .name = "tps65912-pmic",
    },
};

int tps65912_set_bits(struct tps65912 *tps65912, u8 reg, u8 mask)
{
    u8 data;
    int err;

    mutex_lock(&tps65912->io_mutex);

    err = tps65912->read(tps65912, reg, 1, &data);
    if (err) {
        dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg);
        goto out;
    }

    data |= mask;
    err = tps65912->write(tps65912, reg, 1, &data);
    if (err)
        dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg);

out:
    mutex_unlock(&tps65912->io_mutex);
    return err;
}
EXPORT_SYMBOL_GPL(tps65912_set_bits);

int tps65912_clear_bits(struct tps65912 *tps65912, u8 reg, u8 mask)
{
    u8 data;
    int err;

    mutex_lock(&tps65912->io_mutex);
    err = tps65912->read(tps65912, reg, 1, &data);
    if (err) {
        dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg);
        goto out;
    }

    data &= ~mask;
    err = tps65912->write(tps65912, reg, 1, &data);
    if (err)
        dev_err(tps65912->dev, "Write to reg 0x%x failed\n", reg);

out:
    mutex_unlock(&tps65912->io_mutex);
    return err;
}
EXPORT_SYMBOL_GPL(tps65912_clear_bits);

static inline int tps65912_read(struct tps65912 *tps65912, u8 reg)
{
    u8 val;
    int err;

    err = tps65912->read(tps65912, reg, 1, &val);
    if (err < 0)
        return err;

    return val;
}

static inline int tps65912_write(struct tps65912 *tps65912, u8 reg, u8 val)
{
    return tps65912->write(tps65912, reg, 1, &val);
}

int tps65912_reg_read(struct tps65912 *tps65912, u8 reg)
{
    int data;

    mutex_lock(&tps65912->io_mutex);

    data = tps65912_read(tps65912, reg);
    if (data < 0)
        dev_err(tps65912->dev, "Read from reg 0x%x failed\n", reg);

    mutex_unlock(&tps65912->io_mutex);
    return data;
}
EXPORT_SYMBOL_GPL(tps65912_reg_read);

int tps65912_reg_write(struct tps65912 *tps65912, u8 reg, u8 val)
{
    int err;

    mutex_lock(&tps65912->io_mutex);

    err = tps65912_write(tps65912, reg, val);
    if (err < 0)
        dev_err(tps65912->dev, "Write for reg 0x%x failed\n", reg);

    mutex_unlock(&tps65912->io_mutex);
    return err;
}
EXPORT_SYMBOL_GPL(tps65912_reg_write);

int tps65912_device_init(struct tps65912 *tps65912)
{
    struct tps65912_board *pmic_plat_data = tps65912->dev->platform_data;
    struct tps65912_platform_data *init_data;
    int ret, dcdc_avs, value;

    init_data = kzalloc(sizeof(struct tps65912_platform_data), GFP_KERNEL);
    if (init_data == NULL)
        return -ENOMEM;

    mutex_init(&tps65912->io_mutex);
    dev_set_drvdata(tps65912->dev, tps65912);

    dcdc_avs = (pmic_plat_data->is_dcdc1_avs << 0 |
            pmic_plat_data->is_dcdc2_avs  << 1 |
                pmic_plat_data->is_dcdc3_avs << 2 |
                    pmic_plat_data->is_dcdc4_avs << 3);
    if (dcdc_avs) {
        tps65912->read(tps65912, TPS65912_I2C_SPI_CFG, 1, &value);
        dcdc_avs |= value;
        tps65912->write(tps65912, TPS65912_I2C_SPI_CFG, 1, &dcdc_avs);
    }

    ret = mfd_add_devices(tps65912->dev, -1,
                  tps65912s, ARRAY_SIZE(tps65912s),
                  NULL, 0, NULL);
    if (ret < 0)
        goto err;

    init_data->irq = pmic_plat_data->irq;
    init_data->irq_base = pmic_plat_data->irq_base;
    ret = tps65912_irq_init(tps65912, init_data->irq, init_data);
    if (ret < 0)
        goto err;

    kfree(init_data);
    return ret;

err:
    kfree(init_data);
    mfd_remove_devices(tps65912->dev);
    kfree(tps65912);
    return ret;
}

void tps65912_device_exit(struct tps65912 *tps65912)
{
    mfd_remove_devices(tps65912->dev);
    kfree(tps65912);
}

MODULE_AUTHOR("Margarita Olaya  <[email protected]>");
MODULE_DESCRIPTION("TPS65912x chip family multi-function driver");
MODULE_LICENSE("GPL");