Subversion Repositories or1k

/* elan-104nc.c -- MTD map driver for Arcom Control Systems ELAN-104NC

   Copyright (C) 2000 Arcom Control System Ltd

   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

   $Id: elan-104nc.c,v 1.1.1.1 2004-04-15 01:51:51 phoenix Exp $

The ELAN-104NC has up to 8 Mibyte of Intel StrataFlash (28F320/28F640) in x16

mode.  This drivers uses the CFI probe and Intel Extended Command Set drivers.

The flash is accessed as follows:

   32 kbyte memory window at 0xb0000-0xb7fff

   16 bit I/O port (0x22) for some sort of paging.

The single flash device is divided into 3 partition which appear as seperate

MTD devices.

Linux thinks that the I/O port is used by the PIC and hence check_region() will

always fail.  So we don't do it.  I just hope it doesn't break anything.

*/

#include <linux/module.h>

#include <linux/slab.h>

#include <linux/ioport.h>

#include <linux/init.h>

#include <asm/io.h>

#include <linux/mtd/map.h>

#include <linux/mtd/partitions.h>

#define WINDOW_START 0xb0000

/* Number of bits in offset. */

#define WINDOW_SHIFT 15

#define WINDOW_LENGTH (1 << WINDOW_SHIFT)

/* The bits for the offset into the window. */

#define WINDOW_MASK (WINDOW_LENGTH-1)

#define PAGE_IO 0x22

#define PAGE_IO_SIZE 2

static volatile int page_in_window = -1; // Current page in window.

static unsigned long iomapadr;

static spinlock_t elan_104nc_spin = SPIN_LOCK_UNLOCKED;

/* partition_info gives details on the logical partitions that the split the

 * single flash device into. If the size if zero we use up to the end of the

 * device. */

static struct mtd_partition partition_info[]={

    { name: "ELAN-104NC flash boot partition",

      offset: 0,

      size: 640*1024 },

    { name: "ELAN-104NC flash partition 1",

      offset: 640*1024,

      size: 896*1024 },

    { name: "ELAN-104NC flash partition 2",

      offset: (640+896)*1024 }

};

#define NUM_PARTITIONS (sizeof(partition_info)/sizeof(partition_info[0]))

/*

 * If no idea what is going on here.  This is taken from the FlashFX stuff.

 */

#define ROMCS 1

static inline void elan_104nc_setup(void)

{

    u16 t;

    outw( 0x0023 + ROMCS*2, PAGE_IO );

    t=inb( PAGE_IO+1 );

    t=(t & 0xf9) | 0x04;

    outw( ((0x0023 + ROMCS*2) | (t << 8)), PAGE_IO );

}

static inline void elan_104nc_page(struct map_info *map, unsigned long ofs)

{

        unsigned long page = ofs >> WINDOW_SHIFT;

        if( page!=page_in_window ) {

                int cmd1;

                int cmd2;

                cmd1=(page & 0x700) + 0x0833 + ROMCS*0x4000;

                cmd2=((page & 0xff) << 8) + 0x0032;

                outw( cmd1, PAGE_IO );

                outw( cmd2, PAGE_IO );

                page_in_window = page;

        }

}

static __u8 elan_104nc_read8(struct map_info *map, unsigned long ofs)

{

        __u8 ret;

        spin_lock(&elan_104nc_spin);

        elan_104nc_page(map, ofs);

        ret = readb(iomapadr + (ofs & WINDOW_MASK));

        spin_unlock(&elan_104nc_spin);

        return ret;

}

static __u16 elan_104nc_read16(struct map_info *map, unsigned long ofs)

{

        __u16 ret;

        spin_lock(&elan_104nc_spin);

        elan_104nc_page(map, ofs);

        ret = readw(iomapadr + (ofs & WINDOW_MASK));

        spin_unlock(&elan_104nc_spin);

        return ret;

}

static __u32 elan_104nc_read32(struct map_info *map, unsigned long ofs)

{

        __u32 ret;

        spin_lock(&elan_104nc_spin);

        elan_104nc_page(map, ofs);

        ret = readl(iomapadr + (ofs & WINDOW_MASK));

        spin_unlock(&elan_104nc_spin);

        return ret;

}

static void elan_104nc_copy_from(struct map_info *map, void *to, unsigned long from, ssize_t len)

{

        while(len) {

                unsigned long thislen = len;

                if (len > (WINDOW_LENGTH - (from & WINDOW_MASK)))

                        thislen = WINDOW_LENGTH-(from & WINDOW_MASK);

                spin_lock(&elan_104nc_spin);

                elan_104nc_page(map, from);

                memcpy_fromio(to, iomapadr + (from & WINDOW_MASK), thislen);

                spin_unlock(&elan_104nc_spin);

                (__u8*)to += thislen;

                from += thislen;

                len -= thislen;

        }

}

static void elan_104nc_write8(struct map_info *map, __u8 d, unsigned long adr)

{

        spin_lock(&elan_104nc_spin);

        elan_104nc_page(map, adr);

        writeb(d, iomapadr + (adr & WINDOW_MASK));

        spin_unlock(&elan_104nc_spin);

}

static void elan_104nc_write16(struct map_info *map, __u16 d, unsigned long adr)

{

        spin_lock(&elan_104nc_spin);

        elan_104nc_page(map, adr);

        writew(d, iomapadr + (adr & WINDOW_MASK));

        spin_unlock(&elan_104nc_spin);

}

static void elan_104nc_write32(struct map_info *map, __u32 d, unsigned long adr)

{

        spin_lock(&elan_104nc_spin);

        elan_104nc_page(map, adr);

        writel(d, iomapadr + (adr & WINDOW_MASK));

        spin_unlock(&elan_104nc_spin);

}

static void elan_104nc_copy_to(struct map_info *map, unsigned long to, const void *from, ssize_t len)

{

        while(len) {

                unsigned long thislen = len;

                if (len > (WINDOW_LENGTH - (to & WINDOW_MASK)))

                        thislen = WINDOW_LENGTH-(to & WINDOW_MASK);

                spin_lock(&elan_104nc_spin);

                elan_104nc_page(map, to);

                memcpy_toio(iomapadr + (to & WINDOW_MASK), from, thislen);

                spin_unlock(&elan_104nc_spin);

                to += thislen;

                from += thislen;

                len -= thislen;

        }

}

static struct map_info elan_104nc_map = {

        name: "ELAN-104NC flash",

        size: 8*1024*1024, /* this must be set to a maximum possible amount

                        of flash so the cfi probe routines find all

                        the chips */

        buswidth: 2,

        read8: elan_104nc_read8,

        read16: elan_104nc_read16,

        read32: elan_104nc_read32,

        copy_from: elan_104nc_copy_from,

        write8: elan_104nc_write8,

        write16: elan_104nc_write16,

        write32: elan_104nc_write32,

        copy_to: elan_104nc_copy_to

};

/* MTD device for all of the flash. */

static struct mtd_info *all_mtd;

static void cleanup_elan_104nc(void)

{

        if( all_mtd ) {

                del_mtd_partitions( all_mtd );

                map_destroy( all_mtd );

        }

        iounmap((void *)iomapadr);

        release_region(PAGE_IO,PAGE_IO_SIZE);

}

int __init init_elan_104nc(void)

{

        /* Urg! We use I/O port 0x22 without request_region()ing it */

        /*

        if (check_region(PAGE_IO,PAGE_IO_SIZE) != 0) {

                printk( KERN_ERR"%s: IO ports 0x%x-0x%x in use\n",

                        elan_104nc_map.name,

                        PAGE_IO, PAGE_IO+PAGE_IO_SIZE-1 );

                return -EAGAIN;

        }

        */

        iomapadr = (unsigned long)ioremap(WINDOW_START, WINDOW_LENGTH);

        if (!iomapadr) {

                printk( KERN_ERR"%s: failed to ioremap memory region\n",

                        elan_104nc_map.name );

                return -EIO;

        }

        /*

        request_region( PAGE_IO, PAGE_IO_SIZE, "ELAN-104NC flash" );

        */

        printk( KERN_INFO"%s: IO:0x%x-0x%x MEM:0x%x-0x%x\n",

                elan_104nc_map.name,

                PAGE_IO, PAGE_IO+PAGE_IO_SIZE-1,

                WINDOW_START, WINDOW_START+WINDOW_LENGTH-1 );

        elan_104nc_setup();

        /* Probe for chip. */

        all_mtd = do_map_probe("cfi_probe",  &elan_104nc_map );

        if( !all_mtd ) {

                cleanup_elan_104nc();

                return -ENXIO;

        }

        all_mtd->module=THIS_MODULE;

        /* Create MTD devices for each partition. */

        add_mtd_partitions( all_mtd, partition_info, NUM_PARTITIONS );

        return 0;

}

module_init(init_elan_104nc);

module_exit(cleanup_elan_104nc);

MODULE_LICENSE("GPL");

MODULE_AUTHOR("Arcom Control Systems Ltd.");

MODULE_DESCRIPTION("MTD map driver for Arcom Control Systems ELAN-104NC");