linux-imx

/*

 * wm831x-isink.c  --  Current sink driver for the WM831x series

 *

 * Copyright 2009 Wolfson Microelectronics PLC.

 *

 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>

 *

 *  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.

 */

​

#include <linux/module.h>

#include <linux/moduleparam.h>

#include <linux/init.h>

#include <linux/bitops.h>

#include <linux/err.h>

#include <linux/i2c.h>

#include <linux/platform_device.h>

#include <linux/regulator/driver.h>

#include <linux/slab.h>

​

#include <linux/mfd/wm831x/core.h>

#include <linux/mfd/wm831x/regulator.h>

#include <linux/mfd/wm831x/pdata.h>

​

#define WM831X_ISINK_MAX_NAME 7

​

struct wm831x_isink {

    char name[WM831X_ISINK_MAX_NAME];

    struct regulator_desc desc;

    int reg;

    struct wm831x *wm831x;

    struct regulator_dev *regulator;

};

​

static int wm831x_isink_enable(struct regulator_dev *rdev)

{

    struct wm831x_isink *isink = rdev_get_drvdata(rdev);

    struct wm831x *wm831x = isink->wm831x;

    int ret;

​

    /* We have a two stage enable: first start the ISINK... */

    ret = wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_ENA,

                  WM831X_CS1_ENA);

    if (ret != 0)

        return ret;

​

    /* ...then enable drive */

    ret = wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_DRIVE,

                  WM831X_CS1_DRIVE);

    if (ret != 0)

        wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_ENA, 0);

​

    return ret;

​

}

​

static int wm831x_isink_disable(struct regulator_dev *rdev)

{

    struct wm831x_isink *isink = rdev_get_drvdata(rdev);

    struct wm831x *wm831x = isink->wm831x;