1 /*-
2 * Generic SCSI Target Kernel Mode Driver
3 *
4 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
5 *
6 * Copyright (c) 2002 Nate Lawson.
7 * Copyright (c) 1998, 1999, 2001, 2002 Justin T. Gibbs.
8 * All rights reserved.
9 *
10 * Redistribution and use in source and binary forms, with or without
11 * modification, are permitted provided that the following conditions
12 * are met:
13 * 1. Redistributions of source code must retain the above copyright
14 * notice, this list of conditions, and the following disclaimer,
15 * without modification, immediately at the beginning of the file.
16 * 2. The name of the author may not be used to endorse or promote products
17 * derived from this software without specific prior written permission.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
20 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
21 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
22 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
23 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
24 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
25 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
26 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
27 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
28 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
29 * SUCH DAMAGE.
30 */
31
32 #include <sys/cdefs.h>
33 __FBSDID("$FreeBSD$");
34
35 #include <sys/param.h>
36 #include <sys/systm.h>
37 #include <sys/kernel.h>
38 #include <sys/conf.h>
39 #include <sys/malloc.h>
40 #include <sys/poll.h>
41 #include <sys/vnode.h>
42 #include <sys/lock.h>
43 #include <sys/mutex.h>
44 #include <sys/devicestat.h>
45 #include <sys/proc.h>
46 /* Includes to support callout */
47 #include <sys/types.h>
48 #include <sys/systm.h>
49
50 #include <cam/cam.h>
51 #include <cam/cam_ccb.h>
52 #include <cam/cam_periph.h>
53 #include <cam/cam_xpt_periph.h>
54 #include <cam/cam_sim.h>
55 #include <cam/scsi/scsi_targetio.h>
56
57 /* Transaction information attached to each CCB sent by the user */
58 struct targ_cmd_descr {
59 struct cam_periph_map_info mapinfo;
60 TAILQ_ENTRY(targ_cmd_descr) tqe;
61 union ccb *user_ccb;
62 int priority;
63 int func_code;
64 };
65
66 /* Offset into the private CCB area for storing our descriptor */
67 #define targ_descr periph_priv.entries[1].ptr
68
69 TAILQ_HEAD(descr_queue, targ_cmd_descr);
70
71 typedef enum {
72 TARG_STATE_RESV = 0x00, /* Invalid state */
73 TARG_STATE_OPENED = 0x01, /* Device opened, softc initialized */
74 TARG_STATE_LUN_ENABLED = 0x02 /* Device enabled for a path */
75 } targ_state;
76
77 /* Per-instance device software context */
78 struct targ_softc {
79 /* CCBs (CTIOs, ATIOs, INOTs) pending on the controller */
80 struct ccb_queue pending_ccb_queue;
81
82 /* Command descriptors awaiting CTIO resources from the XPT */
83 struct descr_queue work_queue;
84
85 /* Command descriptors that have been aborted back to the user. */
86 struct descr_queue abort_queue;
87
88 /*
89 * Queue of CCBs that have been copied out to userland, but our
90 * userland daemon has not yet seen.
91 */
92 struct ccb_queue user_ccb_queue;
93
94 struct cam_periph *periph;
95 struct cam_path *path;
96 targ_state state;
97 u_int maxio;
98 struct selinfo read_select;
99 struct devstat device_stats;
100 };
101
102 static d_open_t targopen;
103 static d_read_t targread;
104 static d_write_t targwrite;
105 static d_ioctl_t targioctl;
106 static d_poll_t targpoll;
107 static d_kqfilter_t targkqfilter;
108 static void targreadfiltdetach(struct knote *kn);
109 static int targreadfilt(struct knote *kn, long hint);
110 static struct filterops targread_filtops = {
111 .f_isfd = 1,
112 .f_detach = targreadfiltdetach,
113 .f_event = targreadfilt,
114 };
115
116 static struct cdevsw targ_cdevsw = {
117 .d_version = D_VERSION,
118 .d_open = targopen,
119 .d_read = targread,
120 .d_write = targwrite,
121 .d_ioctl = targioctl,
122 .d_poll = targpoll,
123 .d_name = "targ",
124 .d_kqfilter = targkqfilter
125 };
126
127 static cam_status targendislun(struct cam_path *path, int enable,
128 int grp6_len, int grp7_len);
129 static cam_status targenable(struct targ_softc *softc,
130 struct cam_path *path,
131 int grp6_len, int grp7_len);
132 static cam_status targdisable(struct targ_softc *softc);
133 static periph_ctor_t targctor;
134 static periph_dtor_t targdtor;
135 static periph_start_t targstart;
136 static int targusermerge(struct targ_softc *softc,
137 struct targ_cmd_descr *descr,
138 union ccb *ccb);
139 static int targsendccb(struct targ_softc *softc, union ccb *ccb,
140 struct targ_cmd_descr *descr);
141 static void targdone(struct cam_periph *periph,
142 union ccb *done_ccb);
143 static int targreturnccb(struct targ_softc *softc,
144 union ccb *ccb);
145 static union ccb * targgetccb(struct targ_softc *softc, xpt_opcode type,
146 int priority);
147 static void targfreeccb(struct targ_softc *softc, union ccb *ccb);
148 static struct targ_cmd_descr *
149 targgetdescr(struct targ_softc *softc);
150 static periph_init_t targinit;
151 static void targasync(void *callback_arg, u_int32_t code,
152 struct cam_path *path, void *arg);
153 static void abort_all_pending(struct targ_softc *softc);
154 static void notify_user(struct targ_softc *softc);
155 static int targcamstatus(cam_status status);
156 static size_t targccblen(xpt_opcode func_code);
157
158 static struct periph_driver targdriver =
159 {
160 targinit, "targ",
161 TAILQ_HEAD_INITIALIZER(targdriver.units), /* generation */ 0
162 };
163 PERIPHDRIVER_DECLARE(targ, targdriver);
164
165 static MALLOC_DEFINE(M_TARG, "TARG", "TARG data");
166
167 /* Disable LUN if enabled and teardown softc */
168 static void
169 targcdevdtor(void *data)
170 {
171 struct targ_softc *softc;
172 struct cam_periph *periph;
173
174 softc = data;
175 if (softc->periph == NULL) {
176 printf("%s: destroying non-enabled target\n", __func__);
177 free(softc, M_TARG);
178 return;
179 }
180
181 /*
182 * Acquire a hold on the periph so that it doesn't go away before
183 * we are ready at the end of the function.
184 */
185 periph = softc->periph;
186 cam_periph_acquire(periph);
187 cam_periph_lock(periph);
188 (void)targdisable(softc);
189 if (softc->periph != NULL) {
190 cam_periph_invalidate(softc->periph);
191 softc->periph = NULL;
192 }
193 cam_periph_unlock(periph);
194 cam_periph_release(periph);
195 free(softc, M_TARG);
196 }
197
198 /*
199 * Create softc and initialize it. There is no locking here because a
200 * periph doesn't get created until an ioctl is issued to do so, and
201 * that can't happen until this method returns.
202 */
203 static int
204 targopen(struct cdev *dev, int flags, int fmt, struct thread *td)
205 {
206 struct targ_softc *softc;
207
208 /* Allocate its softc, initialize it */
209 softc = malloc(sizeof(*softc), M_TARG,
210 M_WAITOK | M_ZERO);
211 softc->state = TARG_STATE_OPENED;
212 softc->periph = NULL;
213 softc->path = NULL;
214
215 TAILQ_INIT(&softc->pending_ccb_queue);
216 TAILQ_INIT(&softc->work_queue);
217 TAILQ_INIT(&softc->abort_queue);
218 TAILQ_INIT(&softc->user_ccb_queue);
219 knlist_init_mtx(&softc->read_select.si_note, NULL);
220
221 devfs_set_cdevpriv(softc, targcdevdtor);
222 return (0);
223 }
224
225 /* Enable/disable LUNs, set debugging level */
226 static int
227 targioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag, struct thread *td)
228 {
229 struct targ_softc *softc;
230 cam_status status;
231
232 devfs_get_cdevpriv((void **)&softc);
233
234 switch (cmd) {
235 case TARGIOCENABLE:
236 {
237 struct ioc_enable_lun *new_lun;
238 struct cam_path *path;
239
240 new_lun = (struct ioc_enable_lun *)addr;
241 status = xpt_create_path(&path, /*periph*/NULL,
242 new_lun->path_id,
243 new_lun->target_id,
244 new_lun->lun_id);
245 if (status != CAM_REQ_CMP) {
246 printf("Couldn't create path, status %#x\n", status);
247 break;
248 }
249 xpt_path_lock(path);
250 status = targenable(softc, path, new_lun->grp6_len,
251 new_lun->grp7_len);
252 xpt_path_unlock(path);
253 xpt_free_path(path);
254 break;
255 }
256 case TARGIOCDISABLE:
257 if (softc->periph == NULL) {
258 status = CAM_DEV_NOT_THERE;
259 break;
260 }
261 cam_periph_lock(softc->periph);
262 status = targdisable(softc);
263 cam_periph_unlock(softc->periph);
264 break;
265 case TARGIOCDEBUG:
266 {
267 struct ccb_debug cdbg;
268
269 /* If no periph available, disallow debugging changes */
270 if ((softc->state & TARG_STATE_LUN_ENABLED) == 0) {
271 status = CAM_DEV_NOT_THERE;
272 break;
273 }
274 bzero(&cdbg, sizeof cdbg);
275 if (*((int *)addr) != 0)
276 cdbg.flags = CAM_DEBUG_PERIPH;
277 else
278 cdbg.flags = CAM_DEBUG_NONE;
279 xpt_setup_ccb(&cdbg.ccb_h, softc->path, CAM_PRIORITY_NORMAL);
280 cdbg.ccb_h.func_code = XPT_DEBUG;
281 cdbg.ccb_h.cbfcnp = targdone;
282 xpt_action((union ccb *)&cdbg);
283 status = cdbg.ccb_h.status & CAM_STATUS_MASK;
284 break;
285 }
286 default:
287 status = CAM_PROVIDE_FAIL;
288 break;
289 }
290
291 return (targcamstatus(status));
292 }
293
294 /* Writes are always ready, reads wait for user_ccb_queue or abort_queue */
295 static int
296 targpoll(struct cdev *dev, int poll_events, struct thread *td)
297 {
298 struct targ_softc *softc;
299 int revents;
300
301 devfs_get_cdevpriv((void **)&softc);
302
303 /* Poll for write() is always ok. */
304 revents = poll_events & (POLLOUT | POLLWRNORM);
305 if ((poll_events & (POLLIN | POLLRDNORM)) != 0) {
306 /* Poll for read() depends on user and abort queues. */
307 cam_periph_lock(softc->periph);
308 if (!TAILQ_EMPTY(&softc->user_ccb_queue) ||
309 !TAILQ_EMPTY(&softc->abort_queue)) {
310 revents |= poll_events & (POLLIN | POLLRDNORM);
311 }
312 cam_periph_unlock(softc->periph);
313 /* Only sleep if the user didn't poll for write. */
314 if (revents == 0)
315 selrecord(td, &softc->read_select);
316 }
317
318 return (revents);
319 }
320
321 static int
322 targkqfilter(struct cdev *dev, struct knote *kn)
323 {
324 struct targ_softc *softc;
325
326 devfs_get_cdevpriv((void **)&softc);
327 kn->kn_hook = (caddr_t)softc;
328 kn->kn_fop = &targread_filtops;
329 knlist_add(&softc->read_select.si_note, kn, 0);
330 return (0);
331 }
332
333 static void
334 targreadfiltdetach(struct knote *kn)
335 {
336 struct targ_softc *softc;
337
338 softc = (struct targ_softc *)kn->kn_hook;
339 knlist_remove(&softc->read_select.si_note, kn, 0);
340 }
341
342 /* Notify the user's kqueue when the user queue or abort queue gets a CCB */
343 static int
344 targreadfilt(struct knote *kn, long hint)
345 {
346 struct targ_softc *softc;
347 int retval;
348
349 softc = (struct targ_softc *)kn->kn_hook;
350 cam_periph_lock(softc->periph);
351 retval = !TAILQ_EMPTY(&softc->user_ccb_queue) ||
352 !TAILQ_EMPTY(&softc->abort_queue);
353 cam_periph_unlock(softc->periph);
354 return (retval);
355 }
356
357 /* Send the HBA the enable/disable message */
358 static cam_status
359 targendislun(struct cam_path *path, int enable, int grp6_len, int grp7_len)
360 {
361 struct ccb_en_lun en_ccb;
362 cam_status status;
363
364 /* Tell the lun to begin answering selects */
365 memset(&en_ccb, 0, sizeof(en_ccb));
366 xpt_setup_ccb(&en_ccb.ccb_h, path, CAM_PRIORITY_NORMAL);
367 en_ccb.ccb_h.func_code = XPT_EN_LUN;
368 /* Don't need support for any vendor specific commands */
369 en_ccb.grp6_len = grp6_len;
370 en_ccb.grp7_len = grp7_len;
371 en_ccb.enable = enable ? 1 : 0;
372 xpt_action((union ccb *)&en_ccb);
373 status = en_ccb.ccb_h.status & CAM_STATUS_MASK;
374 if (status != CAM_REQ_CMP) {
375 xpt_print(path, "%sable lun CCB rejected, status %#x\n",
376 enable ? "en" : "dis", status);
377 }
378 return (status);
379 }
380
381 /* Enable target mode on a LUN, given its path */
382 static cam_status
383 targenable(struct targ_softc *softc, struct cam_path *path, int grp6_len,
384 int grp7_len)
385 {
386 struct cam_periph *periph;
387 struct ccb_pathinq cpi;
388 cam_status status;
389
390 if ((softc->state & TARG_STATE_LUN_ENABLED) != 0)
391 return (CAM_LUN_ALRDY_ENA);
392
393 /* Make sure SIM supports target mode */
394 xpt_path_inq(&cpi, path);
395 status = cpi.ccb_h.status & CAM_STATUS_MASK;
396 if (status != CAM_REQ_CMP) {
397 printf("pathinq failed, status %#x\n", status);
398 goto enable_fail;
399 }
400 if ((cpi.target_sprt & PIT_PROCESSOR) == 0) {
401 printf("controller does not support target mode\n");
402 status = CAM_FUNC_NOTAVAIL;
403 goto enable_fail;
404 }
405 if (cpi.maxio == 0)
406 softc->maxio = DFLTPHYS; /* traditional default */
407 else if (cpi.maxio > maxphys)
408 softc->maxio = maxphys; /* for safety */
409 else
410 softc->maxio = cpi.maxio; /* real value */
411
412 /* Destroy any periph on our path if it is disabled */
413 periph = cam_periph_find(path, "targ");
414 if (periph != NULL) {
415 struct targ_softc *del_softc;
416
417 del_softc = (struct targ_softc *)periph->softc;
418 if ((del_softc->state & TARG_STATE_LUN_ENABLED) == 0) {
419 cam_periph_invalidate(del_softc->periph);
420 del_softc->periph = NULL;
421 } else {
422 printf("Requested path still in use by targ%d\n",
423 periph->unit_number);
424 status = CAM_LUN_ALRDY_ENA;
425 goto enable_fail;
426 }
427 }
428
429 /* Create a periph instance attached to this path */
430 status = cam_periph_alloc(targctor, NULL, targdtor, targstart,
431 "targ", CAM_PERIPH_BIO, path, targasync, 0, softc);
432 if (status != CAM_REQ_CMP) {
433 printf("cam_periph_alloc failed, status %#x\n", status);
434 goto enable_fail;
435 }
436
437 /* Ensure that the periph now exists. */
438 if (cam_periph_find(path, "targ") == NULL) {
439 panic("targenable: succeeded but no periph?");
440 /* NOTREACHED */
441 }
442
443 /* Send the enable lun message */
444 status = targendislun(path, /*enable*/1, grp6_len, grp7_len);
445 if (status != CAM_REQ_CMP) {
446 printf("enable lun failed, status %#x\n", status);
447 goto enable_fail;
448 }
449 softc->state |= TARG_STATE_LUN_ENABLED;
450
451 enable_fail:
452 return (status);
453 }
454
455 /* Disable this softc's target instance if enabled */
456 static cam_status
457 targdisable(struct targ_softc *softc)
458 {
459 cam_status status;
460
461 if ((softc->state & TARG_STATE_LUN_ENABLED) == 0)
462 return (CAM_REQ_CMP);
463
464 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH, ("targdisable\n"));
465
466 /* Abort any ccbs pending on the controller */
467 abort_all_pending(softc);
468
469 /* Disable this lun */
470 status = targendislun(softc->path, /*enable*/0,
471 /*grp6_len*/0, /*grp7_len*/0);
472 if (status == CAM_REQ_CMP)
473 softc->state &= ~TARG_STATE_LUN_ENABLED;
474 else
475 printf("Disable lun failed, status %#x\n", status);
476
477 return (status);
478 }
479
480 /* Initialize a periph (called from cam_periph_alloc) */
481 static cam_status
482 targctor(struct cam_periph *periph, void *arg)
483 {
484 struct targ_softc *softc;
485
486 /* Store pointer to softc for periph-driven routines */
487 softc = (struct targ_softc *)arg;
488 periph->softc = softc;
489 softc->periph = periph;
490 softc->path = periph->path;
491 return (CAM_REQ_CMP);
492 }
493
494 static void
495 targdtor(struct cam_periph *periph)
496 {
497 struct targ_softc *softc;
498 struct ccb_hdr *ccb_h;
499 struct targ_cmd_descr *descr;
500
501 softc = (struct targ_softc *)periph->softc;
502
503 /*
504 * targdisable() aborts CCBs back to the user and leaves them
505 * on user_ccb_queue and abort_queue in case the user is still
506 * interested in them. We free them now.
507 */
508 while ((ccb_h = TAILQ_FIRST(&softc->user_ccb_queue)) != NULL) {
509 TAILQ_REMOVE(&softc->user_ccb_queue, ccb_h, periph_links.tqe);
510 targfreeccb(softc, (union ccb *)ccb_h);
511 }
512 while ((descr = TAILQ_FIRST(&softc->abort_queue)) != NULL) {
513 TAILQ_REMOVE(&softc->abort_queue, descr, tqe);
514 free(descr, M_TARG);
515 }
516
517 softc->periph = NULL;
518 softc->path = NULL;
519 periph->softc = NULL;
520 }
521
522 /* Receive CCBs from user mode proc and send them to the HBA */
523 static int
524 targwrite(struct cdev *dev, struct uio *uio, int ioflag)
525 {
526 union ccb *user_ccb;
527 struct targ_softc *softc;
528 struct targ_cmd_descr *descr;
529 int write_len, error;
530 int func_code, priority;
531
532 devfs_get_cdevpriv((void **)&softc);
533 write_len = error = 0;
534 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH,
535 ("write - uio_resid %zd\n", uio->uio_resid));
536 while (uio->uio_resid >= sizeof(user_ccb) && error == 0) {
537 union ccb *ccb;
538
539 error = uiomove((caddr_t)&user_ccb, sizeof(user_ccb), uio);
540 if (error != 0) {
541 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH,
542 ("write - uiomove failed (%d)\n", error));
543 break;
544 }
545 priority = fuword32(&user_ccb->ccb_h.pinfo.priority);
546 if (priority == CAM_PRIORITY_NONE) {
547 error = EINVAL;
548 break;
549 }
550 func_code = fuword32(&user_ccb->ccb_h.func_code);
551 switch (func_code) {
552 case XPT_ACCEPT_TARGET_IO:
553 case XPT_IMMED_NOTIFY:
554 case XPT_IMMEDIATE_NOTIFY:
555 cam_periph_lock(softc->periph);
556 ccb = targgetccb(softc, func_code, priority);
557 descr = (struct targ_cmd_descr *)ccb->ccb_h.targ_descr;
558 descr->user_ccb = user_ccb;
559 descr->func_code = func_code;
560 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH,
561 ("Sent ATIO/INOT (%p)\n", user_ccb));
562 xpt_action(ccb);
563 TAILQ_INSERT_TAIL(&softc->pending_ccb_queue,
564 &ccb->ccb_h,
565 periph_links.tqe);
566 cam_periph_unlock(softc->periph);
567 break;
568 default:
569 cam_periph_lock(softc->periph);
570 if ((func_code & XPT_FC_QUEUED) != 0) {
571 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH,
572 ("Sending queued ccb %#x (%p)\n",
573 func_code, user_ccb));
574 descr = targgetdescr(softc);
575 descr->user_ccb = user_ccb;
576 descr->priority = priority;
577 descr->func_code = func_code;
578 TAILQ_INSERT_TAIL(&softc->work_queue,
579 descr, tqe);
580 xpt_schedule(softc->periph, priority);
581 } else {
582 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH,
583 ("Sending inline ccb %#x (%p)\n",
584 func_code, user_ccb));
585 ccb = targgetccb(softc, func_code, priority);
586 descr = (struct targ_cmd_descr *)
587 ccb->ccb_h.targ_descr;
588 descr->user_ccb = user_ccb;
589 descr->priority = priority;
590 descr->func_code = func_code;
591 if (targusermerge(softc, descr, ccb) != EFAULT)
592 targsendccb(softc, ccb, descr);
593 targreturnccb(softc, ccb);
594 }
595 cam_periph_unlock(softc->periph);
596 break;
597 }
598 write_len += sizeof(user_ccb);
599 }
600
601 /*
602 * If we've successfully taken in some amount of
603 * data, return success for that data first. If
604 * an error is persistent, it will be reported
605 * on the next write.
606 */
607 if (error != 0 && write_len == 0)
608 return (error);
609 if (write_len == 0 && uio->uio_resid != 0)
610 return (ENOSPC);
611 return (0);
612 }
613
614 /* Process requests (descrs) via the periph-supplied CCBs */
615 static void
616 targstart(struct cam_periph *periph, union ccb *start_ccb)
617 {
618 struct targ_softc *softc;
619 struct targ_cmd_descr *descr, *next_descr;
620 int error;
621
622 softc = (struct targ_softc *)periph->softc;
623 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH, ("targstart %p\n", start_ccb));
624
625 descr = TAILQ_FIRST(&softc->work_queue);
626 if (descr == NULL) {
627 xpt_release_ccb(start_ccb);
628 } else {
629 TAILQ_REMOVE(&softc->work_queue, descr, tqe);
630 next_descr = TAILQ_FIRST(&softc->work_queue);
631
632 /* Initiate a transaction using the descr and supplied CCB */
633 error = targusermerge(softc, descr, start_ccb);
634 if (error == 0)
635 error = targsendccb(softc, start_ccb, descr);
636 if (error != 0) {
637 xpt_print(periph->path,
638 "targsendccb failed, err %d\n", error);
639 xpt_release_ccb(start_ccb);
640 suword(&descr->user_ccb->ccb_h.status,
641 CAM_REQ_CMP_ERR);
642 TAILQ_INSERT_TAIL(&softc->abort_queue, descr, tqe);
643 notify_user(softc);
644 }
645
646 /* If we have more work to do, stay scheduled */
647 if (next_descr != NULL)
648 xpt_schedule(periph, next_descr->priority);
649 }
650 }
651
652 static int
653 targusermerge(struct targ_softc *softc, struct targ_cmd_descr *descr,
654 union ccb *ccb)
655 {
656 struct ccb_hdr *u_ccbh, *k_ccbh;
657 size_t ccb_len;
658 int error;
659
660 u_ccbh = &descr->user_ccb->ccb_h;
661 k_ccbh = &ccb->ccb_h;
662
663 /*
664 * There are some fields in the CCB header that need to be
665 * preserved, the rest we get from the user ccb. (See xpt_merge_ccb)
666 */
667 xpt_setup_ccb(k_ccbh, softc->path, descr->priority);
668 k_ccbh->retry_count = fuword32(&u_ccbh->retry_count);
669 k_ccbh->func_code = descr->func_code;
670 k_ccbh->flags = fuword32(&u_ccbh->flags);
671 k_ccbh->timeout = fuword32(&u_ccbh->timeout);
672 ccb_len = targccblen(k_ccbh->func_code) - sizeof(struct ccb_hdr);
673 error = copyin(u_ccbh + 1, k_ccbh + 1, ccb_len);
674 if (error != 0) {
675 k_ccbh->status = CAM_REQ_CMP_ERR;
676 return (error);
677 }
678
679 /* Translate usermode abort_ccb pointer to its kernel counterpart */
680 if (k_ccbh->func_code == XPT_ABORT) {
681 struct ccb_abort *cab;
682 struct ccb_hdr *ccb_h;
683
684 cab = (struct ccb_abort *)ccb;
685 TAILQ_FOREACH(ccb_h, &softc->pending_ccb_queue,
686 periph_links.tqe) {
687 struct targ_cmd_descr *ab_descr;
688
689 ab_descr = (struct targ_cmd_descr *)ccb_h->targ_descr;
690 if (ab_descr->user_ccb == cab->abort_ccb) {
691 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH,
692 ("Changing abort for %p to %p\n",
693 cab->abort_ccb, ccb_h));
694 cab->abort_ccb = (union ccb *)ccb_h;
695 break;
696 }
697 }
698 /* CCB not found, set appropriate status */
699 if (ccb_h == NULL) {
700 k_ccbh->status = CAM_PATH_INVALID;
701 error = ESRCH;
702 }
703 }
704
705 return (error);
706 }
707
708 /* Build and send a kernel CCB formed from descr->user_ccb */
709 static int
710 targsendccb(struct targ_softc *softc, union ccb *ccb,
711 struct targ_cmd_descr *descr)
712 {
713 struct cam_periph_map_info *mapinfo;
714 struct ccb_hdr *ccb_h;
715 int error;
716
717 ccb_h = &ccb->ccb_h;
718 mapinfo = &descr->mapinfo;
719 mapinfo->num_bufs_used = 0;
720
721 /*
722 * There's no way for the user to have a completion
723 * function, so we put our own completion function in here.
724 * We also stash in a reference to our descriptor so targreturnccb()
725 * can find our mapping info.
726 */
727 ccb_h->cbfcnp = targdone;
728 ccb_h->targ_descr = descr;
729
730 if ((ccb_h->func_code == XPT_CONT_TARGET_IO) ||
731 (ccb_h->func_code == XPT_DEV_MATCH)) {
732 error = cam_periph_mapmem(ccb, mapinfo, softc->maxio);
733
734 /*
735 * cam_periph_mapmem returned an error, we can't continue.
736 * Return the error to the user.
737 */
738 if (error) {
739 ccb_h->status = CAM_REQ_CMP_ERR;
740 mapinfo->num_bufs_used = 0;
741 return (error);
742 }
743 }
744
745 /*
746 * Once queued on the pending CCB list, this CCB will be protected
747 * by our error recovery handler.
748 */
749 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH, ("sendccb %p\n", ccb));
750 if (XPT_FC_IS_QUEUED(ccb)) {
751 TAILQ_INSERT_TAIL(&softc->pending_ccb_queue, ccb_h,
752 periph_links.tqe);
753 }
754 xpt_action(ccb);
755
756 return (0);
757 }
758
759 /* Completion routine for CCBs (called at splsoftcam) */
760 static void
761 targdone(struct cam_periph *periph, union ccb *done_ccb)
762 {
763 struct targ_softc *softc;
764
765 CAM_DEBUG(periph->path, CAM_DEBUG_PERIPH, ("targdone %p\n", done_ccb));
766 softc = (struct targ_softc *)periph->softc;
767 TAILQ_REMOVE(&softc->pending_ccb_queue, &done_ccb->ccb_h,
768 periph_links.tqe);
769
770 /* If we're no longer enabled, throw away CCB */
771 if ((softc->state & TARG_STATE_LUN_ENABLED) == 0) {
772 targfreeccb(softc, done_ccb);
773 return;
774 }
775 /* abort_all_pending() waits for pending queue to be empty */
776 if (TAILQ_EMPTY(&softc->pending_ccb_queue))
777 wakeup(&softc->pending_ccb_queue);
778
779 switch (done_ccb->ccb_h.func_code) {
780 /* All FC_*_QUEUED CCBs go back to userland */
781 case XPT_IMMED_NOTIFY:
782 case XPT_IMMEDIATE_NOTIFY:
783 case XPT_ACCEPT_TARGET_IO:
784 case XPT_CONT_TARGET_IO:
785 TAILQ_INSERT_TAIL(&softc->user_ccb_queue, &done_ccb->ccb_h,
786 periph_links.tqe);
787 cam_periph_unlock(softc->periph);
788 notify_user(softc);
789 cam_periph_lock(softc->periph);
790 break;
791 default:
792 panic("targdone: impossible xpt opcode %#x",
793 done_ccb->ccb_h.func_code);
794 /* NOTREACHED */
795 }
796 }
797
798 /* Return CCBs to the user from the user queue and abort queue */
799 static int
800 targread(struct cdev *dev, struct uio *uio, int ioflag)
801 {
802 struct descr_queue *abort_queue;
803 struct targ_cmd_descr *user_descr;
804 struct targ_softc *softc;
805 struct ccb_queue *user_queue;
806 struct ccb_hdr *ccb_h;
807 union ccb *user_ccb;
808 int read_len, error;
809
810 error = 0;
811 read_len = 0;
812 devfs_get_cdevpriv((void **)&softc);
813 user_queue = &softc->user_ccb_queue;
814 abort_queue = &softc->abort_queue;
815 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH, ("targread\n"));
816
817 /* If no data is available, wait or return immediately */
818 cam_periph_lock(softc->periph);
819 ccb_h = TAILQ_FIRST(user_queue);
820 user_descr = TAILQ_FIRST(abort_queue);
821 while (ccb_h == NULL && user_descr == NULL) {
822 if ((ioflag & IO_NDELAY) == 0) {
823 error = cam_periph_sleep(softc->periph, user_queue,
824 PRIBIO | PCATCH, "targrd", 0);
825 ccb_h = TAILQ_FIRST(user_queue);
826 user_descr = TAILQ_FIRST(abort_queue);
827 if (error != 0) {
828 if (error == ERESTART) {
829 continue;
830 } else {
831 goto read_fail;
832 }
833 }
834 } else {
835 cam_periph_unlock(softc->periph);
836 return (EAGAIN);
837 }
838 }
839
840 /* Data is available so fill the user's buffer */
841 while (ccb_h != NULL) {
842 struct targ_cmd_descr *descr;
843
844 if (uio->uio_resid < sizeof(user_ccb))
845 break;
846 TAILQ_REMOVE(user_queue, ccb_h, periph_links.tqe);
847 descr = (struct targ_cmd_descr *)ccb_h->targ_descr;
848 user_ccb = descr->user_ccb;
849 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH,
850 ("targread ccb %p (%p)\n", ccb_h, user_ccb));
851 error = targreturnccb(softc, (union ccb *)ccb_h);
852 if (error != 0)
853 goto read_fail;
854 cam_periph_unlock(softc->periph);
855 error = uiomove((caddr_t)&user_ccb, sizeof(user_ccb), uio);
856 cam_periph_lock(softc->periph);
857 if (error != 0)
858 goto read_fail;
859 read_len += sizeof(user_ccb);
860
861 ccb_h = TAILQ_FIRST(user_queue);
862 }
863
864 /* Flush out any aborted descriptors */
865 while (user_descr != NULL) {
866 if (uio->uio_resid < sizeof(user_ccb))
867 break;
868 TAILQ_REMOVE(abort_queue, user_descr, tqe);
869 user_ccb = user_descr->user_ccb;
870 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH,
871 ("targread aborted descr %p (%p)\n",
872 user_descr, user_ccb));
873 suword(&user_ccb->ccb_h.status, CAM_REQ_ABORTED);
874 cam_periph_unlock(softc->periph);
875 error = uiomove((caddr_t)&user_ccb, sizeof(user_ccb), uio);
876 cam_periph_lock(softc->periph);
877 if (error != 0)
878 goto read_fail;
879 read_len += sizeof(user_ccb);
880
881 user_descr = TAILQ_FIRST(abort_queue);
882 }
883
884 /*
885 * If we've successfully read some amount of data, don't report an
886 * error. If the error is persistent, it will be reported on the
887 * next read().
888 */
889 if (read_len == 0 && uio->uio_resid != 0)
890 error = ENOSPC;
891
892 read_fail:
893 cam_periph_unlock(softc->periph);
894 return (error);
895 }
896
897 /* Copy completed ccb back to the user */
898 static int
899 targreturnccb(struct targ_softc *softc, union ccb *ccb)
900 {
901 struct targ_cmd_descr *descr;
902 struct ccb_hdr *u_ccbh;
903 size_t ccb_len;
904 int error;
905
906 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH, ("targreturnccb %p\n", ccb));
907 descr = (struct targ_cmd_descr *)ccb->ccb_h.targ_descr;
908 u_ccbh = &descr->user_ccb->ccb_h;
909
910 /* Copy out the central portion of the ccb_hdr */
911 copyout(&ccb->ccb_h.retry_count, &u_ccbh->retry_count,
912 offsetof(struct ccb_hdr, periph_priv) -
913 offsetof(struct ccb_hdr, retry_count));
914
915 /* Copy out the rest of the ccb (after the ccb_hdr) */
916 ccb_len = targccblen(ccb->ccb_h.func_code) - sizeof(struct ccb_hdr);
917 if (descr->mapinfo.num_bufs_used != 0)
918 cam_periph_unmapmem(ccb, &descr->mapinfo);
919 error = copyout(&ccb->ccb_h + 1, u_ccbh + 1, ccb_len);
920 if (error != 0) {
921 xpt_print(softc->path,
922 "targreturnccb - CCB copyout failed (%d)\n", error);
923 }
924 /* Free CCB or send back to devq. */
925 targfreeccb(softc, ccb);
926
927 return (error);
928 }
929
930 static union ccb *
931 targgetccb(struct targ_softc *softc, xpt_opcode type, int priority)
932 {
933 union ccb *ccb;
934 int ccb_len;
935
936 ccb_len = targccblen(type);
937 ccb = malloc(ccb_len, M_TARG, M_NOWAIT | M_ZERO);
938 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH, ("getccb %p\n", ccb));
939 if (ccb == NULL) {
940 return (ccb);
941 }
942 xpt_setup_ccb(&ccb->ccb_h, softc->path, priority);
943 ccb->ccb_h.func_code = type;
944 ccb->ccb_h.cbfcnp = targdone;
945 ccb->ccb_h.targ_descr = targgetdescr(softc);
946 if (ccb->ccb_h.targ_descr == NULL) {
947 free (ccb, M_TARG);
948 ccb = NULL;
949 }
950 return (ccb);
951 }
952
953 static void
954 targfreeccb(struct targ_softc *softc, union ccb *ccb)
955 {
956 CAM_DEBUG_PRINT(CAM_DEBUG_PERIPH, ("targfreeccb descr %p and\n",
957 ccb->ccb_h.targ_descr));
958 free(ccb->ccb_h.targ_descr, M_TARG);
959
960 switch (ccb->ccb_h.func_code) {
961 case XPT_ACCEPT_TARGET_IO:
962 case XPT_IMMED_NOTIFY:
963 case XPT_IMMEDIATE_NOTIFY:
964 CAM_DEBUG_PRINT(CAM_DEBUG_PERIPH, ("freeing ccb %p\n", ccb));
965 free(ccb, M_TARG);
966 break;
967 default:
968 /* Send back CCB if we got it from the periph */
969 if (XPT_FC_IS_QUEUED(ccb)) {
970 CAM_DEBUG_PRINT(CAM_DEBUG_PERIPH,
971 ("returning queued ccb %p\n", ccb));
972 xpt_release_ccb(ccb);
973 } else {
974 CAM_DEBUG_PRINT(CAM_DEBUG_PERIPH,
975 ("freeing ccb %p\n", ccb));
976 free(ccb, M_TARG);
977 }
978 break;
979 }
980 }
981
982 static struct targ_cmd_descr *
983 targgetdescr(struct targ_softc *softc)
984 {
985 struct targ_cmd_descr *descr;
986
987 descr = malloc(sizeof(*descr), M_TARG,
988 M_NOWAIT);
989 if (descr) {
990 descr->mapinfo.num_bufs_used = 0;
991 }
992 return (descr);
993 }
994
995 static void
996 targinit(void)
997 {
998 struct cdev *dev;
999
1000 /* Add symbolic link to targ0 for compatibility. */
1001 dev = make_dev(&targ_cdevsw, 0, UID_ROOT, GID_WHEEL, 0600, "targ");
1002 make_dev_alias(dev, "targ0");
1003 }
1004
1005 static void
1006 targasync(void *callback_arg, u_int32_t code, struct cam_path *path, void *arg)
1007 {
1008 /* All events are handled in usermode by INOTs */
1009 panic("targasync() called, should be an INOT instead");
1010 }
1011
1012 /* Cancel all pending requests and CCBs awaiting work. */
1013 static void
1014 abort_all_pending(struct targ_softc *softc)
1015 {
1016 struct targ_cmd_descr *descr;
1017 struct ccb_abort cab;
1018 struct ccb_hdr *ccb_h;
1019
1020 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH, ("abort_all_pending\n"));
1021
1022 /* First abort the descriptors awaiting resources */
1023 while ((descr = TAILQ_FIRST(&softc->work_queue)) != NULL) {
1024 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH,
1025 ("Aborting descr from workq %p\n", descr));
1026 TAILQ_REMOVE(&softc->work_queue, descr, tqe);
1027 TAILQ_INSERT_TAIL(&softc->abort_queue, descr, tqe);
1028 }
1029
1030 /*
1031 * Then abort all pending CCBs.
1032 * targdone() will return the aborted CCB via user_ccb_queue
1033 */
1034 memset(&cab, 0, sizeof(cab));
1035 xpt_setup_ccb(&cab.ccb_h, softc->path, CAM_PRIORITY_NORMAL);
1036 cab.ccb_h.func_code = XPT_ABORT;
1037 cab.ccb_h.status = CAM_REQ_CMP_ERR;
1038 TAILQ_FOREACH(ccb_h, &softc->pending_ccb_queue, periph_links.tqe) {
1039 CAM_DEBUG(softc->path, CAM_DEBUG_PERIPH,
1040 ("Aborting pending CCB %p\n", ccb_h));
1041 cab.abort_ccb = (union ccb *)ccb_h;
1042 xpt_action((union ccb *)&cab);
1043 if (cab.ccb_h.status != CAM_REQ_CMP) {
1044 xpt_print(cab.ccb_h.path,
1045 "Unable to abort CCB, status %#x\n",
1046 cab.ccb_h.status);
1047 }
1048 }
1049
1050 /* If we aborted at least one pending CCB ok, wait for it. */
1051 if (cab.ccb_h.status == CAM_REQ_CMP) {
1052 cam_periph_sleep(softc->periph, &softc->pending_ccb_queue,
1053 PRIBIO | PCATCH, "tgabrt", 0);
1054 }
1055
1056 /* If we aborted anything from the work queue, wakeup user. */
1057 if (!TAILQ_EMPTY(&softc->user_ccb_queue)
1058 || !TAILQ_EMPTY(&softc->abort_queue)) {
1059 cam_periph_unlock(softc->periph);
1060 notify_user(softc);
1061 cam_periph_lock(softc->periph);
1062 }
1063 }
1064
1065 /* Notify the user that data is ready */
1066 static void
1067 notify_user(struct targ_softc *softc)
1068 {
1069 /*
1070 * Notify users sleeping via poll(), kqueue(), and
1071 * blocking read().
1072 */
1073 selwakeuppri(&softc->read_select, PRIBIO);
1074 KNOTE_UNLOCKED(&softc->read_select.si_note, 0);
1075 wakeup(&softc->user_ccb_queue);
1076 }
1077
1078 /* Convert CAM status to errno values */
1079 static int
1080 targcamstatus(cam_status status)
1081 {
1082 switch (status & CAM_STATUS_MASK) {
1083 case CAM_REQ_CMP: /* CCB request completed without error */
1084 return (0);
1085 case CAM_REQ_INPROG: /* CCB request is in progress */
1086 return (EINPROGRESS);
1087 case CAM_REQ_CMP_ERR: /* CCB request completed with an error */
1088 return (EIO);
1089 case CAM_PROVIDE_FAIL: /* Unable to provide requested capability */
1090 return (ENOTTY);
1091 case CAM_FUNC_NOTAVAIL: /* The requested function is not available */
1092 return (ENOTSUP);
1093 case CAM_LUN_ALRDY_ENA: /* LUN is already enabled for target mode */
1094 return (EADDRINUSE);
1095 case CAM_PATH_INVALID: /* Supplied Path ID is invalid */
1096 case CAM_DEV_NOT_THERE: /* SCSI Device Not Installed/there */
1097 return (ENOENT);
1098 case CAM_REQ_ABORTED: /* CCB request aborted by the host */
1099 return (ECANCELED);
1100 case CAM_CMD_TIMEOUT: /* Command timeout */
1101 return (ETIMEDOUT);
1102 case CAM_REQUEUE_REQ: /* Requeue to preserve transaction ordering */
1103 return (EAGAIN);
1104 case CAM_REQ_INVALID: /* CCB request was invalid */
1105 return (EINVAL);
1106 case CAM_RESRC_UNAVAIL: /* Resource Unavailable */
1107 return (ENOMEM);
1108 case CAM_BUSY: /* CAM subsystem is busy */
1109 case CAM_UA_ABORT: /* Unable to abort CCB request */
1110 return (EBUSY);
1111 default:
1112 return (ENXIO);
1113 }
1114 }
1115
1116 static size_t
1117 targccblen(xpt_opcode func_code)
1118 {
1119 int len;
1120
1121 /* Codes we expect to see as a target */
1122 switch (func_code) {
1123 case XPT_CONT_TARGET_IO:
1124 case XPT_SCSI_IO:
1125 len = sizeof(struct ccb_scsiio);
1126 break;
1127 case XPT_ACCEPT_TARGET_IO:
1128 len = sizeof(struct ccb_accept_tio);
1129 break;
1130 case XPT_IMMED_NOTIFY:
1131 len = sizeof(struct ccb_immed_notify);
1132 break;
1133 case XPT_IMMEDIATE_NOTIFY:
1134 len = sizeof(struct ccb_immediate_notify);
1135 break;
1136 case XPT_REL_SIMQ:
1137 len = sizeof(struct ccb_relsim);
1138 break;
1139 case XPT_PATH_INQ:
1140 len = sizeof(struct ccb_pathinq);
1141 break;
1142 case XPT_DEBUG:
1143 len = sizeof(struct ccb_debug);
1144 break;
1145 case XPT_ABORT:
1146 len = sizeof(struct ccb_abort);
1147 break;
1148 case XPT_EN_LUN:
1149 len = sizeof(struct ccb_en_lun);
1150 break;
1151 default:
1152 len = sizeof(union ccb);
1153 break;
1154 }
1155
1156 return (len);
1157 }
Cache object: 48a4cebdceb7a5b7a25024302c15dd9e
|