mirror of https://github.com/hak5/openwrt.git
63 lines
1.4 KiB
C
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);
|
||
|
|
|