mirror of https://github.com/hak5/openwrt.git
parent
23e44079dc
commit
0b9ea77b88
|
@ -27,8 +27,32 @@
|
|||
#include <asm/semaphore.h>
|
||||
#include <asm/uaccess.h>
|
||||
#include <asm/danube/danube.h>
|
||||
#include <asm/danube/port.h>
|
||||
#include "port_defs.h"
|
||||
#include <asm/danube/danube_ioctl.h>
|
||||
|
||||
|
||||
#define DANUBE_PORT_OUT_REG 0x00000010
|
||||
#define DANUBE_PORT_IN_REG 0x00000014
|
||||
#define DANUBE_PORT_DIR_REG 0x00000018
|
||||
#define DANUBE_PORT_ALTSEL0_REG 0x0000001C
|
||||
#define DANUBE_PORT_ALTSEL1_REG 0x00000020
|
||||
#define DANUBE_PORT_OD_REG 0x00000024
|
||||
#define DANUBE_PORT_STOFF_REG 0x00000028
|
||||
#define DANUBE_PORT_PUDSEL_REG 0x0000002C
|
||||
#define DANUBE_PORT_PUDEN_REG 0x00000030
|
||||
|
||||
#define PORT_MODULE_ID 0xff
|
||||
|
||||
#define PORT_WRITE_REG(reg, value) \
|
||||
*((volatile u32*)(reg)) = (u32)value;
|
||||
|
||||
#define PORT_READ_REG(reg, value) \
|
||||
value = (u32)*((volatile u32*)(reg));
|
||||
|
||||
#define PORT_IOC_CALL(ret,port,pin,func) \
|
||||
ret=danube_port_reserve_pin(port,pin,PORT_MODULE_ID); \
|
||||
if (ret == 0) ret=func(port,pin,PORT_MODULE_ID); \
|
||||
if (ret == 0) ret=danube_port_free_pin(port,pin,PORT_MODULE_ID);
|
||||
|
||||
|
||||
#define MAX_PORTS 2 // Number of ports in system
|
||||
#define PINS_PER_PORT 16 // Number of available pins per port
|
||||
|
@ -57,7 +81,7 @@ danube_port_reserve_pin (int port, int pin, int module_id)
|
|||
return -EBUSY;
|
||||
}
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -73,7 +97,7 @@ danube_port_free_pin (int port, int pin, int module_id)
|
|||
return -EBUSY;
|
||||
danube_port_pin_usage[port][pin] = 0;
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -93,7 +117,7 @@ danube_port_set_open_drain (int port, int pin, int module_id)
|
|||
reg |= (1 << pin);
|
||||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OD_REG, reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -113,7 +137,7 @@ danube_port_clear_open_drain (int port, int pin, int module_id)
|
|||
reg &= ~(1 << pin);
|
||||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OD_REG, reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -134,7 +158,7 @@ danube_port_set_pudsel (int port, int pin, int module_id)
|
|||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDSEL_REG,
|
||||
reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -155,7 +179,7 @@ danube_port_clear_pudsel (int port, int pin, int module_id)
|
|||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDSEL_REG,
|
||||
reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -175,7 +199,7 @@ danube_port_set_puden (int port, int pin, int module_id)
|
|||
reg |= (1 << pin);
|
||||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDEN_REG, reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -195,7 +219,7 @@ danube_port_clear_puden (int port, int pin, int module_id)
|
|||
reg &= ~(1 << pin);
|
||||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_PUDEN_REG, reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -215,7 +239,7 @@ danube_port_set_stoff (int port, int pin, int module_id)
|
|||
reg |= (1 << pin);
|
||||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_STOFF_REG, reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -235,7 +259,7 @@ danube_port_clear_stoff (int port, int pin, int module_id)
|
|||
reg &= ~(1 << pin);
|
||||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_STOFF_REG, reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -255,7 +279,7 @@ danube_port_set_dir_out (int port, int pin, int module_id)
|
|||
reg |= (1 << pin);
|
||||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_DIR_REG, reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -275,7 +299,7 @@ danube_port_set_dir_in (int port, int pin, int module_id)
|
|||
reg &= ~(1 << pin);
|
||||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_DIR_REG, reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -295,7 +319,7 @@ danube_port_set_output (int port, int pin, int module_id)
|
|||
reg |= (1 << pin);
|
||||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OUT_REG, reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -315,7 +339,7 @@ danube_port_clear_output (int port, int pin, int module_id)
|
|||
reg &= ~(1 << pin);
|
||||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_OUT_REG, reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -358,7 +382,7 @@ danube_port_set_altsel0 (int port, int pin, int module_id)
|
|||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL0_REG,
|
||||
reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -380,7 +404,7 @@ danube_port_clear_altsel0 (int port, int pin, int module_id)
|
|||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL0_REG,
|
||||
reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -402,7 +426,7 @@ danube_port_set_altsel1 (int port, int pin, int module_id)
|
|||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL1_REG,
|
||||
reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -424,7 +448,7 @@ danube_port_clear_altsel1 (int port, int pin, int module_id)
|
|||
PORT_WRITE_REG (danube_port_bases[port] + DANUBE_PORT_ALTSEL1_REG,
|
||||
reg);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int
|
||||
|
@ -652,13 +676,13 @@ danube_port_read_procmem (char *buf, char **start, off_t offset, int count,
|
|||
static int
|
||||
danube_port_open (struct inode *inode, struct file *filep)
|
||||
{
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int
|
||||
danube_port_release (struct inode *inode, struct file *filelp)
|
||||
{
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int
|
||||
|
@ -828,7 +852,7 @@ danube_port_init (void)
|
|||
create_proc_read_entry ("driver/danube_port", 0, NULL,
|
||||
danube_port_read_procmem, NULL);
|
||||
|
||||
return OK;
|
||||
return 0;
|
||||
}
|
||||
|
||||
module_init (danube_port_init);
|
||||
|
|
|
@ -0,0 +1,42 @@
|
|||
/*
|
||||
* 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) 2007 John Crispin <blogic@openwrt.org>
|
||||
*
|
||||
*/
|
||||
#ifndef _DANUBE_IOCTL_H__
|
||||
#define _DANUBE_IOCTL_H__
|
||||
|
||||
/*------------ LED */
|
||||
|
||||
struct danube_port_ioctl_parm
|
||||
{
|
||||
int port;
|
||||
int pin;
|
||||
int value;
|
||||
};
|
||||
|
||||
#define DANUBE_PORT_IOC_MAGIC 0xbf
|
||||
#define DANUBE_PORT_IOCOD _IOW(DANUBE_PORT_IOC_MAGIC,0,struct danube_port_ioctl_parm)
|
||||
#define DANUBE_PORT_IOCPUDSEL _IOW(DANUBE_PORT_IOC_MAGIC,1,struct danube_port_ioctl_parm)
|
||||
#define DANUBE_PORT_IOCPUDEN _IOW(DANUBE_PORT_IOC_MAGIC,2,struct danube_port_ioctl_parm)
|
||||
#define DANUBE_PORT_IOCSTOFF _IOW(DANUBE_PORT_IOC_MAGIC,3,struct danube_port_ioctl_parm)
|
||||
#define DANUBE_PORT_IOCDIR _IOW(DANUBE_PORT_IOC_MAGIC,4,struct danube_port_ioctl_parm)
|
||||
#define DANUBE_PORT_IOCOUTPUT _IOW(DANUBE_PORT_IOC_MAGIC,5,struct danube_port_ioctl_parm)
|
||||
#define DANUBE_PORT_IOCINPUT _IOWR(DANUBE_PORT_IOC_MAGIC,6,struct danube_port_ioctl_parm)
|
||||
#define DANUBE_PORT_IOCALTSEL0 _IOW(DANUBE_PORT_IOC_MAGIC,7,struct danube_port_ioctl_parm)
|
||||
#define DANUBE_PORT_IOCALTSEL1 _IOW(DANUBE_PORT_IOC_MAGIC,8,struct danube_port_ioctl_parm)
|
||||
|
||||
#endif
|
Loading…
Reference in New Issue