add original danube eeprom code

SVN-Revision: 9760
This commit is contained in:
John Crispin 2007-12-14 21:59:31 +00:00
parent 54968fdf1d
commit cce622bcb8
4 changed files with 647 additions and 2 deletions

View file

@ -41,6 +41,7 @@ CONFIG_CPU_SUPPORTS_HIGHMEM=y
# CONFIG_CRYPTO_HW is not set
CONFIG_DANUBE=y
CONFIG_DANUBE_ASC_UART=y
CONFIG_DANUBE_EEPROM=y
CONFIG_DANUBE_GPIO=y
CONFIG_DANUBE_LED=y
CONFIG_DANUBE_MII0=y

View file

@ -24,5 +24,9 @@ config DANUBE_GPIO
bool "Danube gpio"
default y
config DANUBE_EEPROM
bool "Danube eeprom"
default y
endmenu

View file

@ -0,0 +1,639 @@
/******************************************************************************
**
** FILE NAME : danube_eeprom.c
** PROJECT : Danube
** MODULES : EEPROM
**
** DATE : 31 DEC 2004
** AUTHOR : Liu Peng
** DESCRIPTION : X25040 EEPROM Driver
** COPYRIGHT : Copyright (c) 2006
** Infineon Technologies AG
** Am Campeon 1-12, 85579 Neubiberg, Germany
**
** 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.
**
** HISTORY
** $Date $Author $Comment
** 31 DEC 2004 Liu Peng Initiate Version
** 25 OCT 2006 Xu Liang Add GPL header.
*******************************************************************************/
#define IFAP_EEPROM_DRV_VERSION "0.0.1"
/*
**************************************************
*
* This driver was originally based on the INCA-IP driver, but due to
* fundamental conceptual drawbacks there has been changed a lot.
*
* Based on INCA-IP driver Copyright (c) 2003 Gary Jennejohn <gj@denx.de>
* Based on the VxWorks drivers Copyright (c) 2002, Infineon Technologies.
*
* 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
*
*/
#ifndef EXPORT_SYMTAB
#define EXPORT_SYMTAB
#endif
#include <linux/config.h>
#include <linux/module.h>
#include <linux/errno.h>
#include <linux/signal.h>
#include <linux/sched.h>
#include <linux/timer.h>
#include <linux/interrupt.h>
#include <linux/major.h>
#include <linux/string.h>
#include <linux/fs.h>
#include <linux/proc_fs.h>
#include <linux/fcntl.h>
#include <linux/ptrace.h>
#include <linux/mm.h>
#include <linux/ioport.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/spinlock.h>
#include <linux/slab.h>
#include <asm/system.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/uaccess.h>
#include <asm/bitops.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/version.h>
#include <asm/danube/danube.h>
#include <asm/danube/irq.h>
#include <asm/danube/ifx_ssc_defines.h>
#include <asm/danube/ifx_ssc.h>
#if CONFIG_MODVERSIONS==1
# include <linux/modversions.h>
#endif
#define AMAZON_EEPROM_EMSG(fmt,args...) printk("%s:" fmt, __FUNCTION__, ##args)
#if 0
#define AMAZON_EEPROM_DMSG(fmt,args...) printk("%s:" fmt, __FUNCTION__, ##args)
#else
#define AMAZON_EEPROM_DMSG(fmt,args...)
#endif
MODULE_LICENSE ("GPL");
MODULE_AUTHOR ("Peng Liu");
MODULE_DESCRIPTION ("IFAP EEPROM driver");
MODULE_SUPPORTED_DEVICE ("danube_eeprom");
MODULE_PARM (maj, "i");
MODULE_PARM_DESC (maj, "Major device number");
/* allow the user to set the major device number */
static int maj = 0;
static ssize_t danube_eeprom_read (struct file *, char *, size_t, loff_t *);
static ssize_t danube_eeprom_write (struct file *, const char *, size_t,
loff_t *);
static int danube_eeprom_ioctl (struct inode *, struct file *, unsigned int,
unsigned long);
static int danube_eeprom_open (struct inode *, struct file *);
static int danube_eeprom_close (struct inode *, struct file *);
//ifx_ssc.c
extern int ifx_ssc_init (void);
extern int ifx_ssc_open (struct inode *inode, struct file *filp);
extern int ifx_ssc_close (struct inode *inode, struct file *filp);
extern void ifx_ssc_cleanup_module (void);
extern int ifx_ssc_ioctl (struct inode *inode, struct file *filp,
unsigned int cmd, unsigned long data);
extern ssize_t ifx_ssc_kwrite (int port, const char *kbuf, size_t len);
extern ssize_t ifx_ssc_kread (int port, char *kbuf, size_t len);
extern int ifx_ssc_cs_low (u32 pin);
extern int ifx_ssc_cs_high (u32 pin);
extern int ifx_ssc_txrx (char *tx_buf, u32 tx_len, char *rx_buf, u32 rx_len);
extern int ifx_ssc_tx (char *tx_buf, u32 tx_len);
extern int ifx_ssc_rx (char *rx_buf, u32 rx_len);
/* CS: board dependant */
#define EEPROM_CS IFX_SSC_WHBGPOSTAT_OUT0_POS
/* commands for EEPROM, x25160, x25140 */
#define EEPROM_WREN ((u8)0x06)
#define EEPROM_WRDI ((u8)0x04)
#define EEPROM_RDSR ((u8)0x05)
#define EEPROM_WRSR ((u8)0x01)
#define EEPROM_READ ((u8)0x03)
#define EEPROM_WRITE ((u8)0x02)
#define EEPROM_PAGE_SIZE 4
#define EEPROM_SIZE 512
/* Brief: EEPROM_RDSR command
* Return: 0 OK
* error code
*/
static int
eeprom_rdsr (char *status)
{
int ret = 0;
unsigned char cmd = EEPROM_RDSR;
unsigned long flag;
local_irq_save (flag);
if ((ret = ifx_ssc_cs_low (EEPROM_CS))) {
local_irq_restore (flag);
return ret;
}
if ((ret = ifx_ssc_txrx (&cmd, 1, status, 1)) < 0) {
ifx_ssc_cs_high (EEPROM_CS);
local_irq_restore (flag);
return ret;
}
if ((ret = ifx_ssc_cs_high (EEPROM_CS))) {
local_irq_restore (flag);
return ret;
}
local_irq_restore (flag);
return ret;
}
/* Brief: wait for WIP is over
* Return:
* 0 WIP is over
* <0 Error code
*/
static inline int
eeprom_wip_over (void)
{
int ret = 0;
u8 status;
while (1) {
ret = eeprom_rdsr (&status);
AMAZON_EEPROM_DMSG ("status %x \n", status);
if (ret) {
AMAZON_EEPROM_EMSG ("read back status fails %d\n",
ret);
break;
}
else if (((status) & 1) != 0) {
AMAZON_EEPROM_DMSG ("read back status not zero %x\n",
status);
}
else {
break;
}
}
return ret;
}
/* Brief: EEPROM_WREN command
* Return: 0 OK
* error code
*/
static int
eeprom_wren (void)
{
unsigned char cmd = EEPROM_WREN;
int ret = 0;
unsigned long flag;
local_irq_save (flag);
if ((ret = ifx_ssc_cs_low (EEPROM_CS))) {
local_irq_restore (flag);
return ret;
}
if ((ret = ifx_ssc_tx (&cmd, 1)) < 0) {
ifx_ssc_cs_high (EEPROM_CS);
local_irq_restore (flag);
return ret;
}
if ((ret = ifx_ssc_cs_high (EEPROM_CS))) {
local_irq_restore (flag);
return ret;
}
local_irq_restore (flag);
eeprom_wip_over ();
return ret;
}
/* Brief: EEPROM_WRSR command
* Return: 0 OK
* error code
*/
static int
eeprom_wrsr (void)
{
int ret = 0;
unsigned char cmd[2];
cmd[0] = EEPROM_WRSR;
cmd[1] = 0;
if ((ret = eeprom_wren ())) {
AMAZON_EEPROM_EMSG ("eeprom_wren fails\n");
return ret;
}
unsigned long flag;
local_irq_save (flag);
if ((ret = ifx_ssc_cs_low (EEPROM_CS))) {
goto eeprom_wrsr_err_out;
}
if ((ret = ifx_ssc_tx (cmd, 2)) < 0) {
ifx_ssc_cs_high (EEPROM_CS);
goto eeprom_wrsr_err_out;
}
if ((ret = ifx_ssc_cs_low (EEPROM_CS))) {
goto eeprom_wrsr_err_out;
}
local_irq_restore (flag);
eeprom_wip_over ();
return ret;
eeprom_wrsr_err_out:
local_irq_restore (flag);
eeprom_wip_over ();
return ret;
}
/* Brief: read EEPROM
* Parameter:
* addr
* len
* buf
* Return: ok
* -EFAULT
*/
static int
eeprom_read (u32 addr, unsigned char *buf, u32 len)
{
int ret = 0;
unsigned char write_buf[2];
u32 eff = 0;
unsigned long flag;
while (1) {
eeprom_wip_over ();
eff = EEPROM_PAGE_SIZE - (addr % EEPROM_PAGE_SIZE);
eff = (eff < len) ? eff : len;
//Format:
//CMD + ADDR
local_irq_save (flag);
if ((ret = ifx_ssc_cs_low (EEPROM_CS)) < 0) {
goto eeprom_read_err_out;
}
write_buf[0] = EEPROM_READ | ((u8) ((addr & 0x100) >> 5));
write_buf[1] = (addr & 0xff);
if ((ret = ifx_ssc_txrx (write_buf, 2, buf, eff)) != eff) {
AMAZON_EEPROM_EMSG ("ssc_txrx fails %d\n", ret);
ifx_ssc_cs_high (EEPROM_CS);
goto eeprom_read_err_out;
}
buf += ret;
len -= ret;
addr += ret;
if ((ret = ifx_ssc_cs_high (EEPROM_CS))) {
goto eeprom_read_err_out;
}
local_irq_restore (flag);
if (len <= 0) {
break;
}
}
return ret;
eeprom_read_err_out:
local_irq_restore (flag);
return ret;
}
/* Brief: write EEPROm
* Parameter:
* addr
* len
* buf
* Return: 0 ok
* -EFAULT
*/
static int
eeprom_write (u32 addr, unsigned char *buf, u32 len)
{
int ret = 0;
u32 eff = 0;
unsigned char write_buf[2];
//unsigned char rx_buf[EEPROM_PAGE_SIZE];
//Format:
//CMD + ADDR + DATA (up to EEPROM_PAGE_SIZE)
while (1) {
eeprom_wip_over ();
if ((ret = eeprom_wren ())) {
AMAZON_EEPROM_EMSG ("eeprom_wren fails\n");
return ret;
}
write_buf[0] = EEPROM_WRITE | ((u8) ((addr & 0x100) >> 5));
write_buf[1] = (addr & 0xff);
eff = EEPROM_PAGE_SIZE - (addr % EEPROM_PAGE_SIZE);
eff = (eff < len) ? eff : len;
AMAZON_EEPROM_DMSG ("EEPROM Write:\n");
#if 0
int i;
for (i = 0; i < eff; i++) {
printk ("%2x ", buf[i]);
if (i % 16 == 15)
printk ("\n");
}
printk ("\n");
#endif
if ((ret = ifx_ssc_cs_low (EEPROM_CS))) {
return ret;
}
if ((ret = ifx_ssc_tx (write_buf, 2)) < 0) {
AMAZON_EEPROM_EMSG ("ssc_tx fails %d\n", ret);
ifx_ssc_cs_high (EEPROM_CS);
return ret;
}
if ((ret = ifx_ssc_tx (buf, eff)) != eff) {
AMAZON_EEPROM_EMSG ("ssc_tx fails %d\n", ret);
ifx_ssc_cs_high (EEPROM_CS);
return ret;
}
buf += ret;
len -= ret;
addr += ret;
if ((ret = ifx_ssc_cs_high (EEPROM_CS))) {
return ret;
}
#if 0
printk ("<==");
eeprom_read ((addr - eff), rx_buf, eff);
for (i = 0; i < eff; i++) {
printk ("[%x]", rx_buf[i]);
}
printk ("\n");
#endif
if (len <= 0)
break;
}
return ret;
}
int
danube_eeprom_open (struct inode *inode, struct file *filp)
{
filp->f_pos = 0;
return 0;
}
int
danube_eeprom_close (struct inode *inode, struct file *filp)
{
return 0;
}
int
danube_eeprom_ioctl (struct inode *inode, struct file *filp, unsigned int cmd,
unsigned long data)
{
return 0;
}
ssize_t
danube_eeprom_kread (char *buf, size_t len, u32 addr)
{
int ret = 0;
u32 data;
printk ("addr:=%d\n", addr);
printk ("len:=%d\n", len);
if ((addr + len) > EEPROM_SIZE) {
AMAZON_EEPROM_EMSG ("invalid len\n");
addr = 0;
len = EEPROM_SIZE / 2;
}
if ((ret = ifx_ssc_open ((struct inode *) 0, NULL))) {
AMAZON_EEPROM_EMSG ("danube_eeprom_open fails\n");
goto read_err_out;
}
data = (u32) IFX_SSC_MODE_RXTX;
if ((ret =
ifx_ssc_ioctl ((struct inode *) 0, NULL, IFX_SSC_RXTX_MODE_SET,
(unsigned long) &data))) {
AMAZON_EEPROM_EMSG ("set RXTX mode fails\n");
goto read_err_out;
}
if ((ret = eeprom_wrsr ())) {
AMAZON_EEPROM_EMSG ("EEPROM reset fails\n");
goto read_err_out;
}
if ((ret = eeprom_read (addr, buf, len))) {
AMAZON_EEPROM_EMSG ("eeprom read fails\n");
goto read_err_out;
}
read_err_out:
if (ifx_ssc_close ((struct inode *) 0, NULL)) {
AMAZON_EEPROM_EMSG ("danube_eeprom_close fails\n");
}
return len;
}
EXPORT_SYMBOL (danube_eeprom_kread);
static ssize_t
danube_eeprom_read (struct file *filp, char *ubuf, size_t len, loff_t * off)
{
int ret = 0;
unsigned char ssc_rx_buf[EEPROM_SIZE];
long flag;
if (*off >= EEPROM_SIZE)
return 0;
if (*off + len > EEPROM_SIZE)
len = EEPROM_SIZE - *off;
if (len == 0)
return 0;
local_irq_save (flag);
if ((ret = danube_eeprom_kread (ssc_rx_buf, len, *off)) < 0) {
AMAZON_EEPROM_EMSG ("read fails, err=%x\n", ret);
local_irq_restore (flag);
return ret;
}
if (copy_to_user ((void *) ubuf, ssc_rx_buf, ret) != 0) {
local_irq_restore (flag);
ret = -EFAULT;
}
local_irq_restore (flag);
*off += len;
return len;
}
ssize_t
danube_eeprom_kwrite (char *buf, size_t len, u32 addr)
{
int ret = 0;
u32 data;
if ((ret = ifx_ssc_open ((struct inode *) 0, NULL))) {
AMAZON_EEPROM_EMSG ("danube_eeprom_open fails\n");
goto write_err_out;
}
data = (u32) IFX_SSC_MODE_RXTX;
if ((ret =
ifx_ssc_ioctl ((struct inode *) 0, NULL, IFX_SSC_RXTX_MODE_SET,
(unsigned long) &data))) {
AMAZON_EEPROM_EMSG ("set RXTX mode fails\n");
goto write_err_out;
}
if ((ret = eeprom_wrsr ())) {
AMAZON_EEPROM_EMSG ("EEPROM reset fails\n");
goto write_err_out;
}
if ((ret = eeprom_write (addr, buf, len))) {
AMAZON_EEPROM_EMSG ("eeprom write fails\n");
goto write_err_out;
}
write_err_out:
if (ifx_ssc_close ((struct inode *) 0, NULL)) {
AMAZON_EEPROM_EMSG ("danube_eeprom_close fails\n");
}
return ret;
}
EXPORT_SYMBOL (danube_eeprom_kwrite);
static ssize_t
danube_eeprom_write (struct file *filp, const char *ubuf, size_t len,
loff_t * off)
{
int ret = 0;
unsigned char ssc_tx_buf[EEPROM_SIZE];
if (*off >= EEPROM_SIZE)
return 0;
if (len + *off > EEPROM_SIZE)
len = EEPROM_SIZE - *off;
if ((ret = copy_from_user (ssc_tx_buf, ubuf, len))) {
return EFAULT;
}
ret = danube_eeprom_kwrite (ssc_tx_buf, len, *off);
if (ret > 0) {
*off = ret;
}
return ret;
}
loff_t
danube_eeprom_llseek (struct file * filp, loff_t off, int whence)
{
loff_t newpos;
switch (whence) {
case 0: /*SEEK_SET */
newpos = off;
break;
case 1: /*SEEK_CUR */
newpos = filp->f_pos + off;
break;
default:
return -EINVAL;
}
if (newpos < 0)
return -EINVAL;
filp->f_pos = newpos;
return newpos;
}
static struct file_operations danube_eeprom_fops = {
owner:THIS_MODULE,
llseek:danube_eeprom_llseek,
/* llseek */
read:danube_eeprom_read, /* read */
write:danube_eeprom_write,
/* write */
ioctl:danube_eeprom_ioctl,
/* ioctl */
open:danube_eeprom_open, /* open */
release:danube_eeprom_close,
/* release */
};
int __init
danube_eeprom_init (void)
{
int ret = 0;
if ((ret = register_chrdev (maj, "eeprom", &danube_eeprom_fops)) < 0) {
printk ("Unable to register major %d for the Infineon Amazon EEPROM\n", maj);
if (maj == 0) {
goto errout;
}
else {
maj = 0;
if ((ret =
register_chrdev (maj, "ssc",
&danube_eeprom_fops)) < 0) {
printk ("Unable to register major 0 for the Infineon Amazon EEPROM\n");
goto errout;
}
}
}
if (maj == 0)
maj = ret;
errout:
return ret;
}
void __exit
danube_eeprom_cleanup_module (void)
{
if (unregister_chrdev (maj, "eeprom")) {
printk ("Unable to unregister major %d for the EEPROM\n",
maj);
}
}
module_exit (danube_eeprom_cleanup_module);
module_init (danube_eeprom_init);
#ifndef MODULE
static int __init
danube_eeprom_set_maj (char *str)
{
maj = simple_strtol (str, NULL, 0);
return 1;
}
__setup ("eeprom_maj=", danube_eeprom_set_maj);
#endif /* !MODULE */

View file

@ -81,11 +81,12 @@ Index: linux-2.6.23/drivers/char/watchdog/Makefile
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 @@
+++ linux-2.6.23/drivers/char/Makefile 2007-12-14 22:30:59.000000000 +0100
@@ -135,3 +135,7 @@
rm $@.tmp
endif
+
+obj-$(CONFIG_DANUBE_LED) += danube_led.o
+obj-$(CONFIG_DANUBE_GPIO) += danube_gpio.o
+obj-$(CONFIG_DANUBE_EEPROM) += danube_eeprom.o