From 23e44079dc367150420c0c000405267d0e61c4d7 Mon Sep 17 00:00:00 2001 From: John Crispin Date: Thu, 13 Dec 2007 21:10:25 +0000 Subject: [PATCH] add original danube gpio driver ... already did some minor cleanup SVN-Revision: 9738 --- .../danube/files/arch/mips/danube/Kconfig | 4 + .../danube/files/drivers/char/danube_gpio.c | 855 ++++++++++++++++++ target/linux/danube/patches/110-drivers.patch | 35 +- 3 files changed, 882 insertions(+), 12 deletions(-) create mode 100644 target/linux/danube/files/drivers/char/danube_gpio.c diff --git a/target/linux/danube/files/arch/mips/danube/Kconfig b/target/linux/danube/files/arch/mips/danube/Kconfig index 08e5fd4c1757..06404bfe75cb 100644 --- a/target/linux/danube/files/arch/mips/danube/Kconfig +++ b/target/linux/danube/files/arch/mips/danube/Kconfig @@ -20,5 +20,9 @@ config DANUBE_LED bool "Danube led" default y +config DANUBE_GPIO + bool "Danube gpio" + default y + endmenu diff --git a/target/linux/danube/files/drivers/char/danube_gpio.c b/target/linux/danube/files/drivers/char/danube_gpio.c new file mode 100644 index 000000000000..0157446ec4fd --- /dev/null +++ b/target/linux/danube/files/drivers/char/danube_gpio.c @@ -0,0 +1,855 @@ +/* + * 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. + * + * Copyright (C) 2005 infineon + * Copyright (C) 2007 John Crispin + * + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "port_defs.h" + +#define MAX_PORTS 2 // Number of ports in system +#define PINS_PER_PORT 16 // Number of available pins per port + +static int port_major = 0; +static int danube_port_pin_usage[MAX_PORTS][PINS_PER_PORT]; // Map for pin usage +static u32 danube_port_bases[MAX_PORTS] + = { DANUBE_GPIO, + DANUBE_GPIO + 0x00000030 +}; // Base addresses for ports + +static struct semaphore port_sem; + +int +danube_port_reserve_pin (int port, int pin, int module_id) +{ + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] == 0) { + danube_port_pin_usage[port][pin] = module_id; + } + else { + return -EBUSY; + } + + return OK; +} + +int +danube_port_free_pin (int port, int pin, int module_id) +{ + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + danube_port_pin_usage[port][pin] = 0; + + return OK; +} + +int +danube_port_set_open_drain (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_OD_REG, reg); + reg |= (1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OD_REG, reg); + + return OK; +} + +int +danube_port_clear_open_drain (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_OD_REG, reg); + reg &= ~(1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OD_REG, reg); + + return OK; +} + +int +danube_port_set_pudsel (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_PUDSEL_REG, reg); + reg |= (1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDSEL_REG, + reg); + + return OK; +} + +int +danube_port_clear_pudsel (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_PUDSEL_REG, reg); + reg &= ~(1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDSEL_REG, + reg); + + return OK; +} + +int +danube_port_set_puden (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_PUDEN_REG, reg); + reg |= (1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDEN_REG, reg); + + return OK; +} + +int +danube_port_clear_puden (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_PUDEN_REG, reg); + reg &= ~(1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDEN_REG, reg); + + return OK; +} + +int +danube_port_set_stoff (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_STOFF_REG, reg); + reg |= (1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_STOFF_REG, reg); + + return OK; +} + +int +danube_port_clear_stoff (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_STOFF_REG, reg); + reg &= ~(1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_STOFF_REG, reg); + + return OK; +} + +int +danube_port_set_dir_out (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_DIR_REG, reg); + reg |= (1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_DIR_REG, reg); + + return OK; +} + +int +danube_port_set_dir_in (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_DIR_REG, reg); + reg &= ~(1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_DIR_REG, reg); + + return OK; +} + +int +danube_port_set_output (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_OUT_REG, reg); + reg |= (1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OUT_REG, reg); + + return OK; +} + +int +danube_port_clear_output (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_OUT_REG, reg); + reg &= ~(1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OUT_REG, reg); + + return OK; +} + +int +danube_port_get_input (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_IN_REG, reg); + reg &= (1 << pin); + if (reg == 0x00) + return 0; + else + return 1; +} + +int +danube_port_set_altsel0 (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL0_REG, + reg); + reg |= (1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL0_REG, + reg); + + return OK; +} + +int +danube_port_clear_altsel0 (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL0_REG, + reg); + reg &= ~(1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL0_REG, + reg); + + return OK; +} + +int +danube_port_set_altsel1 (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL1_REG, + reg); + reg |= (1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL1_REG, + reg); + + return OK; +} + +int +danube_port_clear_altsel1 (int port, int pin, int module_id) +{ + u32 reg; + + if (port < 0 || pin < 0) + return -EINVAL; + if (port > MAX_PORTS || pin > PINS_PER_PORT) + return -EINVAL; + + if (danube_port_pin_usage[port][pin] != module_id) + return -EBUSY; + + PORT_READ_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL1_REG, + reg); + reg &= ~(1 << pin); + PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL1_REG, + reg); + + return OK; +} + +int +danube_port_read_procmem (char *buf, char **start, off_t offset, int count, + int *eof, void *data) +{ + long len = 0; + int t = 0; + u32 bit = 0; + u32 reg = 0; + + len = sprintf (buf, "\nDanube Port Settings\n"); + + len = len + sprintf (buf + len, + " 3 2 1 0\n"); + len = len + sprintf (buf + len, + " 10987654321098765432109876543210\n"); + len = len + sprintf (buf + len, + "----------------------------------------\n"); + + len = len + sprintf (buf + len, "\nP0-OUT: "); + PORT_READ_REG (DANUBE_GPIO_P0_OUT, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP1-OUT: "); + PORT_READ_REG (DANUBE_GPIO_P1_OUT, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP0-IN: "); + PORT_READ_REG (DANUBE_GPIO_P0_IN, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP1-IN: "); + PORT_READ_REG (DANUBE_GPIO_P1_IN, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP0-DIR: "); + PORT_READ_REG (DANUBE_GPIO_P0_DIR, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP1-DIR: "); + PORT_READ_REG (DANUBE_GPIO_P1_DIR, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP0-STO: "); + PORT_READ_REG (DANUBE_GPIO_P0_STOFF, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP1-STO: "); + PORT_READ_REG (DANUBE_GPIO_P1_STOFF, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP0-PUDE:"); + PORT_READ_REG (DANUBE_GPIO_P0_PUDEN, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP1-PUDE:"); + PORT_READ_REG (DANUBE_GPIO_P1_PUDEN, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP0-OD: "); + PORT_READ_REG (DANUBE_GPIO_P0_OD, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP1-OD: "); + PORT_READ_REG (DANUBE_GPIO_P1_OD, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP0-PUDS:"); + PORT_READ_REG (DANUBE_GPIO_P0_PUDSEL, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP1-PUDS:"); + PORT_READ_REG (DANUBE_GPIO_P1_PUDSEL, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP0_ALT0:"); + PORT_READ_REG (DANUBE_GPIO_P0_ALTSEL0, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP0_ALT1:"); + PORT_READ_REG (DANUBE_GPIO_P0_ALTSEL1, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP1_ALT0:"); + PORT_READ_REG (DANUBE_GPIO_P1_ALTSEL0, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\nP1_ALT1:"); + PORT_READ_REG (DANUBE_GPIO_P1_ALTSEL1, reg); + bit = 0x80000000; + for (t = 0; t < 32; t++) { + if ((reg & bit) > 0) + len = len + sprintf (buf + len, "X"); + else + len = len + sprintf (buf + len, " "); + bit = bit >> 1; + } + + len = len + sprintf (buf + len, "\n\n"); + + *eof = 1; // No more data available + return len; +} + +static int +danube_port_open (struct inode *inode, struct file *filep) +{ + return OK; +} + +static int +danube_port_release (struct inode *inode, struct file *filelp) +{ + return OK; +} + +static int +danube_port_ioctl (struct inode *inode, struct file *filp, + unsigned int cmd, unsigned long arg) +{ + int ret = 0; + volatile struct danube_port_ioctl_parm parm; + + if (_IOC_TYPE (cmd) != DANUBE_PORT_IOC_MAGIC) + return -EINVAL; + + if (_IOC_DIR (cmd) & _IOC_WRITE) { + if (!access_ok + (VERIFY_READ, arg, + sizeof (struct danube_port_ioctl_parm))) + return -EFAULT; + ret = copy_from_user ((void *) &parm, (void *) arg, + sizeof (struct danube_port_ioctl_parm)); + } + if (_IOC_DIR (cmd) & _IOC_READ) { + if (!access_ok + (VERIFY_WRITE, arg, + sizeof (struct danube_port_ioctl_parm))) + return -EFAULT; + } + + if (down_trylock (&port_sem) != 0) + return -EBUSY; + + switch (cmd) { + case DANUBE_PORT_IOCOD: + if (parm.value == 0x00) { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_clear_open_drain); + } + else { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_set_open_drain); + } + break; + case DANUBE_PORT_IOCPUDSEL: + if (parm.value == 0x00) { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_clear_pudsel); + } + else { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_set_pudsel); + } + break; + case DANUBE_PORT_IOCPUDEN: + if (parm.value == 0x00) { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_clear_puden); + } + else { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_set_puden); + } + break; + case DANUBE_PORT_IOCSTOFF: + if (parm.value == 0x00) { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_clear_stoff); + } + else { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_set_stoff); + } + break; + case DANUBE_PORT_IOCDIR: + if (parm.value == 0x00) { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_set_dir_in); + } + else { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_set_dir_out); + } + break; + case DANUBE_PORT_IOCOUTPUT: + if (parm.value == 0x00) { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_clear_output); + } + else { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_set_output); + } + break; + case DANUBE_PORT_IOCALTSEL0: + if (parm.value == 0x00) { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_clear_altsel0); + } + else { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_set_altsel0); + } + break; + case DANUBE_PORT_IOCALTSEL1: + if (parm.value == 0x00) { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_clear_altsel1); + } + else { + PORT_IOC_CALL (ret, parm.port, parm.pin, + danube_port_set_altsel1); + } + break; + case DANUBE_PORT_IOCINPUT: + ret = danube_port_reserve_pin (parm.port, parm.pin, + PORT_MODULE_ID); + if (ret == 0) + parm.value = + danube_port_get_input (parm.port, parm.pin, + PORT_MODULE_ID); + ret = danube_port_free_pin (parm.port, parm.pin, + PORT_MODULE_ID); + copy_to_user ((void *) arg, (void *) &parm, + sizeof (struct danube_port_ioctl_parm)); + break; + default: + ret = -EINVAL; + } + + up (&port_sem); + + return ret; +} + +static struct file_operations port_fops = { + open:danube_port_open, + release:danube_port_release, + ioctl:danube_port_ioctl +}; + +int __init +danube_port_init (void) +{ + int t = 0; + int i = 0; + int err = 0; + u32 pins = 0; + + printk ("Danube Port Initialization\n"); + + sema_init (&port_sem, 1); + + /* Check ports for available pins */ + for (t = 0; t < MAX_PORTS; t++) { + for (i = 0; i < PINS_PER_PORT; i++) + danube_port_pin_usage[t][i] = 0; + } + + /* register port device */ + err = register_chrdev (0, "danube-port", &port_fops); + if (err > 0) + port_major = err; + else { + printk ("danube-port: Error! Could not register port device. #%d\n", err); + return err; + } + + /* Create proc file */ + create_proc_read_entry ("driver/danube_port", 0, NULL, + danube_port_read_procmem, NULL); + + return OK; +} + +module_init (danube_port_init); + +EXPORT_SYMBOL (danube_port_reserve_pin); +EXPORT_SYMBOL (danube_port_free_pin); +EXPORT_SYMBOL (danube_port_set_open_drain); +EXPORT_SYMBOL (danube_port_clear_open_drain); +EXPORT_SYMBOL (danube_port_set_pudsel); +EXPORT_SYMBOL (danube_port_clear_pudsel); +EXPORT_SYMBOL (danube_port_set_puden); +EXPORT_SYMBOL (danube_port_clear_puden); +EXPORT_SYMBOL (danube_port_set_stoff); +EXPORT_SYMBOL (danube_port_clear_stoff); +EXPORT_SYMBOL (danube_port_set_dir_out); +EXPORT_SYMBOL (danube_port_set_dir_in); +EXPORT_SYMBOL (danube_port_set_output); +EXPORT_SYMBOL (danube_port_clear_output); +EXPORT_SYMBOL (danube_port_get_input); + +EXPORT_SYMBOL (danube_port_set_altsel0); +EXPORT_SYMBOL (danube_port_clear_altsel0); +EXPORT_SYMBOL (danube_port_set_altsel1); +EXPORT_SYMBOL (danube_port_clear_altsel1); diff --git a/target/linux/danube/patches/110-drivers.patch b/target/linux/danube/patches/110-drivers.patch index 3004672dc22a..5d170fae5311 100644 --- a/target/linux/danube/patches/110-drivers.patch +++ b/target/linux/danube/patches/110-drivers.patch @@ -1,7 +1,7 @@ Index: linux-2.6.23/drivers/serial/Kconfig =================================================================== ---- linux-2.6.23.orig/drivers/serial/Kconfig 2007-12-10 21:38:39.000000000 +0100 -+++ linux-2.6.23/drivers/serial/Kconfig 2007-12-10 21:38:42.000000000 +0100 +--- linux-2.6.23.orig/drivers/serial/Kconfig 2007-12-13 20:41:42.000000000 +0100 ++++ linux-2.6.23/drivers/serial/Kconfig 2007-12-13 20:41:57.000000000 +0100 @@ -1259,4 +1259,10 @@ Currently, only 8250 compatible ports are supported, but others can easily be added. @@ -15,8 +15,8 @@ Index: linux-2.6.23/drivers/serial/Kconfig endmenu Index: linux-2.6.23/drivers/serial/Makefile =================================================================== ---- linux-2.6.23.orig/drivers/serial/Makefile 2007-12-10 21:38:39.000000000 +0100 -+++ linux-2.6.23/drivers/serial/Makefile 2007-12-10 21:38:42.000000000 +0100 +--- linux-2.6.23.orig/drivers/serial/Makefile 2007-12-13 20:41:42.000000000 +0100 ++++ linux-2.6.23/drivers/serial/Makefile 2007-12-13 20:41:57.000000000 +0100 @@ -64,3 +64,4 @@ obj-$(CONFIG_SERIAL_NETX) += netx-serial.o obj-$(CONFIG_SERIAL_OF_PLATFORM) += of_serial.o @@ -24,8 +24,8 @@ Index: linux-2.6.23/drivers/serial/Makefile +obj-$(CONFIG_SERIAL_DANUBE) += danube_asc.o Index: linux-2.6.23/drivers/mtd/maps/Makefile =================================================================== ---- linux-2.6.23.orig/drivers/mtd/maps/Makefile 2007-12-10 21:38:39.000000000 +0100 -+++ linux-2.6.23/drivers/mtd/maps/Makefile 2007-12-10 21:38:42.000000000 +0100 +--- linux-2.6.23.orig/drivers/mtd/maps/Makefile 2007-12-13 20:41:42.000000000 +0100 ++++ linux-2.6.23/drivers/mtd/maps/Makefile 2007-12-13 20:41:57.000000000 +0100 @@ -71,3 +71,4 @@ obj-$(CONFIG_MTD_OMAP_NOR) += omap_nor.o obj-$(CONFIG_MTD_MTX1) += mtx-1_flash.o @@ -33,8 +33,8 @@ Index: linux-2.6.23/drivers/mtd/maps/Makefile +obj-$(CONFIG_MTD_DANUBE) += danube.o Index: linux-2.6.23/drivers/net/Kconfig =================================================================== ---- linux-2.6.23.orig/drivers/net/Kconfig 2007-12-10 21:38:42.000000000 +0100 -+++ linux-2.6.23/drivers/net/Kconfig 2007-12-10 21:38:42.000000000 +0100 +--- linux-2.6.23.orig/drivers/net/Kconfig 2007-12-13 20:41:42.000000000 +0100 ++++ linux-2.6.23/drivers/net/Kconfig 2007-12-13 20:41:57.000000000 +0100 @@ -339,6 +339,18 @@ source "drivers/net/arm/Kconfig" @@ -56,8 +56,8 @@ Index: linux-2.6.23/drivers/net/Kconfig depends on ARM || MIPS Index: linux-2.6.23/drivers/net/Makefile =================================================================== ---- linux-2.6.23.orig/drivers/net/Makefile 2007-12-10 21:38:42.000000000 +0100 -+++ linux-2.6.23/drivers/net/Makefile 2007-12-10 21:38:42.000000000 +0100 +--- linux-2.6.23.orig/drivers/net/Makefile 2007-12-13 20:41:42.000000000 +0100 ++++ linux-2.6.23/drivers/net/Makefile 2007-12-13 20:41:57.000000000 +0100 @@ -208,6 +208,7 @@ obj-$(CONFIG_FEC_8XX) += fec_8xx/ obj-$(CONFIG_PASEMI_MAC) += pasemi_mac.o @@ -68,8 +68,8 @@ Index: linux-2.6.23/drivers/net/Makefile Index: linux-2.6.23/drivers/char/watchdog/Makefile =================================================================== ---- linux-2.6.23.orig/drivers/char/watchdog/Makefile 2007-12-10 21:41:51.000000000 +0100 -+++ linux-2.6.23/drivers/char/watchdog/Makefile 2007-12-10 21:42:30.000000000 +0100 +--- linux-2.6.23.orig/drivers/char/watchdog/Makefile 2007-12-13 20:41:42.000000000 +0100 ++++ linux-2.6.23/drivers/char/watchdog/Makefile 2007-12-13 20:41:57.000000000 +0100 @@ -90,6 +90,7 @@ obj-$(CONFIG_INDYDOG) += indydog.o obj-$(CONFIG_WDT_MTX1) += mtx-1_wdt.o @@ -78,3 +78,14 @@ Index: linux-2.6.23/drivers/char/watchdog/Makefile # PARISC Architecture +Index: linux-2.6.23/drivers/char/Makefile +=================================================================== +--- linux-2.6.23.orig/drivers/char/Makefile 2007-12-13 20:41:42.000000000 +0100 ++++ linux-2.6.23/drivers/char/Makefile 2007-12-13 21:38:15.000000000 +0100 +@@ -135,3 +135,6 @@ + rm $@.tmp + + endif ++ ++obj-$(CONFIG_DANUBE_LED) += danube_led.o ++obj-$(CONFIG_DANUBE_GPIO) += danube_gpio.o -- 2.30.2