Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  1 /*
  2  * Handle mapping of the flash memory access routines
  3  * on TQM8xxL based devices.
  4  *
  5  * $Id: tqm8xxl.c,v 1.15 2005/11/07 11:14:28 gleixner Exp $
  6  *
  7  * based on rpxlite.c
  8  *
  9  * Copyright(C) 2001 Kirk Lee <kirk@hpc.ee.ntu.edu.tw>
 10  *
 11  * This code is GPLed
 12  *
 13  */
 14 
 15 /*
 16  * According to TQM8xxL hardware manual, TQM8xxL series have
 17  * following flash memory organisations:
 18  *      | capacity |    | chip type |   | bank0 |       | bank1 |
 19  *          2MiB           512Kx16        2MiB             0
 20  *          4MiB           1Mx16          4MiB             0
 21  *          8MiB           1Mx16          4MiB             4MiB
 22  * Thus, we choose CONFIG_MTD_CFI_I2 & CONFIG_MTD_CFI_B4 at
 23  * kernel configuration.
 24  */
 25 #include <linux/module.h>
 26 #include <linux/types.h>
 27 #include <linux/kernel.h>
 28 #include <linux/init.h>
 29 #include <linux/slab.h>
 30 
 31 #include <linux/mtd/mtd.h>
 32 #include <linux/mtd/map.h>
 33 #include <linux/mtd/partitions.h>
 34 
 35 #include <asm/io.h>
 36 
 37 #define FLASH_ADDR 0x40000000
 38 #define FLASH_SIZE 0x00800000
 39 #define FLASH_BANK_MAX 4
 40 
 41 // trivial struct to describe partition information
 42 struct mtd_part_def
 43 {
 44         int nums;
 45         unsigned char *type;
 46         struct mtd_partition* mtd_part;
 47 };
 48 
 49 //static struct mtd_info *mymtd;
 50 static struct mtd_info* mtd_banks[FLASH_BANK_MAX];
 51 static struct map_info* map_banks[FLASH_BANK_MAX];
 52 static struct mtd_part_def part_banks[FLASH_BANK_MAX];
 53 static unsigned long num_banks;
 54 static void __iomem *start_scan_addr;
 55 
 56 /*
 57  * Here are partition information for all known TQM8xxL series devices.
 58  * See include/linux/mtd/partitions.h for definition of the mtd_partition
 59  * structure.
 60  *
 61  * The *_max_flash_size is the maximum possible mapped flash size which
 62  * is not necessarily the actual flash size.  It must correspond to the
 63  * value specified in the mapping definition defined by the
 64  * "struct map_desc *_io_desc" for the corresponding machine.
 65  */
 66 
 67 #ifdef CONFIG_MTD_PARTITIONS
 68 /* Currently, TQM8xxL has upto 8MiB flash */
 69 static unsigned long tqm8xxl_max_flash_size = 0x00800000;
 70 
 71 /* partition definition for first flash bank
 72  * (cf. "drivers/char/flash_config.c")
 73  */
 74 static struct mtd_partition tqm8xxl_partitions[] = {
 75         {
 76           .name = "ppcboot",
 77           .offset = 0x00000000,
 78           .size = 0x00020000,           /* 128KB           */
 79           .mask_flags = MTD_WRITEABLE,  /* force read-only */
 80         },
 81         {
 82           .name = "kernel",             /* default kernel image */
 83           .offset = 0x00020000,
 84           .size = 0x000e0000,
 85           .mask_flags = MTD_WRITEABLE,  /* force read-only */
 86         },
 87         {
 88           .name = "user",
 89           .offset = 0x00100000,
 90           .size = 0x00100000,
 91         },
 92         {
 93           .name = "initrd",
 94           .offset = 0x00200000,
 95           .size = 0x00200000,
 96         }
 97 };
 98 /* partition definition for second flash bank */
 99 static struct mtd_partition tqm8xxl_fs_partitions[] = {
100         {
101           .name = "cramfs",
102           .offset = 0x00000000,
103           .size = 0x00200000,
104         },
105         {
106           .name = "jffs",
107           .offset = 0x00200000,
108           .size = 0x00200000,
109           //.size = MTDPART_SIZ_FULL,
110         }
111 };
112 #endif
113 
114 int __init init_tqm_mtd(void)
115 {
116         int idx = 0, ret = 0;
117         unsigned long flash_addr, flash_size, mtd_size = 0;
118         /* pointer to TQM8xxL board info data */
119         bd_t *bd = (bd_t *)__res;
120 
121         flash_addr = bd->bi_flashstart;
122         flash_size = bd->bi_flashsize;
123 
124         //request maximum flash size address space
125         start_scan_addr = ioremap(flash_addr, flash_size);
126         if (!start_scan_addr) {
127                 printk(KERN_WARNING "%s:Failed to ioremap address:0x%x\n", __FUNCTION__, flash_addr);
128                 return -EIO;
129         }
130 
131         for (idx = 0 ; idx < FLASH_BANK_MAX ; idx++) {
132                 if(mtd_size >= flash_size)
133                         break;
134 
135                 printk(KERN_INFO "%s: chip probing count %d\n", __FUNCTION__, idx);
136 
137                 map_banks[idx] = kzalloc(sizeof(struct map_info), GFP_KERNEL);
138                 if(map_banks[idx] == NULL) {
139                         ret = -ENOMEM;
140                         /* FIXME: What if some MTD devices were probed already? */
141                         goto error_mem;
142                 }
143 
144                 map_banks[idx]->name = (char *)kmalloc(16, GFP_KERNEL);
145 
146                 if (!map_banks[idx]->name) {
147                         ret = -ENOMEM;
148                         /* FIXME: What if some MTD devices were probed already? */
149                         goto error_mem;
150                 }
151                 sprintf(map_banks[idx]->name, "TQM8xxL%d", idx);
152 
153                 map_banks[idx]->size = flash_size;
154                 map_banks[idx]->bankwidth = 4;
155 
156                 simple_map_init(map_banks[idx]);
157 
158                 map_banks[idx]->virt = start_scan_addr;
159                 map_banks[idx]->phys = flash_addr;
160                 /* FIXME: This looks utterly bogus, but I'm trying to
161                    preserve the behaviour of the original (shown here)...
162 
163                 map_banks[idx]->map_priv_1 =
164                 start_scan_addr + ((idx > 0) ?
165                 (mtd_banks[idx-1] ? mtd_banks[idx-1]->size : 0) : 0);
166                 */
167 
168                 if (idx && mtd_banks[idx-1]) {
169                         map_banks[idx]->virt += mtd_banks[idx-1]->size;
170                         map_banks[idx]->phys += mtd_banks[idx-1]->size;
171                 }
172 
173                 //start to probe flash chips
174                 mtd_banks[idx] = do_map_probe("cfi_probe", map_banks[idx]);
175 
176                 if (mtd_banks[idx]) {
177                         mtd_banks[idx]->owner = THIS_MODULE;
178                         mtd_size += mtd_banks[idx]->size;
179                         num_banks++;
180 
181                         printk(KERN_INFO "%s: bank%d, name:%s, size:%dbytes \n", __FUNCTION__, num_banks,
182                         mtd_banks[idx]->name, mtd_banks[idx]->size);
183                 }
184         }
185 
186         /* no supported flash chips found */
187         if (!num_banks) {
188                 printk(KERN_NOTICE "TQM8xxL: No support flash chips found!\n");
189                 ret = -ENXIO;
190                 goto error_mem;
191         }
192 
193 #ifdef CONFIG_MTD_PARTITIONS
194         /*
195          * Select Static partition definitions
196          */
197         part_banks[0].mtd_part = tqm8xxl_partitions;
198         part_banks[0].type = "Static image";
199         part_banks[0].nums = ARRAY_SIZE(tqm8xxl_partitions);
200 
201         part_banks[1].mtd_part = tqm8xxl_fs_partitions;
202         part_banks[1].type = "Static file system";
203         part_banks[1].nums = ARRAY_SIZE(tqm8xxl_fs_partitions);
204 
205         for(idx = 0; idx < num_banks ; idx++) {
206                 if (part_banks[idx].nums == 0) {
207                         printk(KERN_NOTICE "TQM flash%d: no partition info available, registering whole flash at once\n", idx);
208                         add_mtd_device(mtd_banks[idx]);
209                 } else {
210                         printk(KERN_NOTICE "TQM flash%d: Using %s partition definition\n",
211                                         idx, part_banks[idx].type);
212                         add_mtd_partitions(mtd_banks[idx], part_banks[idx].mtd_part,
213                                                                 part_banks[idx].nums);
214                 }
215         }
216 #else
217         printk(KERN_NOTICE "TQM flash: registering %d whole flash banks at once\n", num_banks);
218         for(idx = 0 ; idx < num_banks ; idx++)
219                 add_mtd_device(mtd_banks[idx]);
220 #endif
221         return 0;
222 error_mem:
223         for(idx = 0 ; idx < FLASH_BANK_MAX ; idx++) {
224                 if(map_banks[idx] != NULL) {
225                         kfree(map_banks[idx]->name);
226                         map_banks[idx]->name = NULL;
227                         kfree(map_banks[idx]);
228                         map_banks[idx] = NULL;
229                 }
230         }
231 error:
232         iounmap(start_scan_addr);
233         return ret;
234 }
235 
236 static void __exit cleanup_tqm_mtd(void)
237 {
238         unsigned int idx = 0;
239         for(idx = 0 ; idx < num_banks ; idx++) {
240                 /* destroy mtd_info previously allocated */
241                 if (mtd_banks[idx]) {
242                         del_mtd_partitions(mtd_banks[idx]);
243                         map_destroy(mtd_banks[idx]);
244                 }
245                 /* release map_info not used anymore */
246                 kfree(map_banks[idx]->name);
247                 kfree(map_banks[idx]);
248         }
249 
250         if (start_scan_addr) {
251                 iounmap(start_scan_addr);
252                 start_scan_addr = 0;
253         }
254 }
255 
256 module_init(init_tqm_mtd);
257 module_exit(cleanup_tqm_mtd);
258 
259 MODULE_LICENSE("GPL");
260 MODULE_AUTHOR("Kirk Lee <kirk@hpc.ee.ntu.edu.tw>");
261 MODULE_DESCRIPTION("MTD map driver for TQM8xxL boards");
262 
  This page was automatically generated by the LXR engine.