Quelle  cfi_flagadm.c   Sprache: C

/*
 *  Copyright © 2001 Flaga hf. Medical Devices, Kári Davíðsson <kd@flaga.is>
 *
 *  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  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
 *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
 *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
 *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
 *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
 *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
 *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
 *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 *  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.,
 *  675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <asm/io.h>
#include <linux/mtd/mtd.h>
#include <linux/mtd/map.h>
#include <linux/mtd/partitions.h>


/* We split the flash chip up into four parts.
 * 1: bootloader first 128k (0x00000000 - 0x0001FFFF) size 0x020000
 * 2: kernel 640k (0x00020000 - 0x000BFFFF) size 0x0A0000
 * 3: compressed 1536k root ramdisk (0x000C0000 - 0x0023FFFF) size 0x180000
 * 4: writeable diskpartition (jffs)(0x00240000 - 0x003FFFFF) size 0x1C0000
 */

#define FLASH_PHYS_ADDR 0x40000000
#define FLASH_SIZE 0x400000

#define FLASH_PARTITION0_ADDR 0x00000000
#define FLASH_PARTITION0_SIZE 0x00020000

#define FLASH_PARTITION1_ADDR 0x00020000
#define FLASH_PARTITION1_SIZE 0x000A0000

#define FLASH_PARTITION2_ADDR 0x000C0000
#define FLASH_PARTITION2_SIZE 0x00180000

#define FLASH_PARTITION3_ADDR 0x00240000
#define FLASH_PARTITION3_SIZE 0x001C0000


static struct map_info flagadm_map = {
  .name =  "FlagaDM flash device",
  .size =  FLASH_SIZE,
  .bankwidth = 2,
};

static const struct mtd_partition flagadm_parts[] = {
 {
  .name =  "Bootloader",
  .offset = FLASH_PARTITION0_ADDR,
  .size =  FLASH_PARTITION0_SIZE
 },
 {
  .name =  "Kernel image",
  .offset = FLASH_PARTITION1_ADDR,
  .size =  FLASH_PARTITION1_SIZE
 },
 {
  .name =  "Initial ramdisk image",
  .offset = FLASH_PARTITION2_ADDR,
  .size =  FLASH_PARTITION2_SIZE
 },
 {
  .name =  "Persistent storage",
  .offset = FLASH_PARTITION3_ADDR,
  .size =  FLASH_PARTITION3_SIZE
 }
};

#define PARTITION_COUNT ARRAY_SIZE(flagadm_parts)

static struct mtd_info *mymtd;

static int __init init_flagadm(void)
{
 printk(KERN_NOTICE "FlagaDM flash device: %x at %x\n",
   FLASH_SIZE, FLASH_PHYS_ADDR);

 flagadm_map.phys = FLASH_PHYS_ADDR;
 flagadm_map.virt = ioremap(FLASH_PHYS_ADDR,
     FLASH_SIZE);

 if (!flagadm_map.virt) {
  printk("Failed to ioremap\n");
  return -EIO;
 }

 simple_map_init(&flagadm_map);

 mymtd = do_map_probe("cfi_probe", &flagadm_map);
 if (mymtd) {
  mymtd->owner = THIS_MODULE;
  mtd_device_register(mymtd, flagadm_parts, PARTITION_COUNT);
  printk(KERN_NOTICE "FlagaDM flash device initialized\n");
  return 0;
 }

 iounmap((void __iomem *)flagadm_map.virt);
 return -ENXIO;
}

static void __exit cleanup_flagadm(void)
{
 if (mymtd) {
  mtd_device_unregister(mymtd);
  map_destroy(mymtd);
 }
 if (flagadm_map.virt) {
  iounmap((void __iomem *)flagadm_map.virt);
  flagadm_map.virt = NULL;
 }
}

module_init(init_flagadm);
module_exit(cleanup_flagadm);


MODULE_LICENSE("GPL");
MODULE_AUTHOR("Kári Davíðsson ");
MODULE_DESCRIPTION("MTD map driver for Flaga digital module");