aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/mtd/onenand/onenand_sim.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/mtd/onenand/onenand_sim.c')
-rw-r--r--drivers/mtd/onenand/onenand_sim.c464
1 files changed, 0 insertions, 464 deletions
diff --git a/drivers/mtd/onenand/onenand_sim.c b/drivers/mtd/onenand/onenand_sim.c
deleted file mode 100644
index cb376b206953..000000000000
--- a/drivers/mtd/onenand/onenand_sim.c
+++ /dev/null
@@ -1,464 +0,0 @@
1/*
2 * linux/drivers/mtd/onenand/simulator.c
3 *
4 * The OneNAND simulator
5 *
6 * Copyright(c) 2005 Samsung Electronics
7 * Kyungmin Park <kyungmin.park@samsung.com>
8 */
9
10#include <linux/config.h>
11#include <linux/module.h>
12#include <linux/init.h>
13#include <linux/vmalloc.h>
14#include <linux/mtd/mtd.h>
15#include <linux/mtd/onenand.h>
16
17#include <asm/io.h>
18#include <asm/sizes.h>
19
20#ifndef CONFIG_ONENAND_SIM_MANUFACTURER
21#define CONFIG_ONENAND_SIM_MANUFACTURER 0xec
22#endif
23#ifndef CONFIG_ONENAND_SIM_DEVICE_ID
24#define CONFIG_ONENAND_SIM_DEVICE_ID 0x04
25#endif
26#ifndef CONFIG_ONENAND_SIM_VERSION_ID
27#define CONFIG_ONENAND_SIM_VERSION_ID 0x1e
28#endif
29
30static int manuf_id = CONFIG_ONENAND_SIM_MANUFACTURER;
31static int device_id = CONFIG_ONENAND_SIM_DEVICE_ID;
32static int version_id = CONFIG_ONENAND_SIM_VERSION_ID;
33
34struct onenand_flash {
35 void __iomem *base;
36 void __iomem *data;
37};
38
39#define ONENAND_CORE(flash) (flash->data)
40
41#define ONENAND_MAIN_AREA(this, offset) \
42 (this->base + ONENAND_DATARAM + offset)
43
44#define ONENAND_SPARE_AREA(this, offset) \
45 (this->base + ONENAND_SPARERAM + offset)
46
47#define ONENAND_GET_WP_STATUS(this) \
48 (readw(this->base + ONENAND_REG_WP_STATUS))
49
50#define ONENAND_SET_WP_STATUS(v, this) \
51 (writew(v, this->base + ONENAND_REG_WP_STATUS))
52
53/* It has all 0xff chars */
54static unsigned char *ffchars;
55
56/*
57 * OneNAND simulator mtd
58 */
59struct mtd_info *onenand_sim;
60
61
62/**
63 * onenand_lock_handle - Handle Lock scheme
64 * @param this OneNAND device structure
65 * @param cmd The command to be sent
66 *
67 * Send lock command to OneNAND device.
68 * The lock scheme is depends on chip type.
69 */
70static void onenand_lock_handle(struct onenand_chip *this, int cmd)
71{
72 int block_lock_scheme;
73 int status;
74
75 status = ONENAND_GET_WP_STATUS(this);
76 block_lock_scheme = !(this->options & ONENAND_CONT_LOCK);
77
78 switch (cmd) {
79 case ONENAND_CMD_UNLOCK:
80 if (block_lock_scheme)
81 ONENAND_SET_WP_STATUS(ONENAND_WP_US, this);
82 else
83 ONENAND_SET_WP_STATUS(status | ONENAND_WP_US, this);
84 break;
85
86 case ONENAND_CMD_LOCK:
87 if (block_lock_scheme)
88 ONENAND_SET_WP_STATUS(ONENAND_WP_LS, this);
89 else
90 ONENAND_SET_WP_STATUS(status | ONENAND_WP_LS, this);
91 break;
92
93 case ONENAND_CMD_LOCK_TIGHT:
94 if (block_lock_scheme)
95 ONENAND_SET_WP_STATUS(ONENAND_WP_LTS, this);
96 else
97 ONENAND_SET_WP_STATUS(status | ONENAND_WP_LTS, this);
98 break;
99
100 default:
101 break;
102 }
103}
104
105/**
106 * onenand_bootram_handle - Handle BootRAM area
107 * @param this OneNAND device structure
108 * @param cmd The command to be sent
109 *
110 * Emulate BootRAM area. It is possible to do basic operation using BootRAM.
111 */
112static void onenand_bootram_handle(struct onenand_chip *this, int cmd)
113{
114 switch (cmd) {
115 case ONENAND_CMD_READID:
116 writew(manuf_id, this->base);
117 writew(device_id, this->base + 2);
118 writew(version_id, this->base + 4);
119 break;
120
121 default:
122 /* REVIST: Handle other commands */
123 break;
124 }
125}
126
127/**
128 * onenand_update_interrupt - Set interrupt register
129 * @param this OneNAND device structure
130 * @param cmd The command to be sent
131 *
132 * Update interrupt register. The status is depends on command.
133 */
134static void onenand_update_interrupt(struct onenand_chip *this, int cmd)
135{
136 int interrupt = ONENAND_INT_MASTER;
137
138 switch (cmd) {
139 case ONENAND_CMD_READ:
140 case ONENAND_CMD_READOOB:
141 interrupt |= ONENAND_INT_READ;
142 break;
143
144 case ONENAND_CMD_PROG:
145 case ONENAND_CMD_PROGOOB:
146 interrupt |= ONENAND_INT_WRITE;
147 break;
148
149 case ONENAND_CMD_ERASE:
150 interrupt |= ONENAND_INT_ERASE;
151 break;
152
153 case ONENAND_CMD_RESET:
154 interrupt |= ONENAND_INT_RESET;
155 break;
156
157 default:
158 break;
159 }
160
161 writew(interrupt, this->base + ONENAND_REG_INTERRUPT);
162}
163
164/**
165 * onenand_check_overwrite - Check over-write if happend
166 * @param dest The destination pointer
167 * @param src The source pointer
168 * @param count The length to be check
169 * @return 0 on same, otherwise 1
170 *
171 * Compare the source with destination
172 */
173static int onenand_check_overwrite(void *dest, void *src, size_t count)
174{
175 unsigned int *s = (unsigned int *) src;
176 unsigned int *d = (unsigned int *) dest;
177 int i;
178 count >>= 2;
179
180 for (i = 0; i < count; i++)
181 if ((*s++ ^ *d++) != 0)
182 return 1;
183
184 return 0;
185}
186
187/**
188 * onenand_data_handle - Handle OneNAND Core and DataRAM
189 * @param this OneNAND device structure
190 * @param cmd The command to be sent
191 * @param dataram Which dataram used
192 * @param offset The offset to OneNAND Core
193 *
194 * Copy data from OneNAND Core to DataRAM (read)
195 * Copy data from DataRAM to OneNAND Core (write)
196 * Erase the OneNAND Core (erase)
197 */
198static void onenand_data_handle(struct onenand_chip *this, int cmd,
199 int dataram, unsigned int offset)
200{
201 struct onenand_flash *flash = this->priv;
202 int main_offset, spare_offset;
203 void __iomem *src;
204 void __iomem *dest;
205
206 if (dataram) {
207 main_offset = onenand_sim->oobblock;
208 spare_offset = onenand_sim->oobsize;
209 } else {
210 main_offset = 0;
211 spare_offset = 0;
212 }
213
214 switch (cmd) {
215 case ONENAND_CMD_READ:
216 src = ONENAND_CORE(flash) + offset;
217 dest = ONENAND_MAIN_AREA(this, main_offset);
218 memcpy(dest, src, onenand_sim->oobblock);
219 /* Fall through */
220
221 case ONENAND_CMD_READOOB:
222 src = ONENAND_CORE(flash) + this->chipsize + (offset >> 5);
223 dest = ONENAND_SPARE_AREA(this, spare_offset);
224 memcpy(dest, src, onenand_sim->oobsize);
225 break;
226
227 case ONENAND_CMD_PROG:
228 src = ONENAND_MAIN_AREA(this, main_offset);
229 dest = ONENAND_CORE(flash) + offset;
230 if (memcmp(dest, ffchars, onenand_sim->oobblock) &&
231 onenand_check_overwrite(dest, src, onenand_sim->oobblock))
232 printk(KERN_ERR "over-write happend at 0x%08x\n", offset);
233 memcpy(dest, src, onenand_sim->oobblock);
234 /* Fall through */
235
236 case ONENAND_CMD_PROGOOB:
237 src = ONENAND_SPARE_AREA(this, spare_offset);
238 /* Check all data is 0xff chars */
239 if (!memcmp(src, ffchars, onenand_sim->oobsize))
240 break;
241
242 dest = ONENAND_CORE(flash) + this->chipsize + (offset >> 5);
243 if (memcmp(dest, ffchars, onenand_sim->oobsize) &&
244 onenand_check_overwrite(dest, src, onenand_sim->oobsize))
245 printk(KERN_ERR "OOB: over-write happend at 0x%08x\n", offset);
246 memcpy(dest, src, onenand_sim->oobsize);
247 break;
248
249 case ONENAND_CMD_ERASE:
250 memset(ONENAND_CORE(flash) + offset, 0xff, (1 << this->erase_shift));
251 break;
252
253 default:
254 break;
255 }
256}
257
258/**
259 * onenand_command_handle - Handle command
260 * @param this OneNAND device structure
261 * @param cmd The command to be sent
262 *
263 * Emulate OneNAND command.
264 */
265static void onenand_command_handle(struct onenand_chip *this, int cmd)
266{
267 unsigned long offset = 0;
268 int block = -1, page = -1, bufferram = -1;
269 int dataram = 0;
270
271 switch (cmd) {
272 case ONENAND_CMD_UNLOCK:
273 case ONENAND_CMD_LOCK:
274 case ONENAND_CMD_LOCK_TIGHT:
275 onenand_lock_handle(this, cmd);
276 break;
277
278 case ONENAND_CMD_BUFFERRAM:
279 /* Do nothing */
280 return;
281
282 default:
283 block = (int) readw(this->base + ONENAND_REG_START_ADDRESS1);
284 if (block & (1 << ONENAND_DDP_SHIFT)) {
285 block &= ~(1 << ONENAND_DDP_SHIFT);
286 /* The half of chip block */
287 block += this->chipsize >> (this->erase_shift + 1);
288 }
289 if (cmd == ONENAND_CMD_ERASE)
290 break;
291
292 page = (int) readw(this->base + ONENAND_REG_START_ADDRESS8);
293 page = (page >> ONENAND_FPA_SHIFT);
294 bufferram = (int) readw(this->base + ONENAND_REG_START_BUFFER);
295 bufferram >>= ONENAND_BSA_SHIFT;
296 bufferram &= ONENAND_BSA_DATARAM1;
297 dataram = (bufferram == ONENAND_BSA_DATARAM1) ? 1 : 0;
298 break;
299 }
300
301 if (block != -1)
302 offset += block << this->erase_shift;
303
304 if (page != -1)
305 offset += page << this->page_shift;
306
307 onenand_data_handle(this, cmd, dataram, offset);
308
309 onenand_update_interrupt(this, cmd);
310}
311
312/**
313 * onenand_writew - [OneNAND Interface] Emulate write operation
314 * @param value value to write
315 * @param addr address to write
316 *
317 * Write OneNAND reigser with value
318 */
319static void onenand_writew(unsigned short value, void __iomem *addr)
320{
321 struct onenand_chip *this = onenand_sim->priv;
322
323 /* BootRAM handling */
324 if (addr < this->base + ONENAND_DATARAM) {
325 onenand_bootram_handle(this, value);
326 return;
327 }
328 /* Command handling */
329 if (addr == this->base + ONENAND_REG_COMMAND)
330 onenand_command_handle(this, value);
331
332 writew(value, addr);
333}
334
335/**
336 * flash_init - Initialize OneNAND simulator
337 * @param flash OneNAND simulaotr data strucutres
338 *
339 * Initialize OneNAND simulator.
340 */
341static int __init flash_init(struct onenand_flash *flash)
342{
343 int density, size;
344 int buffer_size;
345
346 flash->base = kmalloc(SZ_128K, GFP_KERNEL);
347 if (!flash->base) {
348 printk(KERN_ERR "Unalbe to allocate base address.\n");
349 return -ENOMEM;
350 }
351
352 memset(flash->base, 0, SZ_128K);
353
354 density = device_id >> ONENAND_DEVICE_DENSITY_SHIFT;
355 size = ((16 << 20) << density);
356
357 ONENAND_CORE(flash) = vmalloc(size + (size >> 5));
358 if (!ONENAND_CORE(flash)) {
359 printk(KERN_ERR "Unalbe to allocate nand core address.\n");
360 kfree(flash->base);
361 return -ENOMEM;
362 }
363
364 memset(ONENAND_CORE(flash), 0xff, size + (size >> 5));
365
366 /* Setup registers */
367 writew(manuf_id, flash->base + ONENAND_REG_MANUFACTURER_ID);
368 writew(device_id, flash->base + ONENAND_REG_DEVICE_ID);
369 writew(version_id, flash->base + ONENAND_REG_VERSION_ID);
370
371 if (density < 2)
372 buffer_size = 0x0400; /* 1KB page */
373 else
374 buffer_size = 0x0800; /* 2KB page */
375 writew(buffer_size, flash->base + ONENAND_REG_DATA_BUFFER_SIZE);
376
377 return 0;
378}
379
380/**
381 * flash_exit - Clean up OneNAND simulator
382 * @param flash OneNAND simulaotr data strucutres
383 *
384 * Clean up OneNAND simulator.
385 */
386static void flash_exit(struct onenand_flash *flash)
387{
388 vfree(ONENAND_CORE(flash));
389 kfree(flash->base);
390 kfree(flash);
391}
392
393static int __init onenand_sim_init(void)
394{
395 struct onenand_chip *this;
396 struct onenand_flash *flash;
397 int len;
398
399 /* Allocate all 0xff chars pointer */
400 ffchars = kmalloc(MAX_ONENAND_PAGESIZE, GFP_KERNEL);
401 if (!ffchars) {
402 printk(KERN_ERR "Unable to allocate ff chars.\n");
403 return -ENOMEM;
404 }
405 memset(ffchars, 0xff, MAX_ONENAND_PAGESIZE);
406
407 len = sizeof(struct mtd_info) + sizeof(struct onenand_chip) + sizeof (struct onenand_flash);
408
409 /* Allocate OneNAND simulator mtd pointer */
410 onenand_sim = kmalloc(len, GFP_KERNEL);
411 if (!onenand_sim) {
412 printk(KERN_ERR "Unable to allocate core structures.\n");
413 kfree(ffchars);
414 return -ENOMEM;
415 }
416
417 memset(onenand_sim, 0, len);
418
419 this = (struct onenand_chip *) (onenand_sim + 1);
420 /* Override write_word function */
421 this->write_word = onenand_writew;
422
423 flash = (struct onenand_flash *) (this + 1);
424
425 if (flash_init(flash)) {
426 printk(KERN_ERR "Unable to allocat flash.\n");
427 kfree(ffchars);
428 kfree(onenand_sim);
429 return -ENOMEM;
430 }
431
432 this->base = flash->base;
433 this->priv = flash;
434 onenand_sim->priv = this;
435
436 if (onenand_scan(onenand_sim, 1)) {
437 kfree(ffchars);
438 kfree(onenand_sim);
439 flash_exit(flash);
440 return -ENXIO;
441 }
442
443 add_mtd_device(onenand_sim);
444
445 return 0;
446}
447
448static void __exit onenand_sim_exit(void)
449{
450 struct onenand_chip *this = onenand_sim->priv;
451 struct onenand_flash *flash = this->priv;
452
453 kfree(ffchars);
454 onenand_release(onenand_sim);
455 flash_exit(flash);
456 kfree(onenand_sim);
457}
458
459module_init(onenand_sim_init);
460module_exit(onenand_sim_exit);
461
462MODULE_LICENSE("GPL");
463MODULE_AUTHOR("Kyungmin Park <kyungmin.park@samsung.com>");
464MODULE_DESCRIPTION("The OneNAND flash simulator");