linux-imx

/*

 * linux/drivers/regulator/aat2870-regulator.c

 *

 * Copyright (c) 2011, NVIDIA Corporation.

 * Author: Jin Park <jinyoungp@nvidia.com>

 *

 * This program is free software; you can redistribute it and/or

 * modify it under the terms of the GNU General Public License

 * version 2 as published by the Free Software Foundation.

 *

 * This program is distributed in the hope that it will be useful, but

 * WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU

 * General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, write to the Free Software

 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA

 * 02110-1301 USA

 */

​

#include <linux/kernel.h>

#include <linux/init.h>

#include <linux/err.h>

#include <linux/module.h>

#include <linux/slab.h>

#include <linux/platform_device.h>

#include <linux/regulator/driver.h>

#include <linux/regulator/machine.h>

#include <linux/mfd/aat2870.h>

​

struct aat2870_regulator {

    struct aat2870_data *aat2870;

    struct regulator_desc desc;

​

    u8 enable_addr;

    u8 enable_shift;

    u8 enable_mask;

​

    u8 voltage_addr;

    u8 voltage_shift;

    u8 voltage_mask;

};

​

static int aat2870_ldo_set_voltage_sel(struct regulator_dev *rdev,

                       unsigned selector)

{

    struct aat2870_regulator *ri = rdev_get_drvdata(rdev);

    struct aat2870_data *aat2870 = ri->aat2870;

​

    return aat2870->update(aat2870, ri->voltage_addr, ri->voltage_mask,

                   selector << ri->voltage_shift);

}

​

static int aat2870_ldo_get_voltage_sel(struct regulator_dev *rdev)

{

    struct aat2870_regulator *ri = rdev_get_drvdata(rdev);

    struct aat2870_data *aat2870 = ri->aat2870;

    u8 val;

    int ret;

​

    ret = aat2870->read(aat2870, ri->voltage_addr, &val);

    if (ret)

        return ret;

​

    return (val & ri->voltage_mask) >> ri->voltage_shift;

}

​

static int aat2870_ldo_enable(struct regulator_dev *rdev)

{

    struct aat2870_regulator *ri = rdev_get_drvdata(rdev);

    struct aat2870_data *aat2870 = ri->aat2870;

​

    return aat2870->update(aat2870, ri->enable_addr, ri->enable_mask,

                   ri->enable_mask);

}

​

static int aat2870_ldo_disable(struct regulator_dev *rdev)

{

    struct aat2870_regulator *ri = rdev_get_drvdata(rdev);

    struct aat2870_data *aat2870 = ri->aat2870;

​

    return aat2870->update(aat2870, ri->enable_addr, ri->enable_mask, 0);

}

​

static int aat2870_ldo_is_enabled(struct regulator_dev *rdev)

{

    struct aat2870_regulator *ri = rdev_get_drvdata(rdev);

    struct aat2870_data *aat2870 = ri->aat2870;

    u8 val;

    int ret;

​