1
0
mirror of git://projects.qi-hardware.com/openwrt-xburst.git synced 2024-12-12 03:26:15 +02:00
openwrt-xburst/target/linux/s3c24xx/files-2.6.30/drivers/mfd/glamo/glamo-gpio.c
lars fb189822fc [s3c24xx] bump to 2.6.30-rc6
git-svn-id: svn://svn.openwrt.org/openwrt/trunk@15918 3c298f89-4303-0410-b956-a3cf2f4a3e73
2009-05-18 17:55:41 +00:00

63 lines
1.4 KiB
C

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/spinlock.h>
#include <linux/io.h>
#include <linux/glamo-gpio.h>
#include "glamo-core.h"
#include "glamo-regs.h"
void glamo_gpio_setpin(struct glamo_core *glamo, unsigned int pin,
unsigned int value)
{
unsigned int reg = REG_OF_GPIO(pin);
u_int16_t tmp;
spin_lock(&glamo->lock);
tmp = readw(glamo->base + reg);
if (value)
tmp |= OUTPUT_BIT(pin);
else
tmp &= ~OUTPUT_BIT(pin);
writew(tmp, glamo->base + reg);
spin_unlock(&glamo->lock);
}
EXPORT_SYMBOL(glamo_gpio_setpin);
int glamo_gpio_getpin(struct glamo_core *glamo, unsigned int pin)
{
return readw(REG_OF_GPIO(pin)) & INPUT_BIT(pin) ? 1 : 0;
}
EXPORT_SYMBOL(glamo_gpio_getpin);
void glamo_gpio_cfgpin(struct glamo_core *glamo, unsigned int pinfunc)
{
unsigned int reg = REG_OF_GPIO(pinfunc);
u_int16_t tmp;
spin_lock(&glamo->lock);
tmp = readw(glamo->base + reg);
if ((pinfunc & 0x00f0) == GLAMO_GPIO_F_FUNC) {
/* pin is a function pin: clear gpio bit */
tmp &= ~FUNC_BIT(pinfunc);
} else {
/* pin is gpio: set gpio bit */
tmp |= FUNC_BIT(pinfunc);
if (pinfunc & GLAMO_GPIO_F_IN) {
/* gpio input: set bit to disable output mode */
tmp |= GPIO_OUT_BIT(pinfunc);
} else if (pinfunc & GLAMO_GPIO_F_OUT) {
/* gpio output: clear bit to enable output mode */
tmp &= ~GPIO_OUT_BIT(pinfunc);
}
}
writew(tmp, glamo->base + reg);
spin_unlock(&glamo->lock);
}
EXPORT_SYMBOL(glamo_gpio_cfgpin);