[PATCH] Deref in drivers/block/paride/pf.c
[linux-2.6] / drivers / block / paride / pg.c
1 /* 
2         pg.c    (c) 1998  Grant R. Guenther <grant@torque.net>
3                           Under the terms of the GNU General Public License.
4
5         The pg driver provides a simple character device interface for
6         sending ATAPI commands to a device.  With the exception of the
7         ATAPI reset operation, all operations are performed by a pair
8         of read and write operations to the appropriate /dev/pgN device.
9         A write operation delivers a command and any outbound data in
10         a single buffer.  Normally, the write will succeed unless the
11         device is offline or malfunctioning, or there is already another
12         command pending.  If the write succeeds, it should be followed
13         immediately by a read operation, to obtain any returned data and
14         status information.  A read will fail if there is no operation
15         in progress.
16
17         As a special case, the device can be reset with a write operation,
18         and in this case, no following read is expected, or permitted.
19
20         There are no ioctl() operations.  Any single operation
21         may transfer at most PG_MAX_DATA bytes.  Note that the driver must
22         copy the data through an internal buffer.  In keeping with all
23         current ATAPI devices, command packets are assumed to be exactly
24         12 bytes in length.
25
26         To permit future changes to this interface, the headers in the
27         read and write buffers contain a single character "magic" flag.
28         Currently this flag must be the character "P".
29
30         By default, the driver will autoprobe for a single parallel
31         port ATAPI device, but if their individual parameters are
32         specified, the driver can handle up to 4 devices.
33
34         To use this device, you must have the following device 
35         special files defined:
36
37                 /dev/pg0 c 97 0
38                 /dev/pg1 c 97 1
39                 /dev/pg2 c 97 2
40                 /dev/pg3 c 97 3
41
42         (You'll need to change the 97 to something else if you use
43         the 'major' parameter to install the driver on a different
44         major number.)
45
46         The behaviour of the pg driver can be altered by setting
47         some parameters from the insmod command line.  The following
48         parameters are adjustable:
49
50             drive0      These four arguments can be arrays of       
51             drive1      1-6 integers as follows:
52             drive2
53             drive3      <prt>,<pro>,<uni>,<mod>,<slv>,<dly>
54
55                         Where,
56
57                 <prt>   is the base of the parallel port address for
58                         the corresponding drive.  (required)
59
60                 <pro>   is the protocol number for the adapter that
61                         supports this drive.  These numbers are
62                         logged by 'paride' when the protocol modules
63                         are initialised.  (0 if not given)
64
65                 <uni>   for those adapters that support chained
66                         devices, this is the unit selector for the
67                         chain of devices on the given port.  It should
68                         be zero for devices that don't support chaining.
69                         (0 if not given)
70
71                 <mod>   this can be -1 to choose the best mode, or one
72                         of the mode numbers supported by the adapter.
73                         (-1 if not given)
74
75                 <slv>   ATAPI devices can be jumpered to master or slave.
76                         Set this to 0 to choose the master drive, 1 to
77                         choose the slave, -1 (the default) to choose the
78                         first drive found.
79
80                 <dly>   some parallel ports require the driver to 
81                         go more slowly.  -1 sets a default value that
82                         should work with the chosen protocol.  Otherwise,
83                         set this to a small integer, the larger it is
84                         the slower the port i/o.  In some cases, setting
85                         this to zero will speed up the device. (default -1)
86
87             major       You may use this parameter to overide the
88                         default major number (97) that this driver
89                         will use.  Be sure to change the device
90                         name as well.
91
92             name        This parameter is a character string that
93                         contains the name the kernel will use for this
94                         device (in /proc output, for instance).
95                         (default "pg").
96
97             verbose     This parameter controls the amount of logging
98                         that is done by the driver.  Set it to 0 for 
99                         quiet operation, to 1 to enable progress
100                         messages while the driver probes for devices,
101                         or to 2 for full debug logging.  (default 0)
102
103         If this driver is built into the kernel, you can use 
104         the following command line parameters, with the same values
105         as the corresponding module parameters listed above:
106
107             pg.drive0
108             pg.drive1
109             pg.drive2
110             pg.drive3
111
112         In addition, you can use the parameter pg.disable to disable
113         the driver entirely.
114
115 */
116
117 /* Changes:
118
119         1.01    GRG 1998.06.16  Bug fixes
120         1.02    GRG 1998.09.24  Added jumbo support
121
122 */
123
124 #define PG_VERSION      "1.02"
125 #define PG_MAJOR        97
126 #define PG_NAME         "pg"
127 #define PG_UNITS        4
128
129 #ifndef PI_PG
130 #define PI_PG   4
131 #endif
132
133 /* Here are things one can override from the insmod command.
134    Most are autoprobed by paride unless set here.  Verbose is 0
135    by default.
136
137 */
138
139 static int verbose = 0;
140 static int major = PG_MAJOR;
141 static char *name = PG_NAME;
142 static int disable = 0;
143
144 static int drive0[6] = { 0, 0, 0, -1, -1, -1 };
145 static int drive1[6] = { 0, 0, 0, -1, -1, -1 };
146 static int drive2[6] = { 0, 0, 0, -1, -1, -1 };
147 static int drive3[6] = { 0, 0, 0, -1, -1, -1 };
148
149 static int (*drives[4])[6] = {&drive0, &drive1, &drive2, &drive3};
150 static int pg_drive_count;
151
152 enum {D_PRT, D_PRO, D_UNI, D_MOD, D_SLV, D_DLY};
153
154 /* end of parameters */
155
156 #include <linux/module.h>
157 #include <linux/init.h>
158 #include <linux/fs.h>
159 #include <linux/devfs_fs_kernel.h>
160 #include <linux/delay.h>
161 #include <linux/slab.h>
162 #include <linux/mtio.h>
163 #include <linux/pg.h>
164 #include <linux/device.h>
165 #include <linux/sched.h>        /* current, TASK_* */
166 #include <linux/jiffies.h>
167
168 #include <asm/uaccess.h>
169
170 module_param(verbose, bool, 0644);
171 module_param(major, int, 0);
172 module_param(name, charp, 0);
173 module_param_array(drive0, int, NULL, 0);
174 module_param_array(drive1, int, NULL, 0);
175 module_param_array(drive2, int, NULL, 0);
176 module_param_array(drive3, int, NULL, 0);
177
178 #include "paride.h"
179
180 #define PG_SPIN_DEL     50      /* spin delay in micro-seconds  */
181 #define PG_SPIN         200
182 #define PG_TMO          HZ
183 #define PG_RESET_TMO    10*HZ
184
185 #define STAT_ERR        0x01
186 #define STAT_INDEX      0x02
187 #define STAT_ECC        0x04
188 #define STAT_DRQ        0x08
189 #define STAT_SEEK       0x10
190 #define STAT_WRERR      0x20
191 #define STAT_READY      0x40
192 #define STAT_BUSY       0x80
193
194 #define ATAPI_IDENTIFY          0x12
195
196 static int pg_open(struct inode *inode, struct file *file);
197 static int pg_release(struct inode *inode, struct file *file);
198 static ssize_t pg_read(struct file *filp, char __user *buf,
199                        size_t count, loff_t * ppos);
200 static ssize_t pg_write(struct file *filp, const char __user *buf,
201                         size_t count, loff_t * ppos);
202 static int pg_detect(void);
203
204 #define PG_NAMELEN      8
205
206 struct pg {
207         struct pi_adapter pia;  /* interface to paride layer */
208         struct pi_adapter *pi;
209         int busy;               /* write done, read expected */
210         int start;              /* jiffies at command start */
211         int dlen;               /* transfer size requested */
212         unsigned long timeout;  /* timeout requested */
213         int status;             /* last sense key */
214         int drive;              /* drive */
215         unsigned long access;   /* count of active opens ... */
216         int present;            /* device present ? */
217         char *bufptr;
218         char name[PG_NAMELEN];  /* pg0, pg1, ... */
219 };
220
221 static struct pg devices[PG_UNITS];
222
223 static int pg_identify(struct pg *dev, int log);
224
225 static char pg_scratch[512];    /* scratch block buffer */
226
227 static struct class *pg_class;
228
229 /* kernel glue structures */
230
231 static struct file_operations pg_fops = {
232         .owner = THIS_MODULE,
233         .read = pg_read,
234         .write = pg_write,
235         .open = pg_open,
236         .release = pg_release,
237 };
238
239 static void pg_init_units(void)
240 {
241         int unit;
242
243         pg_drive_count = 0;
244         for (unit = 0; unit < PG_UNITS; unit++) {
245                 int *parm = *drives[unit];
246                 struct pg *dev = &devices[unit];
247                 dev->pi = &dev->pia;
248                 clear_bit(0, &dev->access);
249                 dev->busy = 0;
250                 dev->present = 0;
251                 dev->bufptr = NULL;
252                 dev->drive = parm[D_SLV];
253                 snprintf(dev->name, PG_NAMELEN, "%s%c", name, 'a'+unit);
254                 if (parm[D_PRT])
255                         pg_drive_count++;
256         }
257 }
258
259 static inline int status_reg(struct pg *dev)
260 {
261         return pi_read_regr(dev->pi, 1, 6);
262 }
263
264 static inline int read_reg(struct pg *dev, int reg)
265 {
266         return pi_read_regr(dev->pi, 0, reg);
267 }
268
269 static inline void write_reg(struct pg *dev, int reg, int val)
270 {
271         pi_write_regr(dev->pi, 0, reg, val);
272 }
273
274 static inline u8 DRIVE(struct pg *dev)
275 {
276         return 0xa0+0x10*dev->drive;
277 }
278
279 static void pg_sleep(int cs)
280 {
281         schedule_timeout_interruptible(cs);
282 }
283
284 static int pg_wait(struct pg *dev, int go, int stop, unsigned long tmo, char *msg)
285 {
286         int j, r, e, s, p, to;
287
288         dev->status = 0;
289
290         j = 0;
291         while ((((r = status_reg(dev)) & go) || (stop && (!(r & stop))))
292                && time_before(jiffies, tmo)) {
293                 if (j++ < PG_SPIN)
294                         udelay(PG_SPIN_DEL);
295                 else
296                         pg_sleep(1);
297         }
298
299         to = time_after_eq(jiffies, tmo);
300
301         if ((r & (STAT_ERR & stop)) || to) {
302                 s = read_reg(dev, 7);
303                 e = read_reg(dev, 1);
304                 p = read_reg(dev, 2);
305                 if (verbose > 1)
306                         printk("%s: %s: stat=0x%x err=0x%x phase=%d%s\n",
307                                dev->name, msg, s, e, p, to ? " timeout" : "");
308                 if (to)
309                         e |= 0x100;
310                 dev->status = (e >> 4) & 0xff;
311                 return -1;
312         }
313         return 0;
314 }
315
316 static int pg_command(struct pg *dev, char *cmd, int dlen, unsigned long tmo)
317 {
318         int k;
319
320         pi_connect(dev->pi);
321
322         write_reg(dev, 6, DRIVE(dev));
323
324         if (pg_wait(dev, STAT_BUSY | STAT_DRQ, 0, tmo, "before command"))
325                 goto fail;
326
327         write_reg(dev, 4, dlen % 256);
328         write_reg(dev, 5, dlen / 256);
329         write_reg(dev, 7, 0xa0);        /* ATAPI packet command */
330
331         if (pg_wait(dev, STAT_BUSY, STAT_DRQ, tmo, "command DRQ"))
332                 goto fail;
333
334         if (read_reg(dev, 2) != 1) {
335                 printk("%s: command phase error\n", dev->name);
336                 goto fail;
337         }
338
339         pi_write_block(dev->pi, cmd, 12);
340
341         if (verbose > 1) {
342                 printk("%s: Command sent, dlen=%d packet= ", dev->name, dlen);
343                 for (k = 0; k < 12; k++)
344                         printk("%02x ", cmd[k] & 0xff);
345                 printk("\n");
346         }
347         return 0;
348 fail:
349         pi_disconnect(dev->pi);
350         return -1;
351 }
352
353 static int pg_completion(struct pg *dev, char *buf, unsigned long tmo)
354 {
355         int r, d, n, p;
356
357         r = pg_wait(dev, STAT_BUSY, STAT_DRQ | STAT_READY | STAT_ERR,
358                     tmo, "completion");
359
360         dev->dlen = 0;
361
362         while (read_reg(dev, 7) & STAT_DRQ) {
363                 d = (read_reg(dev, 4) + 256 * read_reg(dev, 5));
364                 n = ((d + 3) & 0xfffc);
365                 p = read_reg(dev, 2) & 3;
366                 if (p == 0)
367                         pi_write_block(dev->pi, buf, n);
368                 if (p == 2)
369                         pi_read_block(dev->pi, buf, n);
370                 if (verbose > 1)
371                         printk("%s: %s %d bytes\n", dev->name,
372                                p ? "Read" : "Write", n);
373                 dev->dlen += (1 - p) * d;
374                 buf += d;
375                 r = pg_wait(dev, STAT_BUSY, STAT_DRQ | STAT_READY | STAT_ERR,
376                             tmo, "completion");
377         }
378
379         pi_disconnect(dev->pi);
380
381         return r;
382 }
383
384 static int pg_reset(struct pg *dev)
385 {
386         int i, k, err;
387         int expect[5] = { 1, 1, 1, 0x14, 0xeb };
388         int got[5];
389
390         pi_connect(dev->pi);
391         write_reg(dev, 6, DRIVE(dev));
392         write_reg(dev, 7, 8);
393
394         pg_sleep(20 * HZ / 1000);
395
396         k = 0;
397         while ((k++ < PG_RESET_TMO) && (status_reg(dev) & STAT_BUSY))
398                 pg_sleep(1);
399
400         for (i = 0; i < 5; i++)
401                 got[i] = read_reg(dev, i + 1);
402
403         err = memcmp(expect, got, sizeof(got)) ? -1 : 0;
404
405         if (verbose) {
406                 printk("%s: Reset (%d) signature = ", dev->name, k);
407                 for (i = 0; i < 5; i++)
408                         printk("%3x", got[i]);
409                 if (err)
410                         printk(" (incorrect)");
411                 printk("\n");
412         }
413
414         pi_disconnect(dev->pi);
415         return err;
416 }
417
418 static void xs(char *buf, char *targ, int len)
419 {
420         char l = '\0';
421         int k;
422
423         for (k = 0; k < len; k++) {
424                 char c = *buf++;
425                 if (c != ' ' || c != l)
426                         l = *targ++ = c;
427         }
428         if (l == ' ')
429                 targ--;
430         *targ = '\0';
431 }
432
433 static int pg_identify(struct pg *dev, int log)
434 {
435         int s;
436         char *ms[2] = { "master", "slave" };
437         char mf[10], id[18];
438         char id_cmd[12] = { ATAPI_IDENTIFY, 0, 0, 0, 36, 0, 0, 0, 0, 0, 0, 0 };
439         char buf[36];
440
441         s = pg_command(dev, id_cmd, 36, jiffies + PG_TMO);
442         if (s)
443                 return -1;
444         s = pg_completion(dev, buf, jiffies + PG_TMO);
445         if (s)
446                 return -1;
447
448         if (log) {
449                 xs(buf + 8, mf, 8);
450                 xs(buf + 16, id, 16);
451                 printk("%s: %s %s, %s\n", dev->name, mf, id, ms[dev->drive]);
452         }
453
454         return 0;
455 }
456
457 /*
458  * returns  0, with id set if drive is detected
459  *         -1, if drive detection failed
460  */
461 static int pg_probe(struct pg *dev)
462 {
463         if (dev->drive == -1) {
464                 for (dev->drive = 0; dev->drive <= 1; dev->drive++)
465                         if (!pg_reset(dev))
466                                 return pg_identify(dev, 1);
467         } else {
468                 if (!pg_reset(dev))
469                         return pg_identify(dev, 1);
470         }
471         return -1;
472 }
473
474 static int pg_detect(void)
475 {
476         struct pg *dev = &devices[0];
477         int k, unit;
478
479         printk("%s: %s version %s, major %d\n", name, name, PG_VERSION, major);
480
481         k = 0;
482         if (pg_drive_count == 0) {
483                 if (pi_init(dev->pi, 1, -1, -1, -1, -1, -1, pg_scratch,
484                             PI_PG, verbose, dev->name)) {
485                         if (!pg_probe(dev)) {
486                                 dev->present = 1;
487                                 k++;
488                         } else
489                                 pi_release(dev->pi);
490                 }
491
492         } else
493                 for (unit = 0; unit < PG_UNITS; unit++, dev++) {
494                         int *parm = *drives[unit];
495                         if (!parm[D_PRT])
496                                 continue;
497                         if (pi_init(dev->pi, 0, parm[D_PRT], parm[D_MOD],
498                                     parm[D_UNI], parm[D_PRO], parm[D_DLY],
499                                     pg_scratch, PI_PG, verbose, dev->name)) {
500                                 if (!pg_probe(dev)) {
501                                         dev->present = 1;
502                                         k++;
503                                 } else
504                                         pi_release(dev->pi);
505                         }
506                 }
507
508         if (k)
509                 return 0;
510
511         printk("%s: No ATAPI device detected\n", name);
512         return -1;
513 }
514
515 static int pg_open(struct inode *inode, struct file *file)
516 {
517         int unit = iminor(inode) & 0x7f;
518         struct pg *dev = &devices[unit];
519
520         if ((unit >= PG_UNITS) || (!dev->present))
521                 return -ENODEV;
522
523         if (test_and_set_bit(0, &dev->access))
524                 return -EBUSY;
525
526         if (dev->busy) {
527                 pg_reset(dev);
528                 dev->busy = 0;
529         }
530
531         pg_identify(dev, (verbose > 1));
532
533         dev->bufptr = kmalloc(PG_MAX_DATA, GFP_KERNEL);
534         if (dev->bufptr == NULL) {
535                 clear_bit(0, &dev->access);
536                 printk("%s: buffer allocation failed\n", dev->name);
537                 return -ENOMEM;
538         }
539
540         file->private_data = dev;
541
542         return 0;
543 }
544
545 static int pg_release(struct inode *inode, struct file *file)
546 {
547         struct pg *dev = file->private_data;
548
549         kfree(dev->bufptr);
550         dev->bufptr = NULL;
551         clear_bit(0, &dev->access);
552
553         return 0;
554 }
555
556 static ssize_t pg_write(struct file *filp, const char __user *buf, size_t count, loff_t *ppos)
557 {
558         struct pg *dev = filp->private_data;
559         struct pg_write_hdr hdr;
560         int hs = sizeof (hdr);
561
562         if (dev->busy)
563                 return -EBUSY;
564         if (count < hs)
565                 return -EINVAL;
566
567         if (copy_from_user(&hdr, buf, hs))
568                 return -EFAULT;
569
570         if (hdr.magic != PG_MAGIC)
571                 return -EINVAL;
572         if (hdr.dlen > PG_MAX_DATA)
573                 return -EINVAL;
574         if ((count - hs) > PG_MAX_DATA)
575                 return -EINVAL;
576
577         if (hdr.func == PG_RESET) {
578                 if (count != hs)
579                         return -EINVAL;
580                 if (pg_reset(dev))
581                         return -EIO;
582                 return count;
583         }
584
585         if (hdr.func != PG_COMMAND)
586                 return -EINVAL;
587
588         dev->start = jiffies;
589         dev->timeout = hdr.timeout * HZ + HZ / 2 + jiffies;
590
591         if (pg_command(dev, hdr.packet, hdr.dlen, jiffies + PG_TMO)) {
592                 if (dev->status & 0x10)
593                         return -ETIME;
594                 return -EIO;
595         }
596
597         dev->busy = 1;
598
599         if (copy_from_user(dev->bufptr, buf + hs, count - hs))
600                 return -EFAULT;
601         return count;
602 }
603
604 static ssize_t pg_read(struct file *filp, char __user *buf, size_t count, loff_t *ppos)
605 {
606         struct pg *dev = filp->private_data;
607         struct pg_read_hdr hdr;
608         int hs = sizeof (hdr);
609         int copy;
610
611         if (!dev->busy)
612                 return -EINVAL;
613         if (count < hs)
614                 return -EINVAL;
615
616         dev->busy = 0;
617
618         if (pg_completion(dev, dev->bufptr, dev->timeout))
619                 if (dev->status & 0x10)
620                         return -ETIME;
621
622         hdr.magic = PG_MAGIC;
623         hdr.dlen = dev->dlen;
624         copy = 0;
625
626         if (hdr.dlen < 0) {
627                 hdr.dlen = -1 * hdr.dlen;
628                 copy = hdr.dlen;
629                 if (copy > (count - hs))
630                         copy = count - hs;
631         }
632
633         hdr.duration = (jiffies - dev->start + HZ / 2) / HZ;
634         hdr.scsi = dev->status & 0x0f;
635
636         if (copy_to_user(buf, &hdr, hs))
637                 return -EFAULT;
638         if (copy > 0)
639                 if (copy_to_user(buf + hs, dev->bufptr, copy))
640                         return -EFAULT;
641         return copy + hs;
642 }
643
644 static int __init pg_init(void)
645 {
646         int unit;
647         int err;
648
649         if (disable){
650                 err = -1;
651                 goto out;
652         }
653
654         pg_init_units();
655
656         if (pg_detect()) {
657                 err = -1;
658                 goto out;
659         }
660
661         err = register_chrdev(major, name, &pg_fops);
662         if (err < 0) {
663                 printk("pg_init: unable to get major number %d\n", major);
664                 for (unit = 0; unit < PG_UNITS; unit++) {
665                         struct pg *dev = &devices[unit];
666                         if (dev->present)
667                                 pi_release(dev->pi);
668                 }
669                 goto out;
670         }
671         major = err;    /* In case the user specified `major=0' (dynamic) */
672         pg_class = class_create(THIS_MODULE, "pg");
673         if (IS_ERR(pg_class)) {
674                 err = PTR_ERR(pg_class);
675                 goto out_chrdev;
676         }
677         devfs_mk_dir("pg");
678         for (unit = 0; unit < PG_UNITS; unit++) {
679                 struct pg *dev = &devices[unit];
680                 if (dev->present) {
681                         class_device_create(pg_class, NULL, MKDEV(major, unit),
682                                         NULL, "pg%u", unit);
683                         err = devfs_mk_cdev(MKDEV(major, unit),
684                                       S_IFCHR | S_IRUSR | S_IWUSR, "pg/%u",
685                                       unit);
686                         if (err) 
687                                 goto out_class;
688                 }
689         }
690         err = 0;
691         goto out;
692
693 out_class:
694         class_device_destroy(pg_class, MKDEV(major, unit));
695         class_destroy(pg_class);
696 out_chrdev:
697         unregister_chrdev(major, "pg");
698 out:
699         return err;
700 }
701
702 static void __exit pg_exit(void)
703 {
704         int unit;
705
706         for (unit = 0; unit < PG_UNITS; unit++) {
707                 struct pg *dev = &devices[unit];
708                 if (dev->present) {
709                         class_device_destroy(pg_class, MKDEV(major, unit));
710                         devfs_remove("pg/%u", unit);
711                 }
712         }
713         class_destroy(pg_class);
714         devfs_remove("pg");
715         unregister_chrdev(major, name);
716
717         for (unit = 0; unit < PG_UNITS; unit++) {
718                 struct pg *dev = &devices[unit];
719                 if (dev->present)
720                         pi_release(dev->pi);
721         }
722 }
723
724 MODULE_LICENSE("GPL");
725 module_init(pg_init)
726 module_exit(pg_exit)