]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/scsi/ch.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
[SCSI] aic7xxx: fix timer handling bug
[net-next-2.6.git] / drivers / scsi / ch.c
CommitLineData
daa6eda6
GK		 1/*
2 * SCSI Media Changer device driver for Linux 2.6
3 *
4 * (c) 1996-2003 Gerd Knorr <kraxel@bytesex.org>
5 *
6 */
7
8#define VERSION "0.25"
9
10#include <linux/config.h>
11#include <linux/module.h>
12#include <linux/init.h>
13#include <linux/fs.h>
14#include <linux/kernel.h>
15#include <linux/sched.h>
16#include <linux/mm.h>
17#include <linux/major.h>
18#include <linux/string.h>
19#include <linux/errno.h>
20#include <linux/interrupt.h>
21#include <linux/blkdev.h>
22#include <linux/completion.h>
daa6eda6
GK		 23#include <linux/compat.h>
24#include <linux/chio.h> /* here are all the ioctls */
25
26#include <scsi/scsi.h>
27#include <scsi/scsi_cmnd.h>
28#include <scsi/scsi_driver.h>
29#include <scsi/scsi_ioctl.h>
30#include <scsi/scsi_host.h>
31#include <scsi/scsi_device.h>
84743bbc 32#include <scsi/scsi_eh.h>
daa6eda6
GK		 33#include <scsi/scsi_dbg.h>
34
35#define CH_DT_MAX 16
36#define CH_TYPES 8
37
38MODULE_DESCRIPTION("device driver for scsi media changer devices");
39MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org>");
40MODULE_LICENSE("GPL");
41
42static int init = 1;
43module_param(init, int, 0444);
44MODULE_PARM_DESC(init, \
45 "initialize element status on driver load (default: on)");
46
47static int timeout_move = 300;
48module_param(timeout_move, int, 0644);
49MODULE_PARM_DESC(timeout_move,"timeout for move commands "
50 "(default: 300 seconds)");
51
52static int timeout_init = 3600;
53module_param(timeout_init, int, 0644);
54MODULE_PARM_DESC(timeout_init,"timeout for INITIALIZE ELEMENT STATUS "
55 "(default: 3600 seconds)");
56
57static int verbose = 1;
58module_param(verbose, int, 0644);
59MODULE_PARM_DESC(verbose,"be verbose (default: on)");
60
61static int debug = 0;
62module_param(debug, int, 0644);
63MODULE_PARM_DESC(debug,"enable/disable debug messages, also prints more "
64 "detailed sense codes on scsi errors (default: off)");
65
66static int dt_id[CH_DT_MAX] = { [ 0 ... (CH_DT_MAX-1) ] = -1 };
67static int dt_lun[CH_DT_MAX];
68module_param_array(dt_id, int, NULL, 0444);
69module_param_array(dt_lun, int, NULL, 0444);
70
71/* tell the driver about vendor-specific slots */
72static int vendor_firsts[CH_TYPES-4];
73static int vendor_counts[CH_TYPES-4];
74module_param_array(vendor_firsts, int, NULL, 0444);
75module_param_array(vendor_counts, int, NULL, 0444);
76
0ad78200 77static const char * vendor_labels[CH_TYPES-4] = {
daa6eda6
GK		 78 "v0", "v1", "v2", "v3"
79};
80// module_param_string_array(vendor_labels, NULL, 0444);
81
82#define dprintk(fmt, arg...) if (debug) \
83 printk(KERN_DEBUG "%s: " fmt, ch->name , ## arg)
84#define vprintk(fmt, arg...) if (verbose) \
85 printk(KERN_INFO "%s: " fmt, ch->name , ## arg)
86
87/* ------------------------------------------------------------------- */
88
89#define MAX_RETRIES 1
90
91static int ch_probe(struct device *);
92static int ch_remove(struct device *);
93static int ch_open(struct inode * inode, struct file * filp);
94static int ch_release(struct inode * inode, struct file * filp);
95static int ch_ioctl(struct inode * inode, struct file * filp,
96 unsigned int cmd, unsigned long arg);
97#ifdef CONFIG_COMPAT
98static long ch_ioctl_compat(struct file * filp,
99 unsigned int cmd, unsigned long arg);
100#endif
101
21feb5cc 102static struct class * ch_sysfs_class;
daa6eda6
GK		 103
104typedef struct {
105 struct list_head list;
106 int minor;
107 char name[8];
108 struct scsi_device *device;
109 struct scsi_device **dt; /* ptrs to data transfer elements */
110 u_int firsts[CH_TYPES];
111 u_int counts[CH_TYPES];
112 u_int unit_attention;
113 u_int voltags;
114 struct semaphore lock;
115} scsi_changer;
116
117static LIST_HEAD(ch_devlist);
a9f6a0dd 118static DEFINE_SPINLOCK(ch_devlist_lock);
daa6eda6
GK		 119static int ch_devcount;
120
121static struct scsi_driver ch_template =
122{
123 .owner = THIS_MODULE,
124 .gendrv = {
125 .name = "ch",
126 .probe = ch_probe,
127 .remove = ch_remove,
128 },
129};
130
131static struct file_operations changer_fops =
132{
133 .owner = THIS_MODULE,
134 .open = ch_open,
135 .release = ch_release,
136 .ioctl = ch_ioctl,
137#ifdef CONFIG_COMPAT
138 .compat_ioctl = ch_ioctl_compat,
139#endif
140};
141
0ad78200 142static const struct {
daa6eda6
GK		 143 unsigned char sense;
144 unsigned char asc;
145 unsigned char ascq;
146 int errno;
147} err[] = {
148/* Just filled in what looks right. Hav'nt checked any standard paper for
149 these errno assignments, so they may be wrong... */
150 {
151 .sense = ILLEGAL_REQUEST,
152 .asc = 0x21,
153 .ascq = 0x01,
154 .errno = EBADSLT, /* Invalid element address */
155 },{
156 .sense = ILLEGAL_REQUEST,
157 .asc = 0x28,
158 .ascq = 0x01,
159 .errno = EBADE, /* Import or export element accessed */
160 },{
161 .sense = ILLEGAL_REQUEST,
162 .asc = 0x3B,
163 .ascq = 0x0D,
164 .errno = EXFULL, /* Medium destination element full */
165 },{
166 .sense = ILLEGAL_REQUEST,
167 .asc = 0x3B,
168 .ascq = 0x0E,
169 .errno = EBADE, /* Medium source element empty */
170 },{
171 .sense = ILLEGAL_REQUEST,
172 .asc = 0x20,
173 .ascq = 0x00,
174 .errno = EBADRQC, /* Invalid command operation code */
175 },{
176 /* end of list */
177 }
178};
179
180/* ------------------------------------------------------------------- */
181
84743bbc 182static int ch_find_errno(struct scsi_sense_hdr *sshdr)
daa6eda6
GK		 183{
184 int i,errno = 0;
185
186 /* Check to see if additional sense information is available */
84743bbc
JB		 187 if (scsi_sense_valid(sshdr) &&
188 sshdr->asc != 0) {
daa6eda6 189 for (i = 0; err[i].errno != 0; i++) {
84743bbc
JB		 190 if (err[i].sense == sshdr->sense_key &&
191 err[i].asc == sshdr->asc &&
192 err[i].ascq == sshdr->ascq) {
daa6eda6
GK		 193 errno = -err[i].errno;
194 break;
195 }
196 }
197 }
198 if (errno == 0)
199 errno = -EIO;
200 return errno;
201}
202
203static int
204ch_do_scsi(scsi_changer *ch, unsigned char *cmd,
205 void *buffer, unsigned buflength,
206 enum dma_data_direction direction)
207{
84743bbc
JB		 208 int errno, retries = 0, timeout, result;
209 struct scsi_sense_hdr sshdr;
daa6eda6 210
daa6eda6
GK		 211 timeout = (cmd[0] == INITIALIZE_ELEMENT_STATUS)
212 ? timeout_init : timeout_move;
213
214 retry:
215 errno = 0;
216 if (debug) {
217 dprintk("command: ");
218 __scsi_print_command(cmd);
219 }
220
84743bbc
JB		 221 result = scsi_execute_req(ch->device, cmd, direction, buffer,
222 buflength, &sshdr, timeout * HZ,
223 MAX_RETRIES);
daa6eda6 224
84743bbc
JB		 225 dprintk("result: 0x%x\n",result);
226 if (driver_byte(result) & DRIVER_SENSE) {
daa6eda6 227 if (debug)
84743bbc
JB		 228 scsi_print_sense_hdr(ch->name, &sshdr);
229 errno = ch_find_errno(&sshdr);
daa6eda6 230
84743bbc 231 switch(sshdr.sense_key) {
daa6eda6
GK		 232 case UNIT_ATTENTION:
233 ch->unit_attention = 1;
234 if (retries++ < 3)
235 goto retry;
236 break;
237 }
238 }
daa6eda6
GK		 239 return errno;
240}
241
242/* ------------------------------------------------------------------------ */
243
244static int
245ch_elem_to_typecode(scsi_changer *ch, u_int elem)
246{
247 int i;
248
249 for (i = 0; i < CH_TYPES; i++) {
250 if (elem >= ch->firsts[i] &&
251 elem < ch->firsts[i] +
252 ch->counts[i])
253 return i+1;
254 }
255 return 0;
256}
257
258static int
259ch_read_element_status(scsi_changer *ch, u_int elem, char *data)
260{
261 u_char cmd[12];
262 u_char *buffer;
263 int result;
264
265 buffer = kmalloc(512, GFP_KERNEL | GFP_DMA);
266 if(!buffer)
267 return -ENOMEM;
268
269 retry:
270 memset(cmd,0,sizeof(cmd));
271 cmd[0] = READ_ELEMENT_STATUS;
272 cmd[1] = (ch->device->lun << 5) |
273 (ch->voltags ? 0x10 : 0) |
274 ch_elem_to_typecode(ch,elem);
275 cmd[2] = (elem >> 8) & 0xff;
276 cmd[3] = elem & 0xff;
277 cmd[5] = 1;
278 cmd[9] = 255;
279 if (0 == (result = ch_do_scsi(ch, cmd, buffer, 256, DMA_FROM_DEVICE))) {
280 if (((buffer[16] << 8) | buffer[17]) != elem) {
281 dprintk("asked for element 0x%02x, got 0x%02x\n",
282 elem,(buffer[16] << 8) | buffer[17]);
283 kfree(buffer);
284 return -EIO;
285 }
286 memcpy(data,buffer+16,16);
287 } else {
288 if (ch->voltags) {
289 ch->voltags = 0;
290 vprintk("device has no volume tag support\n");
291 goto retry;
292 }
293 dprintk("READ ELEMENT STATUS for element 0x%x failed\n",elem);
294 }
295 kfree(buffer);
296 return result;
297}
298
299static int
300ch_init_elem(scsi_changer *ch)
301{
302 int err;
303 u_char cmd[6];
304
305 vprintk("INITIALIZE ELEMENT STATUS, may take some time ...\n");
306 memset(cmd,0,sizeof(cmd));
307 cmd[0] = INITIALIZE_ELEMENT_STATUS;
308 cmd[1] = ch->device->lun << 5;
309 err = ch_do_scsi(ch, cmd, NULL, 0, DMA_NONE);
310 vprintk("... finished\n");
311 return err;
312}
313
314static int
315ch_readconfig(scsi_changer *ch)
316{
317 u_char cmd[10], data[16];
318 u_char *buffer;
319 int result,id,lun,i;
320 u_int elem;
321
322 buffer = kmalloc(512, GFP_KERNEL | GFP_DMA);
323 if (!buffer)
324 return -ENOMEM;
325 memset(buffer,0,512);
326
327 memset(cmd,0,sizeof(cmd));
328 cmd[0] = MODE_SENSE;
329 cmd[1] = ch->device->lun << 5;
330 cmd[2] = 0x1d;
331 cmd[4] = 255;
332 result = ch_do_scsi(ch, cmd, buffer, 255, DMA_FROM_DEVICE);
333 if (0 != result) {
334 cmd[1] |= (1<<3);
335 result = ch_do_scsi(ch, cmd, buffer, 255, DMA_FROM_DEVICE);
336 }
337 if (0 == result) {
338 ch->firsts[CHET_MT] =
339 (buffer[buffer[3]+ 6] << 8) | buffer[buffer[3]+ 7];
340 ch->counts[CHET_MT] =
341 (buffer[buffer[3]+ 8] << 8) | buffer[buffer[3]+ 9];
342 ch->firsts[CHET_ST] =
343 (buffer[buffer[3]+10] << 8) | buffer[buffer[3]+11];
344 ch->counts[CHET_ST] =
345 (buffer[buffer[3]+12] << 8) | buffer[buffer[3]+13];
346 ch->firsts[CHET_IE] =
347 (buffer[buffer[3]+14] << 8) | buffer[buffer[3]+15];
348 ch->counts[CHET_IE] =
349 (buffer[buffer[3]+16] << 8) | buffer[buffer[3]+17];
350 ch->firsts[CHET_DT] =
351 (buffer[buffer[3]+18] << 8) | buffer[buffer[3]+19];
352 ch->counts[CHET_DT] =
353 (buffer[buffer[3]+20] << 8) | buffer[buffer[3]+21];
354 vprintk("type #1 (mt): 0x%x+%d [medium transport]\n",
355 ch->firsts[CHET_MT],
356 ch->counts[CHET_MT]);
357 vprintk("type #2 (st): 0x%x+%d [storage]\n",
358 ch->firsts[CHET_ST],
359 ch->counts[CHET_ST]);
360 vprintk("type #3 (ie): 0x%x+%d [import/export]\n",
361 ch->firsts[CHET_IE],
362 ch->counts[CHET_IE]);
363 vprintk("type #4 (dt): 0x%x+%d [data transfer]\n",
364 ch->firsts[CHET_DT],
365 ch->counts[CHET_DT]);
366 } else {
367 vprintk("reading element address assigment page failed!\n");
368 }
369
370 /* vendor specific element types */
371 for (i = 0; i < 4; i++) {
372 if (0 == vendor_counts[i])
373 continue;
374 if (NULL == vendor_labels[i])
375 continue;
376 ch->firsts[CHET_V1+i] = vendor_firsts[i];
377 ch->counts[CHET_V1+i] = vendor_counts[i];
378 vprintk("type #%d (v%d): 0x%x+%d [%s, vendor specific]\n",
379 i+5,i+1,vendor_firsts[i],vendor_counts[i],
380 vendor_labels[i]);
381 }
382
383 /* look up the devices of the data transfer elements */
384 ch->dt = kmalloc(ch->counts[CHET_DT]*sizeof(struct scsi_device),
385 GFP_KERNEL);
386 for (elem = 0; elem < ch->counts[CHET_DT]; elem++) {
387 id = -1;
388 lun = 0;
389 if (elem < CH_DT_MAX && -1 != dt_id[elem]) {
390 id = dt_id[elem];
391 lun = dt_lun[elem];
392 vprintk("dt 0x%x: [insmod option] ",
393 elem+ch->firsts[CHET_DT]);
394 } else if (0 != ch_read_element_status
395 (ch,elem+ch->firsts[CHET_DT],data)) {
396 vprintk("dt 0x%x: READ ELEMENT STATUS failed\n",
397 elem+ch->firsts[CHET_DT]);
398 } else {
399 vprintk("dt 0x%x: ",elem+ch->firsts[CHET_DT]);
400 if (data[6] & 0x80) {
401 if (verbose)
402 printk("not this SCSI bus\n");
403 ch->dt[elem] = NULL;
404 } else if (0 == (data[6] & 0x30)) {
405 if (verbose)
406 printk("ID/LUN unknown\n");
407 ch->dt[elem] = NULL;
408 } else {
409 id = ch->device->id;
410 lun = 0;
411 if (data[6] & 0x20) id = data[7];
412 if (data[6] & 0x10) lun = data[6] & 7;
413 }
414 }
415 if (-1 != id) {
416 if (verbose)
417 printk("ID %i, LUN %i, ",id,lun);
418 ch->dt[elem] =
419 scsi_device_lookup(ch->device->host,
420 ch->device->channel,
421 id,lun);
422 if (!ch->dt[elem]) {
423 /* should not happen */
424 if (verbose)
425 printk("Huh? device not found!\n");
426 } else {
427 if (verbose)
428 printk("name: %8.8s %16.16s %4.4s\n",
429 ch->dt[elem]->vendor,
430 ch->dt[elem]->model,
431 ch->dt[elem]->rev);
432 }
433 }
434 }
435 ch->voltags = 1;
436 kfree(buffer);
437
438 return 0;
439}
440
441/* ------------------------------------------------------------------------ */
442
443static int
444ch_position(scsi_changer *ch, u_int trans, u_int elem, int rotate)
445{
446 u_char cmd[10];
447
448 dprintk("position: 0x%x\n",elem);
449 if (0 == trans)
450 trans = ch->firsts[CHET_MT];
451 memset(cmd,0,sizeof(cmd));
452 cmd[0] = POSITION_TO_ELEMENT;
453 cmd[1] = ch->device->lun << 5;
454 cmd[2] = (trans >> 8) & 0xff;
455 cmd[3] = trans & 0xff;
456 cmd[4] = (elem >> 8) & 0xff;
457 cmd[5] = elem & 0xff;
458 cmd[8] = rotate ? 1 : 0;
459 return ch_do_scsi(ch, cmd, NULL, 0, DMA_NONE);
460}
461
462static int
463ch_move(scsi_changer *ch, u_int trans, u_int src, u_int dest, int rotate)
464{
465 u_char cmd[12];
466
467 dprintk("move: 0x%x => 0x%x\n",src,dest);
468 if (0 == trans)
469 trans = ch->firsts[CHET_MT];
470 memset(cmd,0,sizeof(cmd));
471 cmd[0] = MOVE_MEDIUM;
472 cmd[1] = ch->device->lun << 5;
473 cmd[2] = (trans >> 8) & 0xff;
474 cmd[3] = trans & 0xff;
475 cmd[4] = (src >> 8) & 0xff;
476 cmd[5] = src & 0xff;
477 cmd[6] = (dest >> 8) & 0xff;
478 cmd[7] = dest & 0xff;
479 cmd[10] = rotate ? 1 : 0;
480 return ch_do_scsi(ch, cmd, NULL,0, DMA_NONE);
481}
482
483static int
484ch_exchange(scsi_changer *ch, u_int trans, u_int src,
485 u_int dest1, u_int dest2, int rotate1, int rotate2)
486{
487 u_char cmd[12];
488
489 dprintk("exchange: 0x%x => 0x%x => 0x%x\n",
490 src,dest1,dest2);
491 if (0 == trans)
492 trans = ch->firsts[CHET_MT];
493 memset(cmd,0,sizeof(cmd));
494 cmd[0] = EXCHANGE_MEDIUM;
495 cmd[1] = ch->device->lun << 5;
496 cmd[2] = (trans >> 8) & 0xff;
497 cmd[3] = trans & 0xff;
498 cmd[4] = (src >> 8) & 0xff;
499 cmd[5] = src & 0xff;
500 cmd[6] = (dest1 >> 8) & 0xff;
501 cmd[7] = dest1 & 0xff;
502 cmd[8] = (dest2 >> 8) & 0xff;
503 cmd[9] = dest2 & 0xff;
504 cmd[10] = (rotate1 ? 1 : 0) | (rotate2 ? 2 : 0);
505
506 return ch_do_scsi(ch, cmd, NULL,0, DMA_NONE);
507}
508
509static void
510ch_check_voltag(char *tag)
511{
512 int i;
513
514 for (i = 0; i < 32; i++) {
515 /* restrict to ascii */
516 if (tag[i] >= 0x7f || tag[i] < 0x20)
517 tag[i] = ' ';
518 /* don't allow search wildcards */
519 if (tag[i] == '?' ||
520 tag[i] == '*')
521 tag[i] = ' ';
522 }
523}
524
525static int
526ch_set_voltag(scsi_changer *ch, u_int elem,
527 int alternate, int clear, u_char *tag)
528{
529 u_char cmd[12];
530 u_char *buffer;
531 int result;
532
533 buffer = kmalloc(512, GFP_KERNEL);
534 if (!buffer)
535 return -ENOMEM;
536 memset(buffer,0,512);
537
538 dprintk("%s %s voltag: 0x%x => \"%s\"\n",
539 clear ? "clear" : "set",
540 alternate ? "alternate" : "primary",
541 elem, tag);
542 memset(cmd,0,sizeof(cmd));
543 cmd[0] = SEND_VOLUME_TAG;
544 cmd[1] = (ch->device->lun << 5) |
545 ch_elem_to_typecode(ch,elem);
546 cmd[2] = (elem >> 8) & 0xff;
547 cmd[3] = elem & 0xff;
548 cmd[5] = clear
549 ? (alternate ? 0x0d : 0x0c)
550 : (alternate ? 0x0b : 0x0a);
551
552 cmd[9] = 255;
553
554 memcpy(buffer,tag,32);
555 ch_check_voltag(buffer);
556
557 result = ch_do_scsi(ch, cmd, buffer, 256, DMA_TO_DEVICE);
558 kfree(buffer);
559 return result;
560}
561
fe08ac31 562static int ch_gstatus(scsi_changer *ch, int type, unsigned char __user *dest)
daa6eda6
GK		 563{
564 int retval = 0;
565 u_char data[16];
566 unsigned int i;
567
568 down(&ch->lock);
569 for (i = 0; i < ch->counts[type]; i++) {
570 if (0 != ch_read_element_status
571 (ch, ch->firsts[type]+i,data)) {
572 retval = -EIO;
573 break;
574 }
575 put_user(data[2], dest+i);
576 if (data[2] & CESTATUS_EXCEPT)
577 vprintk("element 0x%x: asc=0x%x, ascq=0x%x\n",
578 ch->firsts[type]+i,
579 (int)data[4],(int)data[5]);
580 retval = ch_read_element_status
581 (ch, ch->firsts[type]+i,data);
582 if (0 != retval)
583 break;
584 }
585 up(&ch->lock);
586 return retval;
587}
588
589/* ------------------------------------------------------------------------ */
590
591static int
592ch_release(struct inode *inode, struct file *file)
593{
594 scsi_changer *ch = file->private_data;
595
596 scsi_device_put(ch->device);
597 file->private_data = NULL;
598 return 0;
599}
600
601static int
602ch_open(struct inode *inode, struct file *file)
603{
604 scsi_changer *tmp, *ch;
605 int minor = iminor(inode);
606
607 spin_lock(&ch_devlist_lock);
608 ch = NULL;
609 list_for_each_entry(tmp,&ch_devlist,list) {
610 if (tmp->minor == minor)
611 ch = tmp;
612 }
613 if (NULL == ch || scsi_device_get(ch->device)) {
614 spin_unlock(&ch_devlist_lock);
615 return -ENXIO;
616 }
617 spin_unlock(&ch_devlist_lock);
618
619 file->private_data = ch;
620 return 0;
621}
622
623static int
624ch_checkrange(scsi_changer *ch, unsigned int type, unsigned int unit)
625{
626 if (type >= CH_TYPES || unit >= ch->counts[type])
627 return -1;
628 return 0;
629}
630
631static int ch_ioctl(struct inode * inode, struct file * file,
632 unsigned int cmd, unsigned long arg)
633{
634 scsi_changer *ch = file->private_data;
635 int retval;
fe08ac31 636 void __user *argp = (void __user *)arg;
daa6eda6
GK		 637
638 switch (cmd) {
639 case CHIOGPARAMS:
640 {
641 struct changer_params params;
642
643 params.cp_curpicker = 0;
644 params.cp_npickers = ch->counts[CHET_MT];
645 params.cp_nslots = ch->counts[CHET_ST];
646 params.cp_nportals = ch->counts[CHET_IE];
647 params.cp_ndrives = ch->counts[CHET_DT];
648
fe08ac31 649 if (copy_to_user(argp, &params, sizeof(params)))
daa6eda6
GK		 650 return -EFAULT;
651 return 0;
652 }
653 case CHIOGVPARAMS:
654 {
655 struct changer_vendor_params vparams;
656
657 memset(&vparams,0,sizeof(vparams));
658 if (ch->counts[CHET_V1]) {
659 vparams.cvp_n1 = ch->counts[CHET_V1];
660 strncpy(vparams.cvp_label1,vendor_labels[0],16);
661 }
662 if (ch->counts[CHET_V2]) {
663 vparams.cvp_n2 = ch->counts[CHET_V2];
664 strncpy(vparams.cvp_label2,vendor_labels[1],16);
665 }
666 if (ch->counts[CHET_V3]) {
667 vparams.cvp_n3 = ch->counts[CHET_V3];
668 strncpy(vparams.cvp_label3,vendor_labels[2],16);
669 }
670 if (ch->counts[CHET_V4]) {
671 vparams.cvp_n4 = ch->counts[CHET_V4];
672 strncpy(vparams.cvp_label4,vendor_labels[3],16);
673 }
fe08ac31 674 if (copy_to_user(argp, &vparams, sizeof(vparams)))
daa6eda6
GK		 675 return -EFAULT;
676 return 0;
677 }
678
679 case CHIOPOSITION:
680 {
681 struct changer_position pos;
682
fe08ac31 683 if (copy_from_user(&pos, argp, sizeof (pos)))
daa6eda6
GK		 684 return -EFAULT;
685
686 if (0 != ch_checkrange(ch, pos.cp_type, pos.cp_unit)) {
687 dprintk("CHIOPOSITION: invalid parameter\n");
688 return -EBADSLT;
689 }
690 down(&ch->lock);
691 retval = ch_position(ch,0,
692 ch->firsts[pos.cp_type] + pos.cp_unit,
693 pos.cp_flags & CP_INVERT);
694 up(&ch->lock);
695 return retval;
696 }
697
698 case CHIOMOVE:
699 {
700 struct changer_move mv;
701
fe08ac31 702 if (copy_from_user(&mv, argp, sizeof (mv)))
daa6eda6
GK		 703 return -EFAULT;
704
705 if (0 != ch_checkrange(ch, mv.cm_fromtype, mv.cm_fromunit) ||
706 0 != ch_checkrange(ch, mv.cm_totype, mv.cm_tounit )) {
707 dprintk("CHIOMOVE: invalid parameter\n");
708 return -EBADSLT;
709 }
710
711 down(&ch->lock);
712 retval = ch_move(ch,0,
713 ch->firsts[mv.cm_fromtype] + mv.cm_fromunit,
714 ch->firsts[mv.cm_totype] + mv.cm_tounit,
715 mv.cm_flags & CM_INVERT);
716 up(&ch->lock);
717 return retval;
718 }
719
720 case CHIOEXCHANGE:
721 {
722 struct changer_exchange mv;
723
fe08ac31 724 if (copy_from_user(&mv, argp, sizeof (mv)))
daa6eda6
GK		 725 return -EFAULT;
726
727 if (0 != ch_checkrange(ch, mv.ce_srctype, mv.ce_srcunit ) ||
728 0 != ch_checkrange(ch, mv.ce_fdsttype, mv.ce_fdstunit) ||
729 0 != ch_checkrange(ch, mv.ce_sdsttype, mv.ce_sdstunit)) {
730 dprintk("CHIOEXCHANGE: invalid parameter\n");
731 return -EBADSLT;
732 }
733
734 down(&ch->lock);
735 retval = ch_exchange
736 (ch,0,
737 ch->firsts[mv.ce_srctype] + mv.ce_srcunit,
738 ch->firsts[mv.ce_fdsttype] + mv.ce_fdstunit,
739 ch->firsts[mv.ce_sdsttype] + mv.ce_sdstunit,
740 mv.ce_flags & CE_INVERT1, mv.ce_flags & CE_INVERT2);
741 up(&ch->lock);
742 return retval;
743 }
744
745 case CHIOGSTATUS:
746 {
747 struct changer_element_status ces;
748
fe08ac31 749 if (copy_from_user(&ces, argp, sizeof (ces)))
daa6eda6
GK		 750 return -EFAULT;
751 if (ces.ces_type < 0 || ces.ces_type >= CH_TYPES)
752 return -EINVAL;
753
754 return ch_gstatus(ch, ces.ces_type, ces.ces_data);
755 }
756
757 case CHIOGELEM:
758 {
759 struct changer_get_element cge;
760 u_char cmd[12];
761 u_char *buffer;
762 unsigned int elem;
763 int result,i;
764
fe08ac31 765 if (copy_from_user(&cge, argp, sizeof (cge)))
daa6eda6
GK		 766 return -EFAULT;
767
768 if (0 != ch_checkrange(ch, cge.cge_type, cge.cge_unit))
769 return -EINVAL;
770 elem = ch->firsts[cge.cge_type] + cge.cge_unit;
771
772 buffer = kmalloc(512, GFP_KERNEL | GFP_DMA);
773 if (!buffer)
774 return -ENOMEM;
775 down(&ch->lock);
776
777 voltag_retry:
778 memset(cmd,0,sizeof(cmd));
779 cmd[0] = READ_ELEMENT_STATUS;
780 cmd[1] = (ch->device->lun << 5) |
781 (ch->voltags ? 0x10 : 0) |
782 ch_elem_to_typecode(ch,elem);
783 cmd[2] = (elem >> 8) & 0xff;
784 cmd[3] = elem & 0xff;
785 cmd[5] = 1;
786 cmd[9] = 255;
787
788 if (0 == (result = ch_do_scsi(ch, cmd, buffer, 256, DMA_FROM_DEVICE))) {
789 cge.cge_status = buffer[18];
790 cge.cge_flags = 0;
791 if (buffer[18] & CESTATUS_EXCEPT) {
792 cge.cge_errno = EIO;
793 }
794 if (buffer[25] & 0x80) {
795 cge.cge_flags |= CGE_SRC;
796 if (buffer[25] & 0x40)
797 cge.cge_flags |= CGE_INVERT;
798 elem = (buffer[26]<<8) | buffer[27];
799 for (i = 0; i < 4; i++) {
800 if (elem >= ch->firsts[i] &&
801 elem < ch->firsts[i] + ch->counts[i]) {
802 cge.cge_srctype = i;
803 cge.cge_srcunit = elem-ch->firsts[i];
804 }
805 }
806 }
807 if ((buffer[22] & 0x30) == 0x30) {
808 cge.cge_flags |= CGE_IDLUN;
809 cge.cge_id = buffer[23];
810 cge.cge_lun = buffer[22] & 7;
811 }
812 if (buffer[9] & 0x80) {
813 cge.cge_flags |= CGE_PVOLTAG;
814 memcpy(cge.cge_pvoltag,buffer+28,36);
815 }
816 if (buffer[9] & 0x40) {
817 cge.cge_flags |= CGE_AVOLTAG;
818 memcpy(cge.cge_avoltag,buffer+64,36);
819 }
820 } else if (ch->voltags) {
821 ch->voltags = 0;
822 vprintk("device has no volume tag support\n");
823 goto voltag_retry;
824 }
825 kfree(buffer);
826 up(&ch->lock);
827
fe08ac31 828 if (copy_to_user(argp, &cge, sizeof (cge)))
daa6eda6
GK		 829 return -EFAULT;
830 return result;
831 }
832
833 case CHIOINITELEM:
834 {
835 down(&ch->lock);
836 retval = ch_init_elem(ch);
837 up(&ch->lock);
838 return retval;
839 }
840
841 case CHIOSVOLTAG:
842 {
843 struct changer_set_voltag csv;
844 int elem;
845
fe08ac31 846 if (copy_from_user(&csv, argp, sizeof(csv)))
daa6eda6
GK		 847 return -EFAULT;
848
849 if (0 != ch_checkrange(ch, csv.csv_type, csv.csv_unit)) {
850 dprintk("CHIOSVOLTAG: invalid parameter\n");
851 return -EBADSLT;
852 }
853 elem = ch->firsts[csv.csv_type] + csv.csv_unit;
854 down(&ch->lock);
855 retval = ch_set_voltag(ch, elem,
856 csv.csv_flags & CSV_AVOLTAG,
857 csv.csv_flags & CSV_CLEARTAG,
858 csv.csv_voltag);
859 up(&ch->lock);
860 return retval;
861 }
862
863 default:
fe08ac31 864 return scsi_ioctl(ch->device, cmd, argp);
daa6eda6
GK		 865
866 }
867}
868
869#ifdef CONFIG_COMPAT
870
871struct changer_element_status32 {
872 int ces_type;
873 compat_uptr_t ces_data;
874};
875#define CHIOGSTATUS32 _IOW('c', 8,struct changer_element_status32)
876
877static long ch_ioctl_compat(struct file * file,
878 unsigned int cmd, unsigned long arg)
879{
880 scsi_changer *ch = file->private_data;
881
882 switch (cmd) {
883 case CHIOGPARAMS:
884 case CHIOGVPARAMS:
885 case CHIOPOSITION:
886 case CHIOMOVE:
887 case CHIOEXCHANGE:
888 case CHIOGELEM:
889 case CHIOINITELEM:
890 case CHIOSVOLTAG:
891 /* compatible */
892 return ch_ioctl(NULL /* inode, unused */,
893 file, cmd, arg);
894 case CHIOGSTATUS32:
895 {
896 struct changer_element_status32 ces32;
fe08ac31 897 unsigned char __user *data;
daa6eda6 898
fe08ac31 899 if (copy_from_user(&ces32, (void __user *)arg, sizeof (ces32)))
daa6eda6
GK		 900 return -EFAULT;
901 if (ces32.ces_type < 0 || ces32.ces_type >= CH_TYPES)
902 return -EINVAL;
903
904 data = compat_ptr(ces32.ces_data);
905 return ch_gstatus(ch, ces32.ces_type, data);
906 }
907 default:
908 // return scsi_ioctl_compat(ch->device, cmd, (void*)arg);
909 return -ENOIOCTLCMD;
910
911 }
912}
913#endif
914
915/* ------------------------------------------------------------------------ */
916
917static int ch_probe(struct device *dev)
918{
919 struct scsi_device *sd = to_scsi_device(dev);
920 scsi_changer *ch;
921
922 if (sd->type != TYPE_MEDIUM_CHANGER)
923 return -ENODEV;
924
925 ch = kmalloc(sizeof(*ch), GFP_KERNEL);
926 if (NULL == ch)
927 return -ENOMEM;
928
929 memset(ch,0,sizeof(*ch));
930 ch->minor = ch_devcount;
931 sprintf(ch->name,"ch%d",ch->minor);
932 init_MUTEX(&ch->lock);
933 ch->device = sd;
934 ch_readconfig(ch);
935 if (init)
936 ch_init_elem(ch);
937
53f46542 938 class_device_create(ch_sysfs_class, NULL,
21feb5cc
GK		 939 MKDEV(SCSI_CHANGER_MAJOR,ch->minor),
940 dev, "s%s", ch->name);
daa6eda6 941
017560fc 942 sdev_printk(KERN_INFO, sd, "Attached scsi changer %s\n", ch->name);
daa6eda6
GK		 943
944 spin_lock(&ch_devlist_lock);
945 list_add_tail(&ch->list,&ch_devlist);
946 ch_devcount++;
947 spin_unlock(&ch_devlist_lock);
948 return 0;
949}
950
951static int ch_remove(struct device *dev)
952{
953 struct scsi_device *sd = to_scsi_device(dev);
954 scsi_changer *tmp, *ch;
955
956 spin_lock(&ch_devlist_lock);
957 ch = NULL;
958 list_for_each_entry(tmp,&ch_devlist,list) {
959 if (tmp->device == sd)
960 ch = tmp;
961 }
962 BUG_ON(NULL == ch);
963 list_del(&ch->list);
964 spin_unlock(&ch_devlist_lock);
965
21feb5cc
GK		 966 class_device_destroy(ch_sysfs_class,
967 MKDEV(SCSI_CHANGER_MAJOR,ch->minor));
daa6eda6
GK		 968 kfree(ch->dt);
969 kfree(ch);
970 ch_devcount--;
971 return 0;
972}
973
974static int __init init_ch_module(void)
975{
976 int rc;
977
978 printk(KERN_INFO "SCSI Media Changer driver v" VERSION " \n");
21feb5cc 979 ch_sysfs_class = class_create(THIS_MODULE, "scsi_changer");
daa6eda6
GK		 980 if (IS_ERR(ch_sysfs_class)) {
981 rc = PTR_ERR(ch_sysfs_class);
982 return rc;
983 }
984 rc = register_chrdev(SCSI_CHANGER_MAJOR,"ch",&changer_fops);
985 if (rc < 0) {
986 printk("Unable to get major %d for SCSI-Changer\n",
987 SCSI_CHANGER_MAJOR);
988 goto fail1;
989 }
990 rc = scsi_register_driver(&ch_template.gendrv);
991 if (rc < 0)
992 goto fail2;
993 return 0;
994
995 fail2:
996 unregister_chrdev(SCSI_CHANGER_MAJOR, "ch");
997 fail1:
21feb5cc 998 class_destroy(ch_sysfs_class);
daa6eda6
GK		 999 return rc;
1000}
1001
1002static void __exit exit_ch_module(void)
1003{
1004 scsi_unregister_driver(&ch_template.gendrv);
1005 unregister_chrdev(SCSI_CHANGER_MAJOR, "ch");
21feb5cc 1006 class_destroy(ch_sysfs_class);
daa6eda6
GK		 1007}
1008
1009module_init(init_ch_module);
1010module_exit(exit_ch_module);
1011
1012/*
1013 * Local variables:
1014 * c-basic-offset: 8
1015 * End:
1016 */
Clone of davem's net-next-2.6 tree