Blame view
block/bsg.c
23.5 KB
3d6392cfb bsg: support for ... |
1 |
/* |
0c6a89ba6 [SCSI] bsg: updat... |
2 |
* bsg.c - block layer implementation of the sg v4 interface |
3d6392cfb bsg: support for ... |
3 4 5 6 7 8 9 10 11 |
* * Copyright (C) 2004 Jens Axboe <axboe@suse.de> SUSE Labs * Copyright (C) 2004 Peter M. Jones <pjones@redhat.com> * * This file is subject to the terms and conditions of the GNU General Public * License version 2. See the file "COPYING" in the main directory of this * archive for more details. * */ |
3d6392cfb bsg: support for ... |
12 13 14 15 16 17 |
#include <linux/module.h> #include <linux/init.h> #include <linux/file.h> #include <linux/blkdev.h> #include <linux/poll.h> #include <linux/cdev.h> |
ad5ebd2fa block: jiffies fixes |
18 |
#include <linux/jiffies.h> |
3d6392cfb bsg: support for ... |
19 20 |
#include <linux/percpu.h> #include <linux/uio.h> |
598443a21 [SCSI] bsg: use l... |
21 |
#include <linux/idr.h> |
3d6392cfb bsg: support for ... |
22 |
#include <linux/bsg.h> |
75bd2ef14 bsg: cdev lock_ke... |
23 |
#include <linux/smp_lock.h> |
5a0e3ad6a include cleanup: ... |
24 |
#include <linux/slab.h> |
3d6392cfb bsg: support for ... |
25 26 27 28 |
#include <scsi/scsi.h> #include <scsi/scsi_ioctl.h> #include <scsi/scsi_cmnd.h> |
4e2872d6b bind bsg to all S... |
29 30 |
#include <scsi/scsi_device.h> #include <scsi/scsi_driver.h> |
3d6392cfb bsg: support for ... |
31 |
#include <scsi/sg.h> |
0ed081ce2 bsg: minor cleanup |
32 33 |
#define BSG_DESCRIPTION "Block layer SCSI generic (bsg) driver" #define BSG_VERSION "0.4" |
3d6392cfb bsg: support for ... |
34 |
|
3d6392cfb bsg: support for ... |
35 |
struct bsg_device { |
165125e1e [BLOCK] Get rid o... |
36 |
struct request_queue *queue; |
3d6392cfb bsg: support for ... |
37 38 39 40 41 |
spinlock_t lock; struct list_head busy_list; struct list_head done_list; struct hlist_node dev_list; atomic_t ref_count; |
3d6392cfb bsg: support for ... |
42 43 |
int queued_cmds; int done_cmds; |
3d6392cfb bsg: support for ... |
44 45 |
wait_queue_head_t wq_done; wait_queue_head_t wq_free; |
3ada8b7e9 block: struct dev... |
46 |
char name[20]; |
3d6392cfb bsg: support for ... |
47 48 49 50 51 52 |
int max_queue; unsigned long flags; }; enum { BSG_F_BLOCK = 1, |
3d6392cfb bsg: support for ... |
53 |
}; |
5309cb38d Add queue resizin... |
54 |
#define BSG_DEFAULT_CMDS 64 |
292b7f271 improve bsg devic... |
55 |
#define BSG_MAX_DEVS 32768 |
3d6392cfb bsg: support for ... |
56 57 58 59 |
#undef BSG_DEBUG #ifdef BSG_DEBUG |
24c03d47d block: remove rem... |
60 |
#define dprintk(fmt, args...) printk(KERN_ERR "%s: " fmt, __func__, ##args) |
3d6392cfb bsg: support for ... |
61 62 63 |
#else #define dprintk(fmt, args...) #endif |
3d6392cfb bsg: support for ... |
64 |
static DEFINE_MUTEX(bsg_mutex); |
598443a21 [SCSI] bsg: use l... |
65 |
static DEFINE_IDR(bsg_minor_idr); |
3d6392cfb bsg: support for ... |
66 |
|
25fd16430 bsg: address vari... |
67 |
#define BSG_LIST_ARRAY_SIZE 8 |
25fd16430 bsg: address vari... |
68 |
static struct hlist_head bsg_device_list[BSG_LIST_ARRAY_SIZE]; |
3d6392cfb bsg: support for ... |
69 70 |
static struct class *bsg_class; |
46f6ef4af bsg: convert to d... |
71 |
static int bsg_major; |
3d6392cfb bsg: support for ... |
72 |
|
5309cb38d Add queue resizin... |
73 |
static struct kmem_cache *bsg_cmd_cachep; |
3d6392cfb bsg: support for ... |
74 75 76 77 78 79 80 81 |
/* * our internal command type */ struct bsg_command { struct bsg_device *bd; struct list_head list; struct request *rq; struct bio *bio; |
2c9ecdf40 bsg: add bidi sup... |
82 |
struct bio *bidi_bio; |
3d6392cfb bsg: support for ... |
83 |
int err; |
70e36ecea bsg: replace SG v... |
84 |
struct sg_io_v4 hdr; |
3d6392cfb bsg: support for ... |
85 86 87 88 89 90 |
char sense[SCSI_SENSE_BUFFERSIZE]; }; static void bsg_free_command(struct bsg_command *bc) { struct bsg_device *bd = bc->bd; |
3d6392cfb bsg: support for ... |
91 |
unsigned long flags; |
5309cb38d Add queue resizin... |
92 |
kmem_cache_free(bsg_cmd_cachep, bc); |
3d6392cfb bsg: support for ... |
93 94 95 |
spin_lock_irqsave(&bd->lock, flags); bd->queued_cmds--; |
3d6392cfb bsg: support for ... |
96 97 98 99 |
spin_unlock_irqrestore(&bd->lock, flags); wake_up(&bd->wq_free); } |
e7d721732 bsg: fix a blocki... |
100 |
static struct bsg_command *bsg_alloc_command(struct bsg_device *bd) |
3d6392cfb bsg: support for ... |
101 |
{ |
e7d721732 bsg: fix a blocki... |
102 |
struct bsg_command *bc = ERR_PTR(-EINVAL); |
3d6392cfb bsg: support for ... |
103 104 105 106 107 |
spin_lock_irq(&bd->lock); if (bd->queued_cmds >= bd->max_queue) goto out; |
3d6392cfb bsg: support for ... |
108 |
bd->queued_cmds++; |
3d6392cfb bsg: support for ... |
109 |
spin_unlock_irq(&bd->lock); |
25fd16430 bsg: address vari... |
110 |
bc = kmem_cache_zalloc(bsg_cmd_cachep, GFP_KERNEL); |
5309cb38d Add queue resizin... |
111 112 |
if (unlikely(!bc)) { spin_lock_irq(&bd->lock); |
7e75d7308 bsg: simplify __b... |
113 |
bd->queued_cmds--; |
e7d721732 bsg: fix a blocki... |
114 |
bc = ERR_PTR(-ENOMEM); |
7e75d7308 bsg: simplify __b... |
115 |
goto out; |
5309cb38d Add queue resizin... |
116 |
} |
3d6392cfb bsg: support for ... |
117 118 |
bc->bd = bd; INIT_LIST_HEAD(&bc->list); |
5309cb38d Add queue resizin... |
119 120 |
dprintk("%s: returning free cmd %p ", bd->name, bc); |
3d6392cfb bsg: support for ... |
121 122 |
return bc; out: |
3d6392cfb bsg: support for ... |
123 124 125 |
spin_unlock_irq(&bd->lock); return bc; } |
1c1133e1f bsg: device hash ... |
126 |
static inline struct hlist_head *bsg_dev_idx_hash(int index) |
3d6392cfb bsg: support for ... |
127 |
{ |
1c1133e1f bsg: device hash ... |
128 |
return &bsg_device_list[index & (BSG_LIST_ARRAY_SIZE - 1)]; |
3d6392cfb bsg: support for ... |
129 |
} |
25fd16430 bsg: address vari... |
130 |
static int bsg_io_schedule(struct bsg_device *bd) |
3d6392cfb bsg: support for ... |
131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 |
{ DEFINE_WAIT(wait); int ret = 0; spin_lock_irq(&bd->lock); BUG_ON(bd->done_cmds > bd->queued_cmds); /* * -ENOSPC or -ENODATA? I'm going for -ENODATA, meaning "I have no * work to do", even though we return -ENOSPC after this same test * during bsg_write() -- there, it means our buffer can't have more * bsg_commands added to it, thus has no space left. */ if (bd->done_cmds == bd->queued_cmds) { ret = -ENODATA; goto unlock; } if (!test_bit(BSG_F_BLOCK, &bd->flags)) { ret = -EAGAIN; goto unlock; } |
25fd16430 bsg: address vari... |
154 |
prepare_to_wait(&bd->wq_done, &wait, TASK_UNINTERRUPTIBLE); |
3d6392cfb bsg: support for ... |
155 156 157 |
spin_unlock_irq(&bd->lock); io_schedule(); finish_wait(&bd->wq_done, &wait); |
3d6392cfb bsg: support for ... |
158 159 160 161 162 |
return ret; unlock: spin_unlock_irq(&bd->lock); return ret; } |
165125e1e [BLOCK] Get rid o... |
163 |
static int blk_fill_sgv4_hdr_rq(struct request_queue *q, struct request *rq, |
abf543937 block: move cmdfi... |
164 |
struct sg_io_v4 *hdr, struct bsg_device *bd, |
aeb5d7270 [PATCH] introduce... |
165 |
fmode_t has_write_perm) |
70e36ecea bsg: replace SG v... |
166 |
{ |
9f5de6b10 [SCSI] bsg: add l... |
167 168 169 170 171 |
if (hdr->request_len > BLK_MAX_CDB) { rq->cmd = kzalloc(hdr->request_len, GFP_KERNEL); if (!rq->cmd) return -ENOMEM; } |
70e36ecea bsg: replace SG v... |
172 173 174 175 |
if (copy_from_user(rq->cmd, (void *)(unsigned long)hdr->request, hdr->request_len)) return -EFAULT; |
15d10b611 bsg: add SCSI tra... |
176 177 |
if (hdr->subprotocol == BSG_SUB_PROTOCOL_SCSI_CMD) { |
018e04468 block: get rid of... |
178 |
if (blk_verify_command(rq->cmd, has_write_perm)) |
15d10b611 bsg: add SCSI tra... |
179 180 |
return -EPERM; } else if (!capable(CAP_SYS_RAWIO)) |
70e36ecea bsg: replace SG v... |
181 182 183 184 185 186 187 |
return -EPERM; /* * fill in request structure */ rq->cmd_len = hdr->request_len; rq->cmd_type = REQ_TYPE_BLOCK_PC; |
ad5ebd2fa block: jiffies fixes |
188 |
rq->timeout = msecs_to_jiffies(hdr->timeout); |
70e36ecea bsg: replace SG v... |
189 190 191 192 |
if (!rq->timeout) rq->timeout = q->sg_timeout; if (!rq->timeout) rq->timeout = BLK_DEFAULT_SG_TIMEOUT; |
f2f1fa78a Enforce a minimum... |
193 194 |
if (rq->timeout < BLK_MIN_SG_TIMEOUT) rq->timeout = BLK_MIN_SG_TIMEOUT; |
70e36ecea bsg: replace SG v... |
195 196 197 |
return 0; } |
3d6392cfb bsg: support for ... |
198 |
/* |
70e36ecea bsg: replace SG v... |
199 |
* Check if sg_io_v4 from user is allowed and valid |
3d6392cfb bsg: support for ... |
200 201 |
*/ static int |
165125e1e [BLOCK] Get rid o... |
202 |
bsg_validate_sgv4_hdr(struct request_queue *q, struct sg_io_v4 *hdr, int *rw) |
3d6392cfb bsg: support for ... |
203 |
{ |
15d10b611 bsg: add SCSI tra... |
204 |
int ret = 0; |
70e36ecea bsg: replace SG v... |
205 |
if (hdr->guard != 'Q') |
3d6392cfb bsg: support for ... |
206 |
return -EINVAL; |
3d6392cfb bsg: support for ... |
207 |
|
15d10b611 bsg: add SCSI tra... |
208 209 210 211 212 213 214 215 216 217 218 219 220 |
switch (hdr->protocol) { case BSG_PROTOCOL_SCSI: switch (hdr->subprotocol) { case BSG_SUB_PROTOCOL_SCSI_CMD: case BSG_SUB_PROTOCOL_SCSI_TRANSPORT: break; default: ret = -EINVAL; } break; default: ret = -EINVAL; } |
70e36ecea bsg: replace SG v... |
221 |
|
70e36ecea bsg: replace SG v... |
222 |
*rw = hdr->dout_xfer_len ? WRITE : READ; |
15d10b611 bsg: add SCSI tra... |
223 |
return ret; |
3d6392cfb bsg: support for ... |
224 225 226 |
} /* |
70e36ecea bsg: replace SG v... |
227 |
* map sg_io_v4 to a request. |
3d6392cfb bsg: support for ... |
228 229 |
*/ static struct request * |
c1c201200 bsg: Fix sense bu... |
230 231 |
bsg_map_hdr(struct bsg_device *bd, struct sg_io_v4 *hdr, fmode_t has_write_perm, u8 *sense) |
3d6392cfb bsg: support for ... |
232 |
{ |
165125e1e [BLOCK] Get rid o... |
233 |
struct request_queue *q = bd->queue; |
2c9ecdf40 bsg: add bidi sup... |
234 |
struct request *rq, *next_rq = NULL; |
25fd16430 bsg: address vari... |
235 |
int ret, rw; |
70e36ecea bsg: replace SG v... |
236 237 |
unsigned int dxfer_len; void *dxferp = NULL; |
3d6392cfb bsg: support for ... |
238 |
|
70e36ecea bsg: replace SG v... |
239 240 241 242 |
dprintk("map hdr %llx/%u %llx/%u ", (unsigned long long) hdr->dout_xferp, hdr->dout_xfer_len, (unsigned long long) hdr->din_xferp, hdr->din_xfer_len); |
3d6392cfb bsg: support for ... |
243 |
|
70e36ecea bsg: replace SG v... |
244 |
ret = bsg_validate_sgv4_hdr(q, hdr, &rw); |
3d6392cfb bsg: support for ... |
245 246 247 248 |
if (ret) return ERR_PTR(ret); /* |
3ad2f3fbb tree-wide: Assort... |
249 |
* map scatter-gather elements separately and string them to request |
3d6392cfb bsg: support for ... |
250 251 |
*/ rq = blk_get_request(q, rw, GFP_KERNEL); |
2c9ecdf40 bsg: add bidi sup... |
252 253 |
if (!rq) return ERR_PTR(-ENOMEM); |
abf543937 block: move cmdfi... |
254 |
ret = blk_fill_sgv4_hdr_rq(q, rq, hdr, bd, has_write_perm); |
2c9ecdf40 bsg: add bidi sup... |
255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 |
if (ret) goto out; if (rw == WRITE && hdr->din_xfer_len) { if (!test_bit(QUEUE_FLAG_BIDI, &q->queue_flags)) { ret = -EOPNOTSUPP; goto out; } next_rq = blk_get_request(q, READ, GFP_KERNEL); if (!next_rq) { ret = -ENOMEM; goto out; } rq->next_rq = next_rq; |
40f620286 [SCSI] bsg: copy ... |
270 |
next_rq->cmd_type = rq->cmd_type; |
2c9ecdf40 bsg: add bidi sup... |
271 272 |
dxferp = (void*)(unsigned long)hdr->din_xferp; |
152e283fd block: introduce ... |
273 274 |
ret = blk_rq_map_user(q, next_rq, NULL, dxferp, hdr->din_xfer_len, GFP_KERNEL); |
2c9ecdf40 bsg: add bidi sup... |
275 276 |
if (ret) goto out; |
3d6392cfb bsg: support for ... |
277 |
} |
70e36ecea bsg: replace SG v... |
278 279 280 281 282 283 284 285 286 287 |
if (hdr->dout_xfer_len) { dxfer_len = hdr->dout_xfer_len; dxferp = (void*)(unsigned long)hdr->dout_xferp; } else if (hdr->din_xfer_len) { dxfer_len = hdr->din_xfer_len; dxferp = (void*)(unsigned long)hdr->din_xferp; } else dxfer_len = 0; if (dxfer_len) { |
152e283fd block: introduce ... |
288 289 |
ret = blk_rq_map_user(q, rq, NULL, dxferp, dxfer_len, GFP_KERNEL); |
2c9ecdf40 bsg: add bidi sup... |
290 291 |
if (ret) goto out; |
3d6392cfb bsg: support for ... |
292 |
} |
c1c201200 bsg: Fix sense bu... |
293 294 295 |
rq->sense = sense; rq->sense_len = 0; |
3d6392cfb bsg: support for ... |
296 |
return rq; |
2c9ecdf40 bsg: add bidi sup... |
297 |
out: |
9f5de6b10 [SCSI] bsg: add l... |
298 299 |
if (rq->cmd != rq->__cmd) kfree(rq->cmd); |
2c9ecdf40 bsg: add bidi sup... |
300 301 302 303 304 305 |
blk_put_request(rq); if (next_rq) { blk_rq_unmap_user(next_rq->bio); blk_put_request(next_rq); } return ERR_PTR(ret); |
3d6392cfb bsg: support for ... |
306 307 308 309 310 311 312 313 314 315 316 |
} /* * async completion call-back from the block layer, when scsi/ide/whatever * calls end_that_request_last() on a request */ static void bsg_rq_end_io(struct request *rq, int uptodate) { struct bsg_command *bc = rq->end_io_data; struct bsg_device *bd = bc->bd; unsigned long flags; |
5309cb38d Add queue resizin... |
317 318 319 |
dprintk("%s: finished rq %p bc %p, bio %p stat %d ", bd->name, rq, bc, bc->bio, uptodate); |
3d6392cfb bsg: support for ... |
320 321 322 323 |
bc->hdr.duration = jiffies_to_msecs(jiffies - bc->hdr.duration); spin_lock_irqsave(&bd->lock, flags); |
25fd16430 bsg: address vari... |
324 325 |
list_move_tail(&bc->list, &bd->done_list); bd->done_cmds++; |
3d6392cfb bsg: support for ... |
326 |
spin_unlock_irqrestore(&bd->lock, flags); |
25fd16430 bsg: address vari... |
327 328 |
wake_up(&bd->wq_done); |
3d6392cfb bsg: support for ... |
329 330 331 332 333 334 |
} /* * do final setup of a 'bc' and submit the matching 'rq' to the block * layer for io */ |
165125e1e [BLOCK] Get rid o... |
335 |
static void bsg_add_command(struct bsg_device *bd, struct request_queue *q, |
3d6392cfb bsg: support for ... |
336 337 |
struct bsg_command *bc, struct request *rq) { |
05378940c bsg: add support ... |
338 |
int at_head = (0 == (bc->hdr.flags & BSG_FLAG_Q_AT_TAIL)); |
3d6392cfb bsg: support for ... |
339 340 341 342 343 |
/* * add bc command to busy queue and submit rq for io */ bc->rq = rq; bc->bio = rq->bio; |
2c9ecdf40 bsg: add bidi sup... |
344 345 |
if (rq->next_rq) bc->bidi_bio = rq->next_rq->bio; |
3d6392cfb bsg: support for ... |
346 347 348 349 350 351 352 353 354 |
bc->hdr.duration = jiffies; spin_lock_irq(&bd->lock); list_add_tail(&bc->list, &bd->busy_list); spin_unlock_irq(&bd->lock); dprintk("%s: queueing rq %p, bc %p ", bd->name, rq, bc); rq->end_io_data = bc; |
05378940c bsg: add support ... |
355 |
blk_execute_rq_nowait(q, NULL, rq, at_head, bsg_rq_end_io); |
3d6392cfb bsg: support for ... |
356 |
} |
25fd16430 bsg: address vari... |
357 |
static struct bsg_command *bsg_next_done_cmd(struct bsg_device *bd) |
3d6392cfb bsg: support for ... |
358 359 360 361 362 |
{ struct bsg_command *bc = NULL; spin_lock_irq(&bd->lock); if (bd->done_cmds) { |
43ac9e62c [SCSI] bsg: use b... |
363 |
bc = list_first_entry(&bd->done_list, struct bsg_command, list); |
25fd16430 bsg: address vari... |
364 365 |
list_del(&bc->list); bd->done_cmds--; |
3d6392cfb bsg: support for ... |
366 367 368 369 370 371 372 373 374 |
} spin_unlock_irq(&bd->lock); return bc; } /* * Get a finished command from the done list */ |
e7d721732 bsg: fix a blocki... |
375 |
static struct bsg_command *bsg_get_done_cmd(struct bsg_device *bd) |
3d6392cfb bsg: support for ... |
376 377 378 379 380 381 382 383 |
{ struct bsg_command *bc; int ret; do { bc = bsg_next_done_cmd(bd); if (bc) break; |
e7d721732 bsg: fix a blocki... |
384 385 386 387 388 389 |
if (!test_bit(BSG_F_BLOCK, &bd->flags)) { bc = ERR_PTR(-EAGAIN); break; } ret = wait_event_interruptible(bd->wq_done, bd->done_cmds); |
3d6392cfb bsg: support for ... |
390 |
if (ret) { |
e7d721732 bsg: fix a blocki... |
391 |
bc = ERR_PTR(-ERESTARTSYS); |
3d6392cfb bsg: support for ... |
392 393 394 395 396 397 398 399 400 |
break; } } while (1); dprintk("%s: returning done %p ", bd->name, bc); return bc; } |
70e36ecea bsg: replace SG v... |
401 |
static int blk_complete_sgv4_hdr_rq(struct request *rq, struct sg_io_v4 *hdr, |
2c9ecdf40 bsg: add bidi sup... |
402 |
struct bio *bio, struct bio *bidi_bio) |
70e36ecea bsg: replace SG v... |
403 404 |
{ int ret = 0; |
c1c201200 bsg: Fix sense bu... |
405 406 |
dprintk("rq %p bio %p 0x%x ", rq, bio, rq->errors); |
70e36ecea bsg: replace SG v... |
407 408 409 410 411 412 413 414 415 |
/* * fill in all the output members */ hdr->device_status = status_byte(rq->errors); hdr->transport_status = host_byte(rq->errors); hdr->driver_status = driver_byte(rq->errors); hdr->info = 0; if (hdr->device_status || hdr->transport_status || hdr->driver_status) hdr->info |= SG_INFO_CHECK; |
70e36ecea bsg: replace SG v... |
416 417 418 |
hdr->response_len = 0; if (rq->sense_len && hdr->response) { |
25fd16430 bsg: address vari... |
419 420 |
int len = min_t(unsigned int, hdr->max_response_len, rq->sense_len); |
70e36ecea bsg: replace SG v... |
421 422 423 424 425 426 427 428 |
ret = copy_to_user((void*)(unsigned long)hdr->response, rq->sense, len); if (!ret) hdr->response_len = len; else ret = -EFAULT; } |
2c9ecdf40 bsg: add bidi sup... |
429 |
if (rq->next_rq) { |
c3a4d78c5 block: add rq->re... |
430 431 |
hdr->dout_resid = rq->resid_len; hdr->din_resid = rq->next_rq->resid_len; |
2c9ecdf40 bsg: add bidi sup... |
432 433 |
blk_rq_unmap_user(bidi_bio); blk_put_request(rq->next_rq); |
0c6a89ba6 [SCSI] bsg: updat... |
434 |
} else if (rq_data_dir(rq) == READ) |
c3a4d78c5 block: add rq->re... |
435 |
hdr->din_resid = rq->resid_len; |
0c6a89ba6 [SCSI] bsg: updat... |
436 |
else |
c3a4d78c5 block: add rq->re... |
437 |
hdr->dout_resid = rq->resid_len; |
2c9ecdf40 bsg: add bidi sup... |
438 |
|
2d507a01d [SCSI] libsas, bs... |
439 440 441 442 443 444 445 446 |
/* * If the request generated a negative error number, return it * (providing we aren't already returning an error); if it's * just a protocol response (i.e. non negative), that gets * processed above. */ if (!ret && rq->errors < 0) ret = rq->errors; |
70e36ecea bsg: replace SG v... |
447 |
blk_rq_unmap_user(bio); |
9f5de6b10 [SCSI] bsg: add l... |
448 449 |
if (rq->cmd != rq->__cmd) kfree(rq->cmd); |
70e36ecea bsg: replace SG v... |
450 451 452 453 |
blk_put_request(rq); return ret; } |
3d6392cfb bsg: support for ... |
454 455 456 457 458 459 460 |
static int bsg_complete_all_commands(struct bsg_device *bd) { struct bsg_command *bc; int ret, tret; dprintk("%s: entered ", bd->name); |
3d6392cfb bsg: support for ... |
461 462 463 464 465 |
/* * wait for all commands to complete */ ret = 0; do { |
25fd16430 bsg: address vari... |
466 |
ret = bsg_io_schedule(bd); |
3d6392cfb bsg: support for ... |
467 468 469 470 471 472 473 474 475 476 477 478 479 480 |
/* * look for -ENODATA specifically -- we'll sometimes get * -ERESTARTSYS when we've taken a signal, but we can't * return until we're done freeing the queue, so ignore * it. The signal will get handled when we're done freeing * the bsg_device. */ } while (ret != -ENODATA); /* * discard done commands */ ret = 0; do { |
e7d721732 bsg: fix a blocki... |
481 482 483 |
spin_lock_irq(&bd->lock); if (!bd->queued_cmds) { spin_unlock_irq(&bd->lock); |
3d6392cfb bsg: support for ... |
484 485 |
break; } |
efba1a31f bsg: fix the dead... |
486 |
spin_unlock_irq(&bd->lock); |
3d6392cfb bsg: support for ... |
487 |
|
e7d721732 bsg: fix a blocki... |
488 489 490 |
bc = bsg_get_done_cmd(bd); if (IS_ERR(bc)) break; |
2c9ecdf40 bsg: add bidi sup... |
491 492 |
tret = blk_complete_sgv4_hdr_rq(bc->rq, &bc->hdr, bc->bio, bc->bidi_bio); |
3d6392cfb bsg: support for ... |
493 494 495 496 497 498 499 500 |
if (!ret) ret = tret; bsg_free_command(bc); } while (1); return ret; } |
25fd16430 bsg: address vari... |
501 |
static int |
e7d721732 bsg: fix a blocki... |
502 503 |
__bsg_read(char __user *buf, size_t count, struct bsg_device *bd, const struct iovec *iov, ssize_t *bytes_read) |
3d6392cfb bsg: support for ... |
504 505 506 |
{ struct bsg_command *bc; int nr_commands, ret; |
70e36ecea bsg: replace SG v... |
507 |
if (count % sizeof(struct sg_io_v4)) |
3d6392cfb bsg: support for ... |
508 509 510 |
return -EINVAL; ret = 0; |
70e36ecea bsg: replace SG v... |
511 |
nr_commands = count / sizeof(struct sg_io_v4); |
3d6392cfb bsg: support for ... |
512 |
while (nr_commands) { |
e7d721732 bsg: fix a blocki... |
513 |
bc = bsg_get_done_cmd(bd); |
3d6392cfb bsg: support for ... |
514 515 516 517 518 519 520 521 522 523 |
if (IS_ERR(bc)) { ret = PTR_ERR(bc); break; } /* * this is the only case where we need to copy data back * after completing the request. so do that here, * bsg_complete_work() cannot do that for us */ |
2c9ecdf40 bsg: add bidi sup... |
524 525 |
ret = blk_complete_sgv4_hdr_rq(bc->rq, &bc->hdr, bc->bio, bc->bidi_bio); |
3d6392cfb bsg: support for ... |
526 |
|
25fd16430 bsg: address vari... |
527 |
if (copy_to_user(buf, &bc->hdr, sizeof(bc->hdr))) |
3d6392cfb bsg: support for ... |
528 529 530 531 532 533 |
ret = -EFAULT; bsg_free_command(bc); if (ret) break; |
70e36ecea bsg: replace SG v... |
534 535 |
buf += sizeof(struct sg_io_v4); *bytes_read += sizeof(struct sg_io_v4); |
3d6392cfb bsg: support for ... |
536 537 538 539 540 541 542 543 544 545 546 547 548 |
nr_commands--; } return ret; } static inline void bsg_set_block(struct bsg_device *bd, struct file *file) { if (file->f_flags & O_NONBLOCK) clear_bit(BSG_F_BLOCK, &bd->flags); else set_bit(BSG_F_BLOCK, &bd->flags); } |
25fd16430 bsg: address vari... |
549 550 551 |
/* * Check if the error is a "real" error that we should return. */ |
3d6392cfb bsg: support for ... |
552 553 554 555 556 557 558 559 560 561 562 563 564 565 |
static inline int err_block_err(int ret) { if (ret && ret != -ENOSPC && ret != -ENODATA && ret != -EAGAIN) return 1; return 0; } static ssize_t bsg_read(struct file *file, char __user *buf, size_t count, loff_t *ppos) { struct bsg_device *bd = file->private_data; int ret; ssize_t bytes_read; |
9e69fbb53 bsg: minor cleanups |
566 567 |
dprintk("%s: read %Zd bytes ", bd->name, count); |
3d6392cfb bsg: support for ... |
568 569 |
bsg_set_block(bd, file); |
0b07de85a allow userspace t... |
570 |
|
3d6392cfb bsg: support for ... |
571 |
bytes_read = 0; |
e7d721732 bsg: fix a blocki... |
572 |
ret = __bsg_read(buf, count, bd, NULL, &bytes_read); |
3d6392cfb bsg: support for ... |
573 574 575 576 577 578 579 |
*ppos = bytes_read; if (!bytes_read || (bytes_read && err_block_err(ret))) bytes_read = ret; return bytes_read; } |
25fd16430 bsg: address vari... |
580 |
static int __bsg_write(struct bsg_device *bd, const char __user *buf, |
aeb5d7270 [PATCH] introduce... |
581 582 |
size_t count, ssize_t *bytes_written, fmode_t has_write_perm) |
3d6392cfb bsg: support for ... |
583 584 585 586 |
{ struct bsg_command *bc; struct request *rq; int ret, nr_commands; |
70e36ecea bsg: replace SG v... |
587 |
if (count % sizeof(struct sg_io_v4)) |
3d6392cfb bsg: support for ... |
588 |
return -EINVAL; |
70e36ecea bsg: replace SG v... |
589 |
nr_commands = count / sizeof(struct sg_io_v4); |
3d6392cfb bsg: support for ... |
590 591 592 593 |
rq = NULL; bc = NULL; ret = 0; while (nr_commands) { |
165125e1e [BLOCK] Get rid o... |
594 |
struct request_queue *q = bd->queue; |
3d6392cfb bsg: support for ... |
595 |
|
e7d721732 bsg: fix a blocki... |
596 |
bc = bsg_alloc_command(bd); |
3d6392cfb bsg: support for ... |
597 598 599 600 601 |
if (IS_ERR(bc)) { ret = PTR_ERR(bc); bc = NULL; break; } |
3d6392cfb bsg: support for ... |
602 603 604 605 606 607 608 609 |
if (copy_from_user(&bc->hdr, buf, sizeof(bc->hdr))) { ret = -EFAULT; break; } /* * get a request, fill in the blanks, and add to request queue */ |
c1c201200 bsg: Fix sense bu... |
610 |
rq = bsg_map_hdr(bd, &bc->hdr, has_write_perm, bc->sense); |
3d6392cfb bsg: support for ... |
611 612 613 614 615 616 617 618 619 620 |
if (IS_ERR(rq)) { ret = PTR_ERR(rq); rq = NULL; break; } bsg_add_command(bd, q, bc, rq); bc = NULL; rq = NULL; nr_commands--; |
70e36ecea bsg: replace SG v... |
621 |
buf += sizeof(struct sg_io_v4); |
25fd16430 bsg: address vari... |
622 |
*bytes_written += sizeof(struct sg_io_v4); |
3d6392cfb bsg: support for ... |
623 |
} |
3d6392cfb bsg: support for ... |
624 625 626 627 628 629 630 631 632 633 |
if (bc) bsg_free_command(bc); return ret; } static ssize_t bsg_write(struct file *file, const char __user *buf, size_t count, loff_t *ppos) { struct bsg_device *bd = file->private_data; |
25fd16430 bsg: address vari... |
634 |
ssize_t bytes_written; |
3d6392cfb bsg: support for ... |
635 |
int ret; |
9e69fbb53 bsg: minor cleanups |
636 637 |
dprintk("%s: write %Zd bytes ", bd->name, count); |
3d6392cfb bsg: support for ... |
638 639 |
bsg_set_block(bd, file); |
3d6392cfb bsg: support for ... |
640 |
|
25fd16430 bsg: address vari... |
641 |
bytes_written = 0; |
abf543937 block: move cmdfi... |
642 643 |
ret = __bsg_write(bd, buf, count, &bytes_written, file->f_mode & FMODE_WRITE); |
25fd16430 bsg: address vari... |
644 |
*ppos = bytes_written; |
3d6392cfb bsg: support for ... |
645 646 647 648 |
/* * return bytes written on non-fatal errors */ |
25fd16430 bsg: address vari... |
649 650 |
if (!bytes_written || (bytes_written && err_block_err(ret))) bytes_written = ret; |
3d6392cfb bsg: support for ... |
651 |
|
25fd16430 bsg: address vari... |
652 653 654 |
dprintk("%s: returning %Zd ", bd->name, bytes_written); return bytes_written; |
3d6392cfb bsg: support for ... |
655 |
} |
3d6392cfb bsg: support for ... |
656 657 |
static struct bsg_device *bsg_alloc_device(void) { |
3d6392cfb bsg: support for ... |
658 |
struct bsg_device *bd; |
3d6392cfb bsg: support for ... |
659 660 661 662 663 664 |
bd = kzalloc(sizeof(struct bsg_device), GFP_KERNEL); if (unlikely(!bd)) return NULL; spin_lock_init(&bd->lock); |
5309cb38d Add queue resizin... |
665 |
bd->max_queue = BSG_DEFAULT_CMDS; |
3d6392cfb bsg: support for ... |
666 667 668 669 670 671 672 673 |
INIT_LIST_HEAD(&bd->busy_list); INIT_LIST_HEAD(&bd->done_list); INIT_HLIST_NODE(&bd->dev_list); init_waitqueue_head(&bd->wq_free); init_waitqueue_head(&bd->wq_done); return bd; |
3d6392cfb bsg: support for ... |
674 |
} |
97f46ae45 [SCSI] bsg: add r... |
675 676 677 678 |
static void bsg_kref_release_function(struct kref *kref) { struct bsg_class_device *bcd = container_of(kref, struct bsg_class_device, ref); |
8df5fc042 [SCSI] bsg: fix o... |
679 |
struct device *parent = bcd->parent; |
97f46ae45 [SCSI] bsg: add r... |
680 681 682 |
if (bcd->release) bcd->release(bcd->parent); |
8df5fc042 [SCSI] bsg: fix o... |
683 |
put_device(parent); |
97f46ae45 [SCSI] bsg: add r... |
684 |
} |
3d6392cfb bsg: support for ... |
685 686 |
static int bsg_put_device(struct bsg_device *bd) { |
97f46ae45 [SCSI] bsg: add r... |
687 688 |
int ret = 0, do_free; struct request_queue *q = bd->queue; |
3d6392cfb bsg: support for ... |
689 690 |
mutex_lock(&bsg_mutex); |
97f46ae45 [SCSI] bsg: add r... |
691 |
do_free = atomic_dec_and_test(&bd->ref_count); |
3f27e3ed1 [SCSI] bsg: fix b... |
692 693 |
if (!do_free) { mutex_unlock(&bsg_mutex); |
3d6392cfb bsg: support for ... |
694 |
goto out; |
3f27e3ed1 [SCSI] bsg: fix b... |
695 696 697 698 |
} hlist_del(&bd->dev_list); mutex_unlock(&bsg_mutex); |
3d6392cfb bsg: support for ... |
699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 |
dprintk("%s: tearing down ", bd->name); /* * close can always block */ set_bit(BSG_F_BLOCK, &bd->flags); /* * correct error detection baddies here again. it's the responsibility * of the app to properly reap commands before close() if it wants * fool-proof error detection */ ret = bsg_complete_all_commands(bd); |
5309cb38d Add queue resizin... |
714 |
kfree(bd); |
3d6392cfb bsg: support for ... |
715 |
out: |
97f46ae45 [SCSI] bsg: add r... |
716 717 718 |
kref_put(&q->bsg_dev.ref, bsg_kref_release_function); if (do_free) blk_put_queue(q); |
3d6392cfb bsg: support for ... |
719 720 721 722 |
return ret; } static struct bsg_device *bsg_add_device(struct inode *inode, |
d351af01b bsg: bind bsg to ... |
723 |
struct request_queue *rq, |
3d6392cfb bsg: support for ... |
724 725 |
struct file *file) { |
25fd16430 bsg: address vari... |
726 |
struct bsg_device *bd; |
c3ff1b90d [SCSI] bsg: repla... |
727 |
int ret; |
3d6392cfb bsg: support for ... |
728 729 730 |
#ifdef BSG_DEBUG unsigned char buf[32]; #endif |
c3ff1b90d [SCSI] bsg: repla... |
731 732 733 |
ret = blk_get_queue(rq); if (ret) return ERR_PTR(-ENXIO); |
3d6392cfb bsg: support for ... |
734 735 |
bd = bsg_alloc_device(); |
c3ff1b90d [SCSI] bsg: repla... |
736 737 |
if (!bd) { blk_put_queue(rq); |
3d6392cfb bsg: support for ... |
738 |
return ERR_PTR(-ENOMEM); |
c3ff1b90d [SCSI] bsg: repla... |
739 |
} |
3d6392cfb bsg: support for ... |
740 |
|
d351af01b bsg: bind bsg to ... |
741 |
bd->queue = rq; |
0b07de85a allow userspace t... |
742 |
|
3d6392cfb bsg: support for ... |
743 744 745 |
bsg_set_block(bd, file); atomic_set(&bd->ref_count, 1); |
3d6392cfb bsg: support for ... |
746 |
mutex_lock(&bsg_mutex); |
842ea771c [SCSI] bsg: remov... |
747 |
hlist_add_head(&bd->dev_list, bsg_dev_idx_hash(iminor(inode))); |
3d6392cfb bsg: support for ... |
748 |
|
3ada8b7e9 block: struct dev... |
749 |
strncpy(bd->name, dev_name(rq->bsg_dev.class_dev), sizeof(bd->name) - 1); |
3d6392cfb bsg: support for ... |
750 751 |
dprintk("bound to <%s>, max queue %d ", |
9e69fbb53 bsg: minor cleanups |
752 |
format_dev_t(buf, inode->i_rdev), bd->max_queue); |
3d6392cfb bsg: support for ... |
753 754 755 756 |
mutex_unlock(&bsg_mutex); return bd; } |
842ea771c [SCSI] bsg: remov... |
757 |
static struct bsg_device *__bsg_get_device(int minor, struct request_queue *q) |
3d6392cfb bsg: support for ... |
758 |
{ |
43ac9e62c [SCSI] bsg: use b... |
759 |
struct bsg_device *bd; |
3d6392cfb bsg: support for ... |
760 761 762 |
struct hlist_node *entry; mutex_lock(&bsg_mutex); |
43ac9e62c [SCSI] bsg: use b... |
763 |
hlist_for_each_entry(bd, entry, bsg_dev_idx_hash(minor), dev_list) { |
842ea771c [SCSI] bsg: remov... |
764 |
if (bd->queue == q) { |
3d6392cfb bsg: support for ... |
765 |
atomic_inc(&bd->ref_count); |
43ac9e62c [SCSI] bsg: use b... |
766 |
goto found; |
3d6392cfb bsg: support for ... |
767 |
} |
3d6392cfb bsg: support for ... |
768 |
} |
43ac9e62c [SCSI] bsg: use b... |
769 770 |
bd = NULL; found: |
3d6392cfb bsg: support for ... |
771 772 773 774 775 776 |
mutex_unlock(&bsg_mutex); return bd; } static struct bsg_device *bsg_get_device(struct inode *inode, struct file *file) { |
598443a21 [SCSI] bsg: use l... |
777 778 |
struct bsg_device *bd; struct bsg_class_device *bcd; |
3d6392cfb bsg: support for ... |
779 |
|
3d6392cfb bsg: support for ... |
780 781 782 |
/* * find the class device */ |
3d6392cfb bsg: support for ... |
783 |
mutex_lock(&bsg_mutex); |
598443a21 [SCSI] bsg: use l... |
784 |
bcd = idr_find(&bsg_minor_idr, iminor(inode)); |
d45ac4fa8 [SCSI] bsg: takes... |
785 |
if (bcd) |
97f46ae45 [SCSI] bsg: add r... |
786 |
kref_get(&bcd->ref); |
3d6392cfb bsg: support for ... |
787 788 789 790 |
mutex_unlock(&bsg_mutex); if (!bcd) return ERR_PTR(-ENODEV); |
842ea771c [SCSI] bsg: remov... |
791 |
bd = __bsg_get_device(iminor(inode), bcd->queue); |
d45ac4fa8 [SCSI] bsg: takes... |
792 793 794 795 796 |
if (bd) return bd; bd = bsg_add_device(inode, bcd->queue, file); if (IS_ERR(bd)) |
97f46ae45 [SCSI] bsg: add r... |
797 |
kref_put(&bcd->ref, bsg_kref_release_function); |
d45ac4fa8 [SCSI] bsg: takes... |
798 799 |
return bd; |
3d6392cfb bsg: support for ... |
800 801 802 803 |
} static int bsg_open(struct inode *inode, struct file *file) { |
75bd2ef14 bsg: cdev lock_ke... |
804 805 806 807 808 |
struct bsg_device *bd; lock_kernel(); bd = bsg_get_device(inode, file); unlock_kernel(); |
3d6392cfb bsg: support for ... |
809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 |
if (IS_ERR(bd)) return PTR_ERR(bd); file->private_data = bd; return 0; } static int bsg_release(struct inode *inode, struct file *file) { struct bsg_device *bd = file->private_data; file->private_data = NULL; return bsg_put_device(bd); } static unsigned int bsg_poll(struct file *file, poll_table *wait) { struct bsg_device *bd = file->private_data; unsigned int mask = 0; poll_wait(file, &bd->wq_done, wait); poll_wait(file, &bd->wq_free, wait); spin_lock_irq(&bd->lock); if (!list_empty(&bd->done_list)) mask |= POLLIN | POLLRDNORM; if (bd->queued_cmds >= bd->max_queue) mask |= POLLOUT; spin_unlock_irq(&bd->lock); return mask; } |
25fd16430 bsg: address vari... |
842 |
static long bsg_ioctl(struct file *file, unsigned int cmd, unsigned long arg) |
3d6392cfb bsg: support for ... |
843 844 845 |
{ struct bsg_device *bd = file->private_data; int __user *uarg = (int __user *) arg; |
2d507a01d [SCSI] libsas, bs... |
846 |
int ret; |
3d6392cfb bsg: support for ... |
847 |
|
3d6392cfb bsg: support for ... |
848 849 850 851 852 853 |
switch (cmd) { /* * our own ioctls */ case SG_GET_COMMAND_Q: return put_user(bd->max_queue, uarg); |
5309cb38d Add queue resizin... |
854 |
case SG_SET_COMMAND_Q: { |
3d6392cfb bsg: support for ... |
855 856 857 858 |
int queue; if (get_user(queue, uarg)) return -EFAULT; |
5309cb38d Add queue resizin... |
859 |
if (queue < 1) |
3d6392cfb bsg: support for ... |
860 |
return -EINVAL; |
5309cb38d Add queue resizin... |
861 |
spin_lock_irq(&bd->lock); |
3d6392cfb bsg: support for ... |
862 |
bd->max_queue = queue; |
5309cb38d Add queue resizin... |
863 |
spin_unlock_irq(&bd->lock); |
3d6392cfb bsg: support for ... |
864 865 866 867 868 869 870 871 872 873 874 875 876 877 |
return 0; } /* * SCSI/sg ioctls */ case SG_GET_VERSION_NUM: case SCSI_IOCTL_GET_IDLUN: case SCSI_IOCTL_GET_BUS_NUMBER: case SG_SET_TIMEOUT: case SG_GET_TIMEOUT: case SG_GET_RESERVED_SIZE: case SG_SET_RESERVED_SIZE: case SG_EMULATED_HOST: |
3d6392cfb bsg: support for ... |
878 879 |
case SCSI_IOCTL_SEND_COMMAND: { void __user *uarg = (void __user *) arg; |
74f3c8aff [PATCH] switch sc... |
880 |
return scsi_cmd_ioctl(bd->queue, NULL, file->f_mode, cmd, uarg); |
3d6392cfb bsg: support for ... |
881 |
} |
10e8855b9 bsg: add SG_IO to... |
882 883 |
case SG_IO: { struct request *rq; |
2c9ecdf40 bsg: add bidi sup... |
884 |
struct bio *bio, *bidi_bio = NULL; |
10e8855b9 bsg: add SG_IO to... |
885 |
struct sg_io_v4 hdr; |
05378940c bsg: add support ... |
886 |
int at_head; |
c1c201200 bsg: Fix sense bu... |
887 |
u8 sense[SCSI_SENSE_BUFFERSIZE]; |
10e8855b9 bsg: add SG_IO to... |
888 889 890 |
if (copy_from_user(&hdr, uarg, sizeof(hdr))) return -EFAULT; |
c1c201200 bsg: Fix sense bu... |
891 |
rq = bsg_map_hdr(bd, &hdr, file->f_mode & FMODE_WRITE, sense); |
10e8855b9 bsg: add SG_IO to... |
892 893 894 895 |
if (IS_ERR(rq)) return PTR_ERR(rq); bio = rq->bio; |
2c9ecdf40 bsg: add bidi sup... |
896 897 |
if (rq->next_rq) bidi_bio = rq->next_rq->bio; |
05378940c bsg: add support ... |
898 899 900 |
at_head = (0 == (hdr.flags & BSG_FLAG_Q_AT_TAIL)); blk_execute_rq(bd->queue, NULL, rq, at_head); |
2d507a01d [SCSI] libsas, bs... |
901 |
ret = blk_complete_sgv4_hdr_rq(rq, &hdr, bio, bidi_bio); |
10e8855b9 bsg: add SG_IO to... |
902 903 904 |
if (copy_to_user(uarg, &hdr, sizeof(hdr))) return -EFAULT; |
b711afa69 bsg: style cleanup |
905 |
|
2d507a01d [SCSI] libsas, bs... |
906 |
return ret; |
10e8855b9 bsg: add SG_IO to... |
907 |
} |
3d6392cfb bsg: support for ... |
908 909 910 911 912 913 914 915 916 917 918 |
/* * block device ioctls */ default: #if 0 return ioctl_by_bdev(bd->bdev, cmd, arg); #else return -ENOTTY; #endif } } |
7344be053 bsg: mark struct ... |
919 |
static const struct file_operations bsg_fops = { |
3d6392cfb bsg: support for ... |
920 921 922 923 924 |
.read = bsg_read, .write = bsg_write, .poll = bsg_poll, .open = bsg_open, .release = bsg_release, |
25fd16430 bsg: address vari... |
925 |
.unlocked_ioctl = bsg_ioctl, |
3d6392cfb bsg: support for ... |
926 927 |
.owner = THIS_MODULE, }; |
d351af01b bsg: bind bsg to ... |
928 |
void bsg_unregister_queue(struct request_queue *q) |
3d6392cfb bsg: support for ... |
929 |
{ |
d351af01b bsg: bind bsg to ... |
930 |
struct bsg_class_device *bcd = &q->bsg_dev; |
3d6392cfb bsg: support for ... |
931 |
|
df468820b [SCSI] bsg: fix b... |
932 933 |
if (!bcd->class_dev) return; |
3d6392cfb bsg: support for ... |
934 935 |
mutex_lock(&bsg_mutex); |
598443a21 [SCSI] bsg: use l... |
936 |
idr_remove(&bsg_minor_idr, bcd->minor); |
d351af01b bsg: bind bsg to ... |
937 |
sysfs_remove_link(&q->kobj, "bsg"); |
ee959b00c SCSI: convert str... |
938 |
device_unregister(bcd->class_dev); |
3d6392cfb bsg: support for ... |
939 |
bcd->class_dev = NULL; |
97f46ae45 [SCSI] bsg: add r... |
940 |
kref_put(&bcd->ref, bsg_kref_release_function); |
3d6392cfb bsg: support for ... |
941 942 |
mutex_unlock(&bsg_mutex); } |
4cf0723ac bsg: minor bug fixes |
943 |
EXPORT_SYMBOL_GPL(bsg_unregister_queue); |
3d6392cfb bsg: support for ... |
944 |
|
97f46ae45 [SCSI] bsg: add r... |
945 946 |
int bsg_register_queue(struct request_queue *q, struct device *parent, const char *name, void (*release)(struct device *)) |
3d6392cfb bsg: support for ... |
947 |
{ |
598443a21 [SCSI] bsg: use l... |
948 |
struct bsg_class_device *bcd; |
3d6392cfb bsg: support for ... |
949 |
dev_t dev; |
598443a21 [SCSI] bsg: use l... |
950 |
int ret, minor; |
ee959b00c SCSI: convert str... |
951 |
struct device *class_dev = NULL; |
39dca558a [SCSI] bsg: make ... |
952 953 954 955 956 |
const char *devname; if (name) devname = name; else |
3ada8b7e9 block: struct dev... |
957 |
devname = dev_name(parent); |
3d6392cfb bsg: support for ... |
958 959 960 961 962 963 |
/* * we need a proper transport to send commands, not a stacked device */ if (!q->request_fn) return 0; |
d351af01b bsg: bind bsg to ... |
964 |
bcd = &q->bsg_dev; |
3d6392cfb bsg: support for ... |
965 |
memset(bcd, 0, sizeof(*bcd)); |
3d6392cfb bsg: support for ... |
966 967 |
mutex_lock(&bsg_mutex); |
292b7f271 improve bsg devic... |
968 |
|
598443a21 [SCSI] bsg: use l... |
969 970 971 972 |
ret = idr_pre_get(&bsg_minor_idr, GFP_KERNEL); if (!ret) { ret = -ENOMEM; goto unlock; |
292b7f271 improve bsg devic... |
973 |
} |
598443a21 [SCSI] bsg: use l... |
974 975 976 |
ret = idr_get_new(&bsg_minor_idr, bcd, &minor); if (ret < 0) goto unlock; |
292b7f271 improve bsg devic... |
977 |
|
598443a21 [SCSI] bsg: use l... |
978 979 980 981 982 983 984 985 |
if (minor >= BSG_MAX_DEVS) { printk(KERN_ERR "bsg: too many bsg devices "); ret = -EINVAL; goto remove_idr; } bcd->minor = minor; |
d351af01b bsg: bind bsg to ... |
986 |
bcd->queue = q; |
97f46ae45 [SCSI] bsg: add r... |
987 988 989 |
bcd->parent = get_device(parent); bcd->release = release; kref_init(&bcd->ref); |
46f6ef4af bsg: convert to d... |
990 |
dev = MKDEV(bsg_major, bcd->minor); |
1ff9f542e device create: bl... |
991 |
class_dev = device_create(bsg_class, parent, dev, NULL, "%s", devname); |
4e2872d6b bind bsg to all S... |
992 993 |
if (IS_ERR(class_dev)) { ret = PTR_ERR(class_dev); |
598443a21 [SCSI] bsg: use l... |
994 |
goto put_dev; |
4e2872d6b bind bsg to all S... |
995 996 |
} bcd->class_dev = class_dev; |
abce891a1 Fix new generic b... |
997 |
if (q->kobj.sd) { |
4e2872d6b bind bsg to all S... |
998 999 |
ret = sysfs_create_link(&q->kobj, &bcd->class_dev->kobj, "bsg"); if (ret) |
598443a21 [SCSI] bsg: use l... |
1000 |
goto unregister_class_dev; |
4e2872d6b bind bsg to all S... |
1001 |
} |
3d6392cfb bsg: support for ... |
1002 1003 |
mutex_unlock(&bsg_mutex); return 0; |
6826ee4fd [SCSI] bsg: fix b... |
1004 |
|
598443a21 [SCSI] bsg: use l... |
1005 |
unregister_class_dev: |
ee959b00c SCSI: convert str... |
1006 |
device_unregister(class_dev); |
598443a21 [SCSI] bsg: use l... |
1007 |
put_dev: |
97f46ae45 [SCSI] bsg: add r... |
1008 |
put_device(parent); |
598443a21 [SCSI] bsg: use l... |
1009 1010 1011 |
remove_idr: idr_remove(&bsg_minor_idr, minor); unlock: |
264a04721 bsg: add cheasy e... |
1012 |
mutex_unlock(&bsg_mutex); |
4e2872d6b bind bsg to all S... |
1013 1014 |
return ret; } |
4cf0723ac bsg: minor bug fixes |
1015 |
EXPORT_SYMBOL_GPL(bsg_register_queue); |
4e2872d6b bind bsg to all S... |
1016 |
|
7e7654a92 cdev: remove unne... |
1017 |
static struct cdev bsg_cdev; |
292b7f271 improve bsg devic... |
1018 |
|
e454cea20 Driver-Core: exte... |
1019 |
static char *bsg_devnode(struct device *dev, mode_t *mode) |
2bdf91491 Driver Core: bsg:... |
1020 1021 1022 |
{ return kasprintf(GFP_KERNEL, "bsg/%s", dev_name(dev)); } |
3d6392cfb bsg: support for ... |
1023 1024 1025 |
static int __init bsg_init(void) { int ret, i; |
46f6ef4af bsg: convert to d... |
1026 |
dev_t devid; |
3d6392cfb bsg: support for ... |
1027 |
|
5309cb38d Add queue resizin... |
1028 |
bsg_cmd_cachep = kmem_cache_create("bsg_cmd", |
20c2df83d mm: Remove slab d... |
1029 |
sizeof(struct bsg_command), 0, 0, NULL); |
5309cb38d Add queue resizin... |
1030 1031 1032 1033 1034 |
if (!bsg_cmd_cachep) { printk(KERN_ERR "bsg: failed creating slab cache "); return -ENOMEM; } |
25fd16430 bsg: address vari... |
1035 |
for (i = 0; i < BSG_LIST_ARRAY_SIZE; i++) |
3d6392cfb bsg: support for ... |
1036 1037 1038 |
INIT_HLIST_HEAD(&bsg_device_list[i]); bsg_class = class_create(THIS_MODULE, "bsg"); |
5309cb38d Add queue resizin... |
1039 |
if (IS_ERR(bsg_class)) { |
9b9f770ce bsg: fix initiali... |
1040 1041 |
ret = PTR_ERR(bsg_class); goto destroy_kmemcache; |
5309cb38d Add queue resizin... |
1042 |
} |
e454cea20 Driver-Core: exte... |
1043 |
bsg_class->devnode = bsg_devnode; |
3d6392cfb bsg: support for ... |
1044 |
|
46f6ef4af bsg: convert to d... |
1045 |
ret = alloc_chrdev_region(&devid, 0, BSG_MAX_DEVS, "bsg"); |
9b9f770ce bsg: fix initiali... |
1046 1047 |
if (ret) goto destroy_bsg_class; |
292b7f271 improve bsg devic... |
1048 |
|
46f6ef4af bsg: convert to d... |
1049 |
bsg_major = MAJOR(devid); |
292b7f271 improve bsg devic... |
1050 |
cdev_init(&bsg_cdev, &bsg_fops); |
46f6ef4af bsg: convert to d... |
1051 |
ret = cdev_add(&bsg_cdev, MKDEV(bsg_major, 0), BSG_MAX_DEVS); |
9b9f770ce bsg: fix initiali... |
1052 1053 |
if (ret) goto unregister_chrdev; |
3d6392cfb bsg: support for ... |
1054 |
|
5d3a8cd34 bsg: fix missing ... |
1055 |
printk(KERN_INFO BSG_DESCRIPTION " version " BSG_VERSION |
0ed081ce2 bsg: minor cleanup |
1056 1057 |
" loaded (major %d) ", bsg_major); |
3d6392cfb bsg: support for ... |
1058 |
return 0; |
9b9f770ce bsg: fix initiali... |
1059 1060 1061 1062 1063 1064 1065 |
unregister_chrdev: unregister_chrdev_region(MKDEV(bsg_major, 0), BSG_MAX_DEVS); destroy_bsg_class: class_destroy(bsg_class); destroy_kmemcache: kmem_cache_destroy(bsg_cmd_cachep); return ret; |
3d6392cfb bsg: support for ... |
1066 1067 1068 |
} MODULE_AUTHOR("Jens Axboe"); |
0ed081ce2 bsg: minor cleanup |
1069 |
MODULE_DESCRIPTION(BSG_DESCRIPTION); |
3d6392cfb bsg: support for ... |
1070 |
MODULE_LICENSE("GPL"); |
4e2872d6b bind bsg to all S... |
1071 |
device_initcall(bsg_init); |