/* for driver-call usage */
uint32
_gpio_ctrl(unsigned int cmd, uint32 mask, uint32 val)
{
struct gpio_ioctl gpioioc;
unsigned long flags;
gpioioc.mask = mask;
gpioioc.val = val;
switch (cmd) {
case GPIO_IOC_RESERVE:
gpioioc.val = si_gpioreserve(gpio_sih, gpioioc.mask, GPIO_APP_PRIORITY);
break;
case GPIO_IOC_RELEASE:
gpioioc.val = si_gpiorelease(gpio_sih, gpioioc.mask, GPIO_APP_PRIORITY);
break;
case GPIO_IOC_OUT:
gpioioc.val = si_gpioout(gpio_sih, gpioioc.mask, gpioioc.val,
GPIO_APP_PRIORITY);
break;
case GPIO_IOC_OUTEN:
gpioioc.val = si_gpioouten(gpio_sih, gpioioc.mask, gpioioc.val,
GPIO_APP_PRIORITY);
break;
case GPIO_IOC_IN:
gpioioc.val = si_gpioin(gpio_sih);
break;
default:
break;
}
return gpioioc.val;
}
static long
gpio_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
{
#else
static int
gpio_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
{
#endif /* linux-2.6.22 */
struct gpio_ioctl gpioioc;
if (copy_from_user(&gpioioc, (struct gpio_ioctl *)arg, sizeof(struct gpio_ioctl)))
return -EFAULT;
switch (cmd) {
case GPIO_IOC_RESERVE:
gpioioc.val = si_gpioreserve(gpio_sih, gpioioc.mask, GPIO_APP_PRIORITY);
break;
case GPIO_IOC_RELEASE:
/*
* releasing the gpio doesn't change the current
* value on the GPIO last write value
* persists till some one overwrites it
*/
gpioioc.val = si_gpiorelease(gpio_sih, gpioioc.mask, GPIO_APP_PRIORITY);
break;
case GPIO_IOC_OUT:
gpioioc.val = si_gpioout(gpio_sih, gpioioc.mask, gpioioc.val,
GPIO_APP_PRIORITY);
break;
case GPIO_IOC_OUTEN:
gpioioc.val = si_gpioouten(gpio_sih, gpioioc.mask, gpioioc.val,
GPIO_APP_PRIORITY);
break;
case GPIO_IOC_IN:
gpioioc.val = si_gpioin(gpio_sih);
break;
default:
break;
}
if (copy_to_user((struct gpio_ioctl *)arg, &gpioioc, sizeof(struct gpio_ioctl)))
return -EFAULT;
return 0;
}
static struct file_operations gpio_fops = {
owner: THIS_MODULE,
open: gpio_open,
release: gpio_release,
#if LINUX_VERSION_CODE >= KERNEL_VERSION(2, 6, 36)
unlocked_ioctl: gpio_ioctl
#else
ioctl: gpio_ioctl
#endif
};
void gpio_free(unsigned int gpio)
{
mask &= ~(1<<gpio);
/* clear pullup */
si_gpiopull(gpio_sih, 0/*pullup*/, (1<<gpio), GPIO_APP_PRIORITY);
si_gpiorelease(gpio_sih, (1<<gpio), GPIO_APP_PRIORITY);
DBG("%s: gpio %d mask 0x%x\n", __FUNCTION__, gpio, mask);
return;
}
static int
gpio_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
{
struct gpio_ioctl gpioioc;
if (copy_from_user(&gpioioc, (struct gpio_ioctl *)arg, sizeof(struct gpio_ioctl)))
return -EFAULT;
switch (cmd) {
case GPIO_IOC_RESERVE:
gpioioc.val = si_gpioreserve(gpio_sih, gpioioc.mask, GPIO_APP_PRIORITY);
break;
case GPIO_IOC_RELEASE:
/*
* releasing the gpio doesn't change the current
* value on the GPIO last write value
* persists till some one overwrites it
*/
gpioioc.val = si_gpiorelease(gpio_sih, gpioioc.mask, GPIO_APP_PRIORITY);
break;
case GPIO_IOC_OUT:
gpioioc.val = si_gpioout(gpio_sih, gpioioc.mask, gpioioc.val,
GPIO_APP_PRIORITY);
break;
case GPIO_IOC_OUTEN:
gpioioc.val = si_gpioouten(gpio_sih, gpioioc.mask, gpioioc.val,
GPIO_APP_PRIORITY);
break;
case GPIO_IOC_IN:
gpioioc.val = si_gpioin(gpio_sih);
break;
default:
break;
}
if (copy_to_user((struct gpio_ioctl *)arg, &gpioioc, sizeof(struct gpio_ioctl)))
return -EFAULT;
return 0;
}
static int
bcmgpio_ioctl(int gpioreg, unsigned int mask , unsigned int val)
{
#if defined(__ECOS)
int value;
switch (gpioreg) {
case BCMGPIO_REG_IN:
value = si_gpioin(gpio_sih);
break;
case BCMGPIO_REG_OUT:
value = si_gpioout(gpio_sih, mask, val,GPIO_APP_PRIORITY);
break;
case BCMGPIO_REG_OUTEN:
value = si_gpioouten(gpio_sih, mask, val,GPIO_APP_PRIORITY);
break;
case BCMGPIO_REG_RESERVE:
value = si_gpioreserve(gpio_sih, mask, GPIO_APP_PRIORITY);
break;
case BCMGPIO_REG_RELEASE:
/*
* releasing the gpio doesn't change the current
* value on the GPIO last write value
* persists till some one overwrites it
*/
value = si_gpiorelease(gpio_sih, mask, GPIO_APP_PRIORITY);
break;
default:
GPIO_ERROR ("invalid gpioreg %d\n", gpioreg);
value = -1;
break;
}
return value;
#else
struct gpio_ioctl gpio;
int type;
gpio.val = val;
gpio.mask = mask;
switch (gpioreg) {
case BCMGPIO_REG_IN:
type = GPIO_IOC_IN;
break;
case BCMGPIO_REG_OUT:
type = GPIO_IOC_OUT;
break;
case BCMGPIO_REG_OUTEN:
type = GPIO_IOC_OUTEN;
break;
case BCMGPIO_REG_RESERVE:
type = GPIO_IOC_RESERVE;
break;
case BCMGPIO_REG_RELEASE:
type = GPIO_IOC_RELEASE;
break;
default:
GPIO_ERROR ("invalid gpioreg %d\n", gpioreg);
return -1;
}
if (ioctl(bcmgpio_fd, type, &gpio) < 0) {
GPIO_ERROR ("invalid gpioreg %d\n", gpioreg);
return -1;
}
return (gpio.val);
#endif
}