From 88731c199b6c0d769cd768213bd85e31069d8804 Mon Sep 17 00:00:00 2001 From: blogic Date: Thu, 8 Oct 2009 18:40:16 +0000 Subject: several cleanups for ifxmips. removes all code that has not been cleaned up properly git-svn-id: svn://svn.openwrt.org/openwrt/trunk@18008 3c298f89-4303-0410-b956-a3cf2f4a3e73 --- .../ifxmips/files/drivers/char/ifxmips_eeprom.c | 507 --------------------- 1 file changed, 507 deletions(-) delete mode 100644 target/linux/ifxmips/files/drivers/char/ifxmips_eeprom.c (limited to 'target/linux/ifxmips/files/drivers/char/ifxmips_eeprom.c') diff --git a/target/linux/ifxmips/files/drivers/char/ifxmips_eeprom.c b/target/linux/ifxmips/files/drivers/char/ifxmips_eeprom.c deleted file mode 100644 index e1d37934d..000000000 --- a/target/linux/ifxmips/files/drivers/char/ifxmips_eeprom.c +++ /dev/null @@ -1,507 +0,0 @@ -/* - * 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. - * - * 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 - * Based on the VxWorks drivers Copyright(c) 2002, Infineon Technologies. - * - * Copyright(C) 2006 infineon - * Copyright(C) 2007 John Crispin - * - */ - -#define IFAP_EEPROM_DRV_VERSION "0.0.1" - -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -#include -#include -#include - -#include -#include -#include -#include -#include - -/* allow the user to set the major device number */ -static int ifxmips_eeprom_maj; - -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(unsigned int pin); -extern int ifx_ssc_cs_high(unsigned int pin); -extern int ifx_ssc_txrx(char *tx_buf, unsigned int tx_len, char *rx_buf, unsigned int rx_len); -extern int ifx_ssc_tx(char *tx_buf, unsigned int tx_len); -extern int ifx_ssc_rx(char *rx_buf, unsigned int rx_len); - -#define EEPROM_CS IFX_SSC_WHBGPOSTAT_OUT0_POS - -/* commands for EEPROM, x25160, x25140 */ -#define EEPROM_WREN ((unsigned char)0x06) -#define EEPROM_WRDI ((unsigned char)0x04) -#define EEPROM_RDSR ((unsigned char)0x05) -#define EEPROM_WRSR ((unsigned char)0x01) -#define EEPROM_READ ((unsigned char)0x03) -#define EEPROM_WRITE ((unsigned char)0x02) -#define EEPROM_PAGE_SIZE 4 -#define EEPROM_SIZE 512 - -static int eeprom_rdsr(void) -{ - int ret = 0; - unsigned char cmd = EEPROM_RDSR; - unsigned long flag; - char status; - - local_irq_save(flag); - - if ((ret = ifx_ssc_cs_low(EEPROM_CS)) == 0) - if ((ret = ifx_ssc_txrx(&cmd, 1, &status, 1)) >= 0) - ret = status & 1; - - ifx_ssc_cs_high(EEPROM_CS); - local_irq_restore(flag); - - return ret; -} - -void eeprom_wip_over(void) -{ - while (eeprom_rdsr()) - printk(KERN_INFO "waiting for eeprom\n"); -} - -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)) == 0) - if ((ret = ifx_ssc_tx(&cmd, 1)) >= 0) - ret = 0; - - ifx_ssc_cs_high(EEPROM_CS); - local_irq_restore(flag); - - if (!ret) - eeprom_wip_over(); - - return ret; -} - -static int eeprom_wrsr(void) -{ - int ret = 0; - unsigned char cmd[2]; - unsigned long flag; - - cmd[0] = EEPROM_WRSR; - cmd[1] = 0; - - if ((ret = eeprom_wren())) { - printk(KERN_ERR "eeprom_wren fails\n"); - goto out1; - } - - local_irq_save(flag); - - if ((ret = ifx_ssc_cs_low(EEPROM_CS))) - goto out; - - if ((ret = ifx_ssc_tx(cmd, 2)) < 0) { - ifx_ssc_cs_high(EEPROM_CS); - goto out; - } - - if ((ret = ifx_ssc_cs_low(EEPROM_CS))) - goto out; - - local_irq_restore(flag); - eeprom_wip_over(); - - return ret; - -out: - local_irq_restore(flag); - eeprom_wip_over(); - -out1: - return ret; -} - -static int eeprom_read(unsigned int addr, unsigned char *buf, unsigned int len) -{ - int ret = 0; - unsigned char write_buf[2]; - unsigned int eff = 0; - unsigned long flag; - - while (1) { - eeprom_wip_over(); - eff = EEPROM_PAGE_SIZE - (addr % EEPROM_PAGE_SIZE); - eff = (eff < len) ? eff : len; - local_irq_save(flag); - - if ((ret = ifx_ssc_cs_low(EEPROM_CS)) < 0) - goto out; - - write_buf[0] = EEPROM_READ | ((unsigned char)((addr & 0x100) >> 5)); - write_buf[1] = (addr & 0xff); - - ret = ifx_ssc_txrx(write_buf, 2, buf, eff); - if (ret != eff) { - printk(KERN_ERR "ssc_txrx fails %d\n", ret); - ifx_ssc_cs_high(EEPROM_CS); - goto out; - } - - buf += ret; - len -= ret; - addr += ret; - - ret = ifx_ssc_cs_high(EEPROM_CS); - if (ret) - goto out; - - local_irq_restore(flag); - - if (len <= 0) - goto out2; - } - -out: - local_irq_restore(flag); -out2: - return ret; -} - -static int eeprom_write(unsigned int addr, unsigned char *buf, unsigned int len) -{ - int ret = 0; - unsigned int eff = 0; - unsigned char write_buf[2]; - int i; - unsigned char rx_buf[EEPROM_PAGE_SIZE]; - - while (1) { - eeprom_wip_over(); - - if ((ret = eeprom_wren())) { - printk(KERN_ERR "eeprom_wren fails\n"); - goto out; - } - - write_buf[0] = EEPROM_WRITE | ((unsigned char)((addr & 0x100) >> 5)); - write_buf[1] = (addr & 0xff); - - eff = EEPROM_PAGE_SIZE - (addr % EEPROM_PAGE_SIZE); - eff = (eff < len) ? eff : len; - - printk(KERN_INFO "EEPROM Write:\n"); - for (i = 0; i < eff; i++) { - printk("%2x ", buf[i]); - if ((i % 16) == 15) - printk("\n"); - } - printk("\n"); - - if ((ret = ifx_ssc_cs_low(EEPROM_CS))) - goto out; - - if ((ret = ifx_ssc_tx(write_buf, 2)) < 0) { - printk(KERN_ERR "ssc_tx fails %d\n", ret); - ifx_ssc_cs_high(EEPROM_CS); - goto out; - } - - if ((ret = ifx_ssc_tx(buf, eff)) != eff) { - printk(KERN_ERR "ssc_tx fails %d\n", ret); - ifx_ssc_cs_high(EEPROM_CS); - goto out; - } - - buf += ret; - len -= ret; - addr += ret; - - if ((ret = ifx_ssc_cs_high(EEPROM_CS))) - goto out; - - printk(KERN_INFO "<=="); - eeprom_read((addr - eff), rx_buf, eff); - for (i = 0; i < eff; i++) - printk("[%x]", rx_buf[i]); - printk("\n"); - - if (len <= 0) - break; - } - -out: - return ret; -} - -int ifxmips_eeprom_open(struct inode *inode, struct file *filp) -{ - filp->f_pos = 0; - return 0; -} - -int ifxmips_eeprom_close(struct inode *inode, struct file *filp) -{ - return 0; -} - -int ifxmips_eeprom_ioctl(struct inode *inode, struct file *filp, unsigned int cmd, unsigned long data) -{ - return 0; -} - -ssize_t ifxmips_eeprom_read(char *buf, size_t len, unsigned int addr) -{ - int ret = 0; - unsigned int data; - - printk(KERN_INFO "addr:=%d\n", addr); - printk(KERN_INFO "len:=%d\n", len); - - if ((addr + len) > EEPROM_SIZE) { - printk(KERN_ERR "invalid len\n"); - addr = 0; - len = EEPROM_SIZE / 2; - } - - if ((ret = ifx_ssc_open((struct inode *)0, NULL))) { - printk(KERN_ERR "ifxmips_ssc_open fails\n"); - goto out; - } - - data = (unsigned int)IFX_SSC_MODE_RXTX; - - if ((ret = ifx_ssc_ioctl((struct inode *)0, NULL, IFX_SSC_RXTX_MODE_SET, (unsigned long) &data))) { - printk(KERN_ERR "set RXTX mode fails\n"); - goto out; - } - - if ((ret = eeprom_wrsr())) { - printk(KERN_ERR "EEPROM reset fails\n"); - goto out; - } - - if ((ret = eeprom_read(addr, buf, len))) { - printk(KERN_ERR "eeprom read fails\n"); - goto out; - } - -out: - if (ifx_ssc_close((struct inode *)0, NULL)) - printk(KERN_ERR "ifxmips_ssc_close fails\n"); - - return len; -} -EXPORT_SYMBOL(ifxmips_eeprom_read); - -static ssize_t ifxmips_eeprom_fops_read(struct file *filp, char *ubuf, size_t len, loff_t *off) -{ - int ret = 0; - unsigned char ssc_rx_buf[EEPROM_SIZE]; - unsigned 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 = ifxmips_eeprom_read(ssc_rx_buf, len, *off)) < 0) { - printk(KERN_ERR "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 ifxmips_eeprom_write(char *buf, size_t len, unsigned int addr) -{ - int ret = 0; - unsigned int data; - - if ((ret = ifx_ssc_open((struct inode *)0, NULL))) { - printk(KERN_ERR "ifxmips_ssc_open fails\n"); - goto out; - } - - data = (unsigned int) IFX_SSC_MODE_RXTX; - - if ((ret = ifx_ssc_ioctl((struct inode *)0, NULL, IFX_SSC_RXTX_MODE_SET, (unsigned long) &data))) { - printk(KERN_ERR "set RXTX mode fails\n"); - goto out; - } - - if ((ret = eeprom_wrsr())) { - printk(KERN_ERR "EEPROM reset fails\n"); - goto out; - } - - if ((ret = eeprom_write(addr, buf, len))) { - printk(KERN_ERR "eeprom write fails\n"); - goto out; - } - -out: - if (ifx_ssc_close((struct inode *)0, NULL)) - printk(KERN_ERR "ifxmips_ssc_close fails\n"); - - return ret; -} -EXPORT_SYMBOL(ifxmips_eeprom_write); - -static ssize_t ifxmips_eeprom_fops_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 = ifxmips_eeprom_write(ssc_tx_buf, len, *off); - - if (ret > 0) - *off = ret; - - return ret; -} - -loff_t ifxmips_eeprom_llseek(struct file *filp, loff_t off, int whence) -{ - loff_t newpos; - switch (whence) { - case SEEK_SET: - newpos = off; - break; - - case 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 ifxmips_eeprom_fops = { - .owner = THIS_MODULE, - .llseek = ifxmips_eeprom_llseek, - .read = ifxmips_eeprom_fops_read, - .write = ifxmips_eeprom_fops_write, - .ioctl = ifxmips_eeprom_ioctl, - .open = ifxmips_eeprom_open, - .release = ifxmips_eeprom_close, -}; - -int __init ifxmips_eeprom_init(void) -{ - int ret = 0; - - ifxmips_eeprom_maj = register_chrdev(0, "eeprom", &ifxmips_eeprom_fops); - - if (ifxmips_eeprom_maj < 0) { - printk(KERN_ERR "failed to register eeprom device\n"); - ret = -EINVAL; - - goto out; - } - - printk(KERN_INFO "ifxmips_eeprom : /dev/eeprom mayor %d\n", ifxmips_eeprom_maj); - -out: - return ret; -} - -void __exit ifxmips_eeprom_cleanup_module(void) -{ - /*if (unregister_chrdev(ifxmips_eeprom_maj, "eeprom")) { - printk(KERN_ERR "Unable to unregister major %d for the EEPROM\n", - maj); - }*/ -} - -module_exit(ifxmips_eeprom_cleanup_module); -module_init(ifxmips_eeprom_init); - -MODULE_LICENSE("GPL"); -MODULE_AUTHOR("Peng Liu"); -MODULE_DESCRIPTION("IFAP EEPROM driver"); -MODULE_SUPPORTED_DEVICE("ifxmips_eeprom"); - -- cgit v1.2.3