1/*
2 * Mapping for Ocotea user flash
3 *
4 * Matt Porter <mporter@kernel.crashing.org>
5 *
6 * Copyright 2002-2004 MontaVista Software Inc.
7 *
8 * This program is free software; you can redistribute  it and/or modify it
9 * under  the terms of  the GNU General  Public License as published by the
10 * Free Software Foundation;  either version 2 of the  License, or (at your
11 * option) any later version.
12 */
13
14#include <linux/module.h>
15#include <linux/types.h>
16#include <linux/kernel.h>
17#include <linux/init.h>
18#include <linux/mtd/mtd.h>
19#include <linux/mtd/map.h>
20#include <linux/mtd/partitions.h>
21#include <asm/io.h>
22#include <asm/ibm44x.h>
23#include <platforms/4xx/ocotea.h>
24
25static struct mtd_info *flash;
26
27static struct map_info ocotea_small_map = {
28	.name =		"Ocotea small flash",
29	.size =		OCOTEA_SMALL_FLASH_SIZE,
30	.buswidth =	1,
31};
32
33static struct map_info ocotea_large_map = {
34	.name =		"Ocotea large flash",
35	.size =		OCOTEA_LARGE_FLASH_SIZE,
36	.buswidth =	1,
37};
38
39static struct mtd_partition ocotea_small_partitions[] = {
40	{
41		.name =   "pibs",
42		.offset = 0x0,
43		.size =   0x100000,
44	}
45};
46
47static struct mtd_partition ocotea_large_partitions[] = {
48	{
49		.name =   "fs",
50		.offset = 0,
51		.size =   0x300000,
52	},
53	{
54		.name =   "firmware",
55		.offset = 0x300000,
56		.size =   0x100000,
57	}
58};
59
60int __init init_ocotea(void)
61{
62	u8 fpga0_reg;
63	u8 *fpga0_adr;
64	unsigned long long small_flash_base, large_flash_base;
65
66	fpga0_adr = ioremap64(OCOTEA_FPGA_ADDR, 16);
67	if (!fpga0_adr)
68		return -ENOMEM;
69
70	fpga0_reg = readb((unsigned long)fpga0_adr);
71	iounmap(fpga0_adr);
72
73	if (OCOTEA_BOOT_LARGE_FLASH(fpga0_reg)) {
74		small_flash_base = OCOTEA_SMALL_FLASH_HIGH;
75		large_flash_base = OCOTEA_LARGE_FLASH_LOW;
76	}
77	else {
78		small_flash_base = OCOTEA_SMALL_FLASH_LOW;
79		large_flash_base = OCOTEA_LARGE_FLASH_HIGH;
80	}
81
82	ocotea_small_map.phys = small_flash_base;
83	ocotea_small_map.virt = ioremap64(small_flash_base,
84					 ocotea_small_map.size);
85
86	if (!ocotea_small_map.virt) {
87		printk("Failed to ioremap flash\n");
88		return -EIO;
89	}
90
91	simple_map_init(&ocotea_small_map);
92
93	flash = do_map_probe("map_rom", &ocotea_small_map);
94	if (flash) {
95		flash->owner = THIS_MODULE;
96		add_mtd_partitions(flash, ocotea_small_partitions,
97					ARRAY_SIZE(ocotea_small_partitions));
98	} else {
99		printk("map probe failed for flash\n");
100		iounmap(ocotea_small_map.virt);
101		return -ENXIO;
102	}
103
104	ocotea_large_map.phys = large_flash_base;
105	ocotea_large_map.virt = ioremap64(large_flash_base,
106					 ocotea_large_map.size);
107
108	if (!ocotea_large_map.virt) {
109		printk("Failed to ioremap flash\n");
110		iounmap(ocotea_small_map.virt);
111		return -EIO;
112	}
113
114	simple_map_init(&ocotea_large_map);
115
116	flash = do_map_probe("cfi_probe", &ocotea_large_map);
117	if (flash) {
118		flash->owner = THIS_MODULE;
119		add_mtd_partitions(flash, ocotea_large_partitions,
120					ARRAY_SIZE(ocotea_large_partitions));
121	} else {
122		printk("map probe failed for flash\n");
123		iounmap(ocotea_small_map.virt);
124		iounmap(ocotea_large_map.virt);
125		return -ENXIO;
126	}
127
128	return 0;
129}
130
131static void __exit cleanup_ocotea(void)
132{
133	if (flash) {
134		del_mtd_partitions(flash);
135		map_destroy(flash);
136	}
137
138	if (ocotea_small_map.virt) {
139		iounmap((void *)ocotea_small_map.virt);
140		ocotea_small_map.virt = 0;
141	}
142
143	if (ocotea_large_map.virt) {
144		iounmap((void *)ocotea_large_map.virt);
145		ocotea_large_map.virt = 0;
146	}
147}
148
149module_init(init_ocotea);
150module_exit(cleanup_ocotea);
151
152MODULE_LICENSE("GPL");
153MODULE_AUTHOR("Matt Porter <mporter@kernel.crashing.org>");
154MODULE_DESCRIPTION("MTD map and partitions for IBM 440GX Ocotea boards");
155