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