1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29#include <linux/module.h>
30#include <linux/smp_lock.h>
31#include <linux/types.h>
32#include <linux/errno.h>
33#include <linux/miscdevice.h>
34#include <linux/slab.h>
35#include <linux/fcntl.h>
36#include <linux/poll.h>
37#include <linux/init.h>
38#include <linux/string.h>
39#include <linux/genhd.h>
40#include <linux/blkdev.h>
41#include <asm/uaccess.h>
42#include <asm/pgtable.h>
43#include <asm/io.h>
44#include <asm/pcic.h>
45#include <asm/oplib.h>
46
47#include <asm/jsflash.h>
48#define JSFIDSZ (sizeof(struct jsflash_ident_arg))
49#define JSFPRGSZ (sizeof(struct jsflash_program_arg))
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65#define JSF_MINOR 178
66
67#define JSF_MAX 3
68#define JSF_NPART 3
69#define JSF_PART_BITS 2
70#define JSF_PART_MASK 0x3
71
72
73
74
75
76static unsigned int jsf_inl(unsigned long addr)
77{
78 unsigned long retval;
79
80 __asm__ __volatile__("lda [%1] %2, %0\n\t" :
81 "=r" (retval) :
82 "r" (addr), "i" (ASI_M_BYPASS));
83 return retval;
84}
85
86static void jsf_outl(unsigned long addr, __u32 data)
87{
88
89 __asm__ __volatile__("sta %0, [%1] %2\n\t" : :
90 "r" (data), "r" (addr), "i" (ASI_M_BYPASS) :
91 "memory");
92}
93
94
95
96
97
98struct jsfd_part {
99 unsigned long dbase;
100 unsigned long dsize;
101};
102
103struct jsflash {
104 unsigned long base;
105 unsigned long size;
106 unsigned long busy;
107 struct jsflash_ident_arg id;
108
109 struct jsfd_part dv[JSF_NPART];
110};
111
112
113
114
115
116#define JSF_BASE_TOP 0x30000000
117#define JSF_BASE_ALL 0x20000000
118
119#define JSF_BASE_JK 0x20400000
120
121
122
123static struct gendisk *jsfd_disk[JSF_MAX];
124
125
126
127
128static struct jsflash jsf0;
129
130
131
132
133
134
135
136
137static void jsf_wait(unsigned long p) {
138 unsigned int x1, x2;
139
140 for (;;) {
141 x1 = jsf_inl(p);
142 x2 = jsf_inl(p);
143 if ((x1 & 0x40404040) == (x2 & 0x40404040)) return;
144 }
145}
146
147
148
149
150
151
152
153
154
155
156
157
158static void jsf_write4(unsigned long fa, u32 data) {
159
160 jsf_outl(fa, 0xAAAAAAAA);
161 jsf_outl(fa, 0x55555555);
162 jsf_outl(fa, 0xA0A0A0A0);
163 jsf_outl(fa, data);
164
165 jsf_wait(fa);
166}
167
168
169
170static void jsfd_read(char *buf, unsigned long p, size_t togo) {
171 union byte4 {
172 char s[4];
173 unsigned int n;
174 } b;
175
176 while (togo >= 4) {
177 togo -= 4;
178 b.n = jsf_inl(p);
179 memcpy(buf, b.s, 4);
180 p += 4;
181 buf += 4;
182 }
183}
184
185static void jsfd_do_request(struct request_queue *q)
186{
187 struct request *req;
188
189 req = blk_fetch_request(q);
190 while (req) {
191 struct jsfd_part *jdp = req->rq_disk->private_data;
192 unsigned long offset = blk_rq_pos(req) << 9;
193 size_t len = blk_rq_cur_bytes(req);
194 int err = -EIO;
195
196 if ((offset + len) > jdp->dsize)
197 goto end;
198
199 if (rq_data_dir(req) != READ) {
200 printk(KERN_ERR "jsfd: write\n");
201 goto end;
202 }
203
204 if ((jdp->dbase & 0xff000000) != 0x20000000) {
205 printk(KERN_ERR "jsfd: bad base %x\n", (int)jdp->dbase);
206 goto end;
207 }
208
209 jsfd_read(req->buffer, jdp->dbase + offset, len);
210 err = 0;
211 end:
212 if (!__blk_end_request_cur(req, err))
213 req = blk_fetch_request(q);
214 }
215}
216
217
218
219
220
221
222
223
224
225static loff_t jsf_lseek(struct file * file, loff_t offset, int orig)
226{
227 loff_t ret;
228
229 lock_kernel();
230 switch (orig) {
231 case 0:
232 file->f_pos = offset;
233 ret = file->f_pos;
234 break;
235 case 1:
236 file->f_pos += offset;
237 ret = file->f_pos;
238 break;
239 default:
240 ret = -EINVAL;
241 }
242 unlock_kernel();
243 return ret;
244}
245
246
247
248
249static ssize_t jsf_read(struct file * file, char __user * buf,
250 size_t togo, loff_t *ppos)
251{
252 unsigned long p = *ppos;
253 char __user *tmp = buf;
254
255 union byte4 {
256 char s[4];
257 unsigned int n;
258 } b;
259
260 if (p < JSF_BASE_ALL || p >= JSF_BASE_TOP) {
261 return 0;
262 }
263
264 if ((p + togo) < p
265 || (p + togo) >= JSF_BASE_TOP) {
266 togo = JSF_BASE_TOP - p;
267 }
268
269 if (p < JSF_BASE_ALL && togo != 0) {
270#if 0
271 size_t x = JSF_BASE_ALL - p;
272 if (x > togo) x = togo;
273 clear_user(tmp, x);
274 tmp += x;
275 p += x;
276 togo -= x;
277#else
278
279
280
281
282
283 return 0;
284#endif
285 }
286
287 while (togo >= 4) {
288 togo -= 4;
289 b.n = jsf_inl(p);
290 if (copy_to_user(tmp, b.s, 4))
291 return -EFAULT;
292 tmp += 4;
293 p += 4;
294 }
295
296
297
298
299
300
301 *ppos = p;
302 return tmp-buf;
303}
304
305static ssize_t jsf_write(struct file * file, const char __user * buf,
306 size_t count, loff_t *ppos)
307{
308 return -ENOSPC;
309}
310
311
312
313static int jsf_ioctl_erase(unsigned long arg)
314{
315 unsigned long p;
316
317
318 p = 0x20400000;
319
320 jsf_outl(p, 0xAAAAAAAA);
321 jsf_outl(p, 0x55555555);
322 jsf_outl(p, 0x80808080);
323 jsf_outl(p, 0xAAAAAAAA);
324 jsf_outl(p, 0x55555555);
325 jsf_outl(p, 0x10101010);
326
327#if 0
328
329
330
331
332 {
333 int i;
334 __u32 x;
335 for (i = 0; i < 1000000; i++) {
336 x = jsf_inl(p);
337 if ((x & 0x80808080) == 0x80808080) break;
338 }
339 if ((x & 0x80808080) != 0x80808080) {
340 printk("jsf0: erase timeout with 0x%08x\n", x);
341 } else {
342 printk("jsf0: erase done with 0x%08x\n", x);
343 }
344 }
345#else
346 jsf_wait(p);
347#endif
348
349 return 0;
350}
351
352
353
354
355
356static int jsf_ioctl_program(void __user *arg)
357{
358 struct jsflash_program_arg abuf;
359 char __user *uptr;
360 unsigned long p;
361 unsigned int togo;
362 union {
363 unsigned int n;
364 char s[4];
365 } b;
366
367 if (copy_from_user(&abuf, arg, JSFPRGSZ))
368 return -EFAULT;
369 p = abuf.off;
370 togo = abuf.size;
371 if ((togo & 3) || (p & 3)) return -EINVAL;
372
373 uptr = (char __user *) (unsigned long) abuf.data;
374 while (togo != 0) {
375 togo -= 4;
376 if (copy_from_user(&b.s[0], uptr, 4))
377 return -EFAULT;
378 jsf_write4(p, b.n);
379 p += 4;
380 uptr += 4;
381 }
382
383 return 0;
384}
385
386static long jsf_ioctl(struct file *f, unsigned int cmd, unsigned long arg)
387{
388 lock_kernel();
389 int error = -ENOTTY;
390 void __user *argp = (void __user *)arg;
391
392 if (!capable(CAP_SYS_ADMIN)) {
393 unlock_kernel();
394 return -EPERM;
395 }
396 switch (cmd) {
397 case JSFLASH_IDENT:
398 if (copy_to_user(argp, &jsf0.id, JSFIDSZ)) {
399 unlock_kernel();
400 return -EFAULT;
401 }
402 break;
403 case JSFLASH_ERASE:
404 error = jsf_ioctl_erase(arg);
405 break;
406 case JSFLASH_PROGRAM:
407 error = jsf_ioctl_program(argp);
408 break;
409 }
410
411 unlock_kernel();
412 return error;
413}
414
415static int jsf_mmap(struct file * file, struct vm_area_struct * vma)
416{
417 return -ENXIO;
418}
419
420static int jsf_open(struct inode * inode, struct file * filp)
421{
422 lock_kernel();
423 if (jsf0.base == 0) {
424 unlock_kernel();
425 return -ENXIO;
426 }
427 if (test_and_set_bit(0, (void *)&jsf0.busy) != 0) {
428 unlock_kernel();
429 return -EBUSY;
430 }
431
432 unlock_kernel();
433 return 0;
434}
435
436static int jsf_release(struct inode *inode, struct file *file)
437{
438 jsf0.busy = 0;
439 return 0;
440}
441
442static const struct file_operations jsf_fops = {
443 .owner = THIS_MODULE,
444 .llseek = jsf_lseek,
445 .read = jsf_read,
446 .write = jsf_write,
447 .unlocked_ioctl = jsf_ioctl,
448 .mmap = jsf_mmap,
449 .open = jsf_open,
450 .release = jsf_release,
451};
452
453static struct miscdevice jsf_dev = { JSF_MINOR, "jsflash", &jsf_fops };
454
455static const struct block_device_operations jsfd_fops = {
456 .owner = THIS_MODULE,
457};
458
459static int jsflash_init(void)
460{
461 int rc;
462 struct jsflash *jsf;
463 int node;
464 char banner[128];
465 struct linux_prom_registers reg0;
466
467 node = prom_getchild(prom_root_node);
468 node = prom_searchsiblings(node, "flash-memory");
469 if (node != 0 && node != -1) {
470 if (prom_getproperty(node, "reg",
471 (char *)®0, sizeof(reg0)) == -1) {
472 printk("jsflash: no \"reg\" property\n");
473 return -ENXIO;
474 }
475 if (reg0.which_io != 0) {
476 printk("jsflash: bus number nonzero: 0x%x:%x\n",
477 reg0.which_io, reg0.phys_addr);
478 return -ENXIO;
479 }
480
481
482
483
484#if 0
485 if ((reg0.phys_addr >> 24) != 0x20) {
486 printk("jsflash: suspicious address: 0x%x:%x\n",
487 reg0.which_io, reg0.phys_addr);
488 return -ENXIO;
489 }
490#endif
491 if ((int)reg0.reg_size <= 0) {
492 printk("jsflash: bad size 0x%x\n", (int)reg0.reg_size);
493 return -ENXIO;
494 }
495 } else {
496
497 printk("jsflash: no /flash-memory node, use PROLL >= 12\n");
498 prom_getproperty(prom_root_node, "banner-name", banner, 128);
499 if (strcmp (banner, "JavaStation-NC") != 0 &&
500 strcmp (banner, "JavaStation-E") != 0) {
501 return -ENXIO;
502 }
503 reg0.which_io = 0;
504 reg0.phys_addr = 0x20400000;
505 reg0.reg_size = 0x00800000;
506 }
507
508
509
510 if (sparc_cpu_model != sun4m) {
511
512 return -ENXIO;
513 }
514
515 if (jsf0.base == 0) {
516 jsf = &jsf0;
517
518 jsf->base = reg0.phys_addr;
519 jsf->size = reg0.reg_size;
520
521
522 jsf->id.off = JSF_BASE_ALL;
523 jsf->id.size = 0x01000000;
524 strcpy(jsf->id.name, "Krups_all");
525
526 jsf->dv[0].dbase = jsf->base;
527 jsf->dv[0].dsize = jsf->size;
528 jsf->dv[1].dbase = jsf->base + 1024;
529 jsf->dv[1].dsize = jsf->size - 1024;
530 jsf->dv[2].dbase = JSF_BASE_ALL;
531 jsf->dv[2].dsize = 0x01000000;
532
533 printk("Espresso Flash @0x%lx [%d MB]\n", jsf->base,
534 (int) (jsf->size / (1024*1024)));
535 }
536
537 if ((rc = misc_register(&jsf_dev)) != 0) {
538 printk(KERN_ERR "jsf: unable to get misc minor %d\n",
539 JSF_MINOR);
540 jsf0.base = 0;
541 return rc;
542 }
543
544 return 0;
545}
546
547static struct request_queue *jsf_queue;
548
549static int jsfd_init(void)
550{
551 static DEFINE_SPINLOCK(lock);
552 struct jsflash *jsf;
553 struct jsfd_part *jdp;
554 int err;
555 int i;
556
557 if (jsf0.base == 0)
558 return -ENXIO;
559
560 err = -ENOMEM;
561 for (i = 0; i < JSF_MAX; i++) {
562 struct gendisk *disk = alloc_disk(1);
563 if (!disk)
564 goto out;
565 jsfd_disk[i] = disk;
566 }
567
568 if (register_blkdev(JSFD_MAJOR, "jsfd")) {
569 err = -EIO;
570 goto out;
571 }
572
573 jsf_queue = blk_init_queue(jsfd_do_request, &lock);
574 if (!jsf_queue) {
575 err = -ENOMEM;
576 unregister_blkdev(JSFD_MAJOR, "jsfd");
577 goto out;
578 }
579
580 for (i = 0; i < JSF_MAX; i++) {
581 struct gendisk *disk = jsfd_disk[i];
582 if ((i & JSF_PART_MASK) >= JSF_NPART) continue;
583 jsf = &jsf0;
584 jdp = &jsf->dv[i&JSF_PART_MASK];
585
586 disk->major = JSFD_MAJOR;
587 disk->first_minor = i;
588 sprintf(disk->disk_name, "jsfd%d", i);
589 disk->fops = &jsfd_fops;
590 set_capacity(disk, jdp->dsize >> 9);
591 disk->private_data = jdp;
592 disk->queue = jsf_queue;
593 add_disk(disk);
594 set_disk_ro(disk, 1);
595 }
596 return 0;
597out:
598 while (i--)
599 put_disk(jsfd_disk[i]);
600 return err;
601}
602
603MODULE_LICENSE("GPL");
604
605static int __init jsflash_init_module(void) {
606 int rc;
607
608 if ((rc = jsflash_init()) == 0) {
609 jsfd_init();
610 return 0;
611 }
612 return rc;
613}
614
615static void __exit jsflash_cleanup_module(void)
616{
617 int i;
618
619 for (i = 0; i < JSF_MAX; i++) {
620 if ((i & JSF_PART_MASK) >= JSF_NPART) continue;
621 del_gendisk(jsfd_disk[i]);
622 put_disk(jsfd_disk[i]);
623 }
624 if (jsf0.busy)
625 printk("jsf0: cleaning busy unit\n");
626 jsf0.base = 0;
627 jsf0.busy = 0;
628
629 misc_deregister(&jsf_dev);
630 unregister_blkdev(JSFD_MAJOR, "jsfd");
631 blk_cleanup_queue(jsf_queue);
632}
633
634module_init(jsflash_init_module);
635module_exit(jsflash_cleanup_module);
636