linux-imx

/*

 * wm8350-core.c  --  Device access for Wolfson WM8350

 *

 * Copyright 2007, 2008 Wolfson Microelectronics PLC.

 *

 * Author: Liam Girdwood

 *

 *  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/kernel.h>

#include <linux/module.h>

#include <linux/errno.h>

​

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

#include <linux/mfd/wm8350/gpio.h>

#include <linux/mfd/wm8350/pmic.h>

​

static int gpio_set_dir(struct wm8350 *wm8350, int gpio, int dir)

{

    int ret;

​

    wm8350_reg_unlock(wm8350);

    if (dir == WM8350_GPIO_DIR_OUT)

        ret = wm8350_clear_bits(wm8350,

                    WM8350_GPIO_CONFIGURATION_I_O,

                    1 << gpio);

    else

        ret = wm8350_set_bits(wm8350,

                      WM8350_GPIO_CONFIGURATION_I_O,

                      1 << gpio);

    wm8350_reg_lock(wm8350);

    return ret;

}

​

static int wm8350_gpio_set_debounce(struct wm8350 *wm8350, int gpio, int db)

{

    if (db == WM8350_GPIO_DEBOUNCE_ON)

        return wm8350_set_bits(wm8350, WM8350_GPIO_DEBOUNCE,

                       1 << gpio);

    else

        return wm8350_clear_bits(wm8350,

                     WM8350_GPIO_DEBOUNCE, 1 << gpio);

}

​

static int gpio_set_func(struct wm8350 *wm8350, int gpio, int func)

{

    u16 reg;

​

    wm8350_reg_unlock(wm8350);

    switch (gpio) {

    case 0:

        reg = wm8350_reg_read(wm8350, WM8350_GPIO_FUNCTION_SELECT_1)

            & ~WM8350_GP0_FN_MASK;

        wm8350_reg_write(wm8350, WM8350_GPIO_FUNCTION_SELECT_1,

                 reg | ((func & 0xf) << 0));

        break;

    case 1:

        reg = wm8350_reg_read(wm8350, WM8350_GPIO_FUNCTION_SELECT_1)

            & ~WM8350_GP1_FN_MASK;

        wm8350_reg_write(wm8350, WM8350_GPIO_FUNCTION_SELECT_1,

                 reg | ((func & 0xf) << 4));

        break;

    case 2:

        reg = wm8350_reg_read(wm8350, WM8350_GPIO_FUNCTION_SELECT_1)

            & ~WM8350_GP2_FN_MASK;

        wm8350_reg_write(wm8350, WM8350_GPIO_FUNCTION_SELECT_1,

                 reg | ((func & 0xf) << 8));

        break;

    case 3:

        reg = wm8350_reg_read(wm8350, WM8350_GPIO_FUNCTION_SELECT_1)

            & ~WM8350_GP3_FN_MASK;

        wm8350_reg_write(wm8350, WM8350_GPIO_FUNCTION_SELECT_1,

                 reg | ((func & 0xf) << 12));

        break;

    case 4:

        reg = wm8350_reg_read(wm8350, WM8350_GPIO_FUNCTION_SELECT_2)

            & ~WM8350_GP4_FN_MASK;

        wm8350_reg_write(wm8350, WM8350_GPIO_FUNCTION_SELECT_2,

                 reg | ((func & 0xf) << 0));

        break;

    case 5:

        reg = wm8350_reg_read(wm8350, WM8350_GPIO_FUNCTION_SELECT_2)

            & ~WM8350_GP5_FN_MASK;

        wm8350_reg_write(wm8350, WM8350_GPIO_FUNCTION_SELECT_2,

                 reg | ((func & 0xf) << 4));

        break;

    case 6: