ts5500_flash.c 2.9 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21
/*
 * ts5500_flash.c -- MTD map driver for Technology Systems TS-5500 board
 *
 * Copyright (C) 2004 Sean Young <sean@mess.org>
 *
 * 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
 *
 * Note:
 * - In order for detection to work, jumper 3 must be set.
22
 * - Drive A and B use the resident flash disk (RFD) flash translation layer. 
L
Linus Torvalds 已提交
23 24 25
 * - If you have created your own jffs file system and the bios overwrites 
 *   it during boot, try disabling Drive A: and B: in the boot order.
 *
26
 * $Id: ts5500_flash.c,v 1.4 2005/06/29 09:29:43 sean Exp $
L
Linus Torvalds 已提交
27 28 29
 */

#include <linux/config.h>
30
#include <linux/init.h>
L
Linus Torvalds 已提交
31 32 33
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/mtd/map.h>
34
#include <linux/mtd/mtd.h>
L
Linus Torvalds 已提交
35
#include <linux/mtd/partitions.h>
36 37
#include <linux/types.h>

L
Linus Torvalds 已提交
38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76

#define WINDOW_ADDR	0x09400000
#define WINDOW_SIZE	0x00200000

static struct map_info ts5500_map = {
	.name = "TS-5500 Flash",
	.size = WINDOW_SIZE,
	.bankwidth = 1,
	.phys = WINDOW_ADDR
};

static struct mtd_partition ts5500_partitions[] = {
	{
		.name = "Drive A",
		.offset = 0,
		.size = 0x0e0000
	},
	{
		.name = "BIOS",
		.offset = 0x0e0000,
		.size = 0x020000,
	},
	{
		.name = "Drive B",
		.offset = 0x100000,
		.size = 0x100000
	}
};

#define NUM_PARTITIONS (sizeof(ts5500_partitions)/sizeof(struct mtd_partition))

static struct mtd_info *mymtd;

static int __init init_ts5500_map(void)
{
	int rc = 0;

	ts5500_map.virt = ioremap_nocache(ts5500_map.phys, ts5500_map.size);

77
	if (!ts5500_map.virt) {
L
Linus Torvalds 已提交
78 79
		printk(KERN_ERR "Failed to ioremap_nocache\n");
		rc = -EIO;
80
		goto err2;
L
Linus Torvalds 已提交
81 82 83 84 85
	}

	simple_map_init(&ts5500_map);

	mymtd = do_map_probe("jedec_probe", &ts5500_map);
86
	if (!mymtd)
L
Linus Torvalds 已提交
87 88
		mymtd = do_map_probe("map_rom", &ts5500_map);

89
	if (!mymtd) {
L
Linus Torvalds 已提交
90
		rc = -ENXIO;
91
		goto err1;
L
Linus Torvalds 已提交
92 93 94 95 96 97 98
	}

	mymtd->owner = THIS_MODULE;
	add_mtd_partitions(mymtd, ts5500_partitions, NUM_PARTITIONS);

	return 0;

99
err1:
L
Linus Torvalds 已提交
100 101
	map_destroy(mymtd);
	iounmap(ts5500_map.virt);
102
err2:
L
Linus Torvalds 已提交
103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125
	return rc;
}

static void __exit cleanup_ts5500_map(void)
{
	if (mymtd) {
		del_mtd_partitions(mymtd);
		map_destroy(mymtd);
	}

	if (ts5500_map.virt) {
		iounmap(ts5500_map.virt);
		ts5500_map.virt = NULL;
	}
}

module_init(init_ts5500_map);
module_exit(cleanup_ts5500_map);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Sean Young <sean@mess.org>");
MODULE_DESCRIPTION("MTD map driver for Techology Systems TS-5500 board");