This patch adds support the GPIO interface Signed-off-by: Minkyu Kang <mk7.kang@samsung.com>master
parent
3e5d177133
commit
8f5407c90d
@ -0,0 +1,143 @@ |
|||||||
|
/*
|
||||||
|
* (C) Copyright 2009 Samsung Electronics |
||||||
|
* Minkyu Kang <mk7.kang@samsung.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. |
||||||
|
* |
||||||
|
* 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., 59 Temple Place, Suite 330, Boston, |
||||||
|
* MA 02111-1307 USA |
||||||
|
*/ |
||||||
|
|
||||||
|
#include <common.h> |
||||||
|
#include <asm/io.h> |
||||||
|
#include <asm/arch/gpio.h> |
||||||
|
|
||||||
|
#define CON_MASK(x) (0xf << ((x) << 2)) |
||||||
|
#define CON_SFR(x, v) ((v) << ((x) << 2)) |
||||||
|
|
||||||
|
#define DAT_MASK(x) (0x1 << (x)) |
||||||
|
#define DAT_SET(x) (0x1 << (x)) |
||||||
|
|
||||||
|
#define PULL_MASK(x) (0x3 << ((x) << 1)) |
||||||
|
#define PULL_MODE(x, v) ((v) << ((x) << 1)) |
||||||
|
|
||||||
|
#define DRV_MASK(x) (0x3 << ((x) << 1)) |
||||||
|
#define DRV_SET(x, m) ((m) << ((x) << 1)) |
||||||
|
#define RATE_MASK(x) (0x1 << (x + 16)) |
||||||
|
#define RATE_SET(x) (0x1 << (x + 16)) |
||||||
|
|
||||||
|
void gpio_cfg_pin(struct s5pc1xx_gpio_bank *bank, int gpio, int cfg) |
||||||
|
{ |
||||||
|
unsigned int value; |
||||||
|
|
||||||
|
value = readl(&bank->con); |
||||||
|
value &= ~CON_MASK(gpio); |
||||||
|
value |= CON_SFR(gpio, cfg); |
||||||
|
writel(value, &bank->con); |
||||||
|
} |
||||||
|
|
||||||
|
void gpio_direction_output(struct s5pc1xx_gpio_bank *bank, int gpio, int en) |
||||||
|
{ |
||||||
|
unsigned int value; |
||||||
|
|
||||||
|
gpio_cfg_pin(bank, gpio, GPIO_OUTPUT); |
||||||
|
|
||||||
|
value = readl(&bank->dat); |
||||||
|
value &= ~DAT_MASK(gpio); |
||||||
|
if (en) |
||||||
|
value |= DAT_SET(gpio); |
||||||
|
writel(value, &bank->dat); |
||||||
|
} |
||||||
|
|
||||||
|
void gpio_direction_input(struct s5pc1xx_gpio_bank *bank, int gpio) |
||||||
|
{ |
||||||
|
gpio_cfg_pin(bank, gpio, GPIO_INPUT); |
||||||
|
} |
||||||
|
|
||||||
|
void gpio_set_value(struct s5pc1xx_gpio_bank *bank, int gpio, int en) |
||||||
|
{ |
||||||
|
unsigned int value; |
||||||
|
|
||||||
|
value = readl(&bank->dat); |
||||||
|
value &= ~DAT_MASK(gpio); |
||||||
|
if (en) |
||||||
|
value |= DAT_SET(gpio); |
||||||
|
writel(value, &bank->dat); |
||||||
|
} |
||||||
|
|
||||||
|
unsigned int gpio_get_value(struct s5pc1xx_gpio_bank *bank, int gpio) |
||||||
|
{ |
||||||
|
unsigned int value; |
||||||
|
|
||||||
|
value = readl(&bank->dat); |
||||||
|
return !!(value & DAT_MASK(gpio)); |
||||||
|
} |
||||||
|
|
||||||
|
void gpio_set_pull(struct s5pc1xx_gpio_bank *bank, int gpio, int mode) |
||||||
|
{ |
||||||
|
unsigned int value; |
||||||
|
|
||||||
|
value = readl(&bank->pull); |
||||||
|
value &= ~PULL_MASK(gpio); |
||||||
|
|
||||||
|
switch (mode) { |
||||||
|
case GPIO_PULL_DOWN: |
||||||
|
case GPIO_PULL_UP: |
||||||
|
value |= PULL_MODE(gpio, mode); |
||||||
|
break; |
||||||
|
default: |
||||||
|
return; |
||||||
|
} |
||||||
|
|
||||||
|
writel(value, &bank->pull); |
||||||
|
} |
||||||
|
|
||||||
|
void gpio_set_drv(struct s5pc1xx_gpio_bank *bank, int gpio, int mode) |
||||||
|
{ |
||||||
|
unsigned int value; |
||||||
|
|
||||||
|
value = readl(&bank->drv); |
||||||
|
value &= ~DRV_MASK(gpio); |
||||||
|
|
||||||
|
switch (mode) { |
||||||
|
case GPIO_DRV_1X: |
||||||
|
case GPIO_DRV_2X: |
||||||
|
case GPIO_DRV_3X: |
||||||
|
case GPIO_DRV_4X: |
||||||
|
value |= DRV_SET(gpio, mode); |
||||||
|
break; |
||||||
|
default: |
||||||
|
return; |
||||||
|
} |
||||||
|
|
||||||
|
writel(value, &bank->drv); |
||||||
|
} |
||||||
|
|
||||||
|
void gpio_set_rate(struct s5pc1xx_gpio_bank *bank, int gpio, int mode) |
||||||
|
{ |
||||||
|
unsigned int value; |
||||||
|
|
||||||
|
value = readl(&bank->drv); |
||||||
|
value &= ~RATE_MASK(gpio); |
||||||
|
|
||||||
|
switch (mode) { |
||||||
|
case GPIO_DRV_FAST: |
||||||
|
case GPIO_DRV_SLOW: |
||||||
|
value |= RATE_SET(gpio); |
||||||
|
break; |
||||||
|
default: |
||||||
|
return; |
||||||
|
} |
||||||
|
|
||||||
|
writel(value, &bank->drv); |
||||||
|
} |
Loading…
Reference in new issue