]> CyberLeo.Net >> Repos - FreeBSD/FreeBSD.git/blob - sys/cam/cam_xpt.c
Make "kldunload atapicam" return EBUSY instead of deadlocking when a device
[FreeBSD/FreeBSD.git] / sys / cam / cam_xpt.c
1 /*-
2  * Implementation of the Common Access Method Transport (XPT) layer.
3  *
4  * Copyright (c) 1997, 1998, 1999 Justin T. Gibbs.
5  * Copyright (c) 1997, 1998, 1999 Kenneth D. Merry.
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions, and the following disclaimer,
13  *    without modification, immediately at the beginning of the file.
14  * 2. The name of the author may not be used to endorse or promote products
15  *    derived from this software without specific prior written permission.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
21  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27  * SUCH DAMAGE.
28  */
29
30 #include <sys/cdefs.h>
31 __FBSDID("$FreeBSD$");
32
33 #include <sys/param.h>
34 #include <sys/bus.h>
35 #include <sys/systm.h>
36 #include <sys/types.h>
37 #include <sys/malloc.h>
38 #include <sys/kernel.h>
39 #include <sys/time.h>
40 #include <sys/conf.h>
41 #include <sys/fcntl.h>
42 #include <sys/md5.h>
43 #include <sys/interrupt.h>
44 #include <sys/sbuf.h>
45 #include <sys/taskqueue.h>
46
47 #include <sys/lock.h>
48 #include <sys/mutex.h>
49 #include <sys/sysctl.h>
50 #include <sys/kthread.h>
51
52 #ifdef PC98
53 #include <pc98/pc98/pc98_machdep.h>     /* geometry translation */
54 #endif
55
56 #include <cam/cam.h>
57 #include <cam/cam_ccb.h>
58 #include <cam/cam_periph.h>
59 #include <cam/cam_sim.h>
60 #include <cam/cam_xpt.h>
61 #include <cam/cam_xpt_sim.h>
62 #include <cam/cam_xpt_periph.h>
63 #include <cam/cam_debug.h>
64
65 #include <cam/scsi/scsi_all.h>
66 #include <cam/scsi/scsi_message.h>
67 #include <cam/scsi/scsi_pass.h>
68 #include <machine/stdarg.h>     /* for xpt_print below */
69 #include "opt_cam.h"
70
71 /* Datastructures internal to the xpt layer */
72 MALLOC_DEFINE(M_CAMXPT, "CAM XPT", "CAM XPT buffers");
73
74 /* Object for defering XPT actions to a taskqueue */
75 struct xpt_task {
76         struct task     task;
77         void            *data1;
78         uintptr_t       data2;
79 };
80
81 /*
82  * Definition of an async handler callback block.  These are used to add
83  * SIMs and peripherals to the async callback lists.
84  */
85 struct async_node {
86         SLIST_ENTRY(async_node) links;
87         u_int32_t       event_enable;   /* Async Event enables */
88         void            (*callback)(void *arg, u_int32_t code,
89                                     struct cam_path *path, void *args);
90         void            *callback_arg;
91 };
92
93 SLIST_HEAD(async_list, async_node);
94 SLIST_HEAD(periph_list, cam_periph);
95
96 /*
97  * This is the maximum number of high powered commands (e.g. start unit)
98  * that can be outstanding at a particular time.
99  */
100 #ifndef CAM_MAX_HIGHPOWER
101 #define CAM_MAX_HIGHPOWER  4
102 #endif
103
104 /*
105  * Structure for queueing a device in a run queue.
106  * There is one run queue for allocating new ccbs,
107  * and another for sending ccbs to the controller.
108  */
109 struct cam_ed_qinfo {
110         cam_pinfo pinfo;
111         struct    cam_ed *device;
112 };
113
114 /*
115  * The CAM EDT (Existing Device Table) contains the device information for
116  * all devices for all busses in the system.  The table contains a
117  * cam_ed structure for each device on the bus.
118  */
119 struct cam_ed {
120         TAILQ_ENTRY(cam_ed) links;
121         struct  cam_ed_qinfo alloc_ccb_entry;
122         struct  cam_ed_qinfo send_ccb_entry;
123         struct  cam_et   *target;
124         struct  cam_sim  *sim;
125         lun_id_t         lun_id;
126         struct  camq drvq;              /*
127                                          * Queue of type drivers wanting to do
128                                          * work on this device.
129                                          */
130         struct  cam_ccbq ccbq;          /* Queue of pending ccbs */
131         struct  async_list asyncs;      /* Async callback info for this B/T/L */
132         struct  periph_list periphs;    /* All attached devices */
133         u_int   generation;             /* Generation number */
134         struct  cam_periph *owner;      /* Peripheral driver's ownership tag */
135         struct  xpt_quirk_entry *quirk; /* Oddities about this device */
136                                         /* Storage for the inquiry data */
137         cam_proto        protocol;
138         u_int            protocol_version;
139         cam_xport        transport;
140         u_int            transport_version;
141         struct           scsi_inquiry_data inq_data;
142         u_int8_t         inq_flags;     /*
143                                          * Current settings for inquiry flags.
144                                          * This allows us to override settings
145                                          * like disconnection and tagged
146                                          * queuing for a device.
147                                          */
148         u_int8_t         queue_flags;   /* Queue flags from the control page */
149         u_int8_t         serial_num_len;
150         u_int8_t        *serial_num;
151         u_int32_t        qfrozen_cnt;
152         u_int32_t        flags;
153 #define CAM_DEV_UNCONFIGURED            0x01
154 #define CAM_DEV_REL_TIMEOUT_PENDING     0x02
155 #define CAM_DEV_REL_ON_COMPLETE         0x04
156 #define CAM_DEV_REL_ON_QUEUE_EMPTY      0x08
157 #define CAM_DEV_RESIZE_QUEUE_NEEDED     0x10
158 #define CAM_DEV_TAG_AFTER_COUNT         0x20
159 #define CAM_DEV_INQUIRY_DATA_VALID      0x40
160 #define CAM_DEV_IN_DV                   0x80
161 #define CAM_DEV_DV_HIT_BOTTOM           0x100
162         u_int32_t        tag_delay_count;
163 #define CAM_TAG_DELAY_COUNT             5
164         u_int32_t        tag_saved_openings;
165         u_int32_t        refcount;
166         struct callout   callout;
167 };
168
169 /*
170  * Each target is represented by an ET (Existing Target).  These
171  * entries are created when a target is successfully probed with an
172  * identify, and removed when a device fails to respond after a number
173  * of retries, or a bus rescan finds the device missing.
174  */
175 struct cam_et {
176         TAILQ_HEAD(, cam_ed) ed_entries;
177         TAILQ_ENTRY(cam_et) links;
178         struct  cam_eb  *bus;
179         target_id_t     target_id;
180         u_int32_t       refcount;
181         u_int           generation;
182         struct          timeval last_reset;
183 };
184
185 /*
186  * Each bus is represented by an EB (Existing Bus).  These entries
187  * are created by calls to xpt_bus_register and deleted by calls to
188  * xpt_bus_deregister.
189  */
190 struct cam_eb {
191         TAILQ_HEAD(, cam_et) et_entries;
192         TAILQ_ENTRY(cam_eb)  links;
193         path_id_t            path_id;
194         struct cam_sim       *sim;
195         struct timeval       last_reset;
196         u_int32_t            flags;
197 #define CAM_EB_RUNQ_SCHEDULED   0x01
198         u_int32_t            refcount;
199         u_int                generation;
200         device_t             parent_dev;
201 };
202
203 struct cam_path {
204         struct cam_periph *periph;
205         struct cam_eb     *bus;
206         struct cam_et     *target;
207         struct cam_ed     *device;
208 };
209
210 struct xpt_quirk_entry {
211         struct scsi_inquiry_pattern inq_pat;
212         u_int8_t quirks;
213 #define CAM_QUIRK_NOLUNS        0x01
214 #define CAM_QUIRK_NOSERIAL      0x02
215 #define CAM_QUIRK_HILUNS        0x04
216 #define CAM_QUIRK_NOHILUNS      0x08
217         u_int mintags;
218         u_int maxtags;
219 };
220
221 static int cam_srch_hi = 0;
222 TUNABLE_INT("kern.cam.cam_srch_hi", &cam_srch_hi);
223 static int sysctl_cam_search_luns(SYSCTL_HANDLER_ARGS);
224 SYSCTL_PROC(_kern_cam, OID_AUTO, cam_srch_hi, CTLTYPE_INT|CTLFLAG_RW, 0, 0,
225     sysctl_cam_search_luns, "I",
226     "allow search above LUN 7 for SCSI3 and greater devices");
227
228 #define CAM_SCSI2_MAXLUN        8
229 /*
230  * If we're not quirked to search <= the first 8 luns
231  * and we are either quirked to search above lun 8,
232  * or we're > SCSI-2 and we've enabled hilun searching,
233  * or we're > SCSI-2 and the last lun was a success,
234  * we can look for luns above lun 8.
235  */
236 #define CAN_SRCH_HI_SPARSE(dv)                          \
237   (((dv->quirk->quirks & CAM_QUIRK_NOHILUNS) == 0)      \
238   && ((dv->quirk->quirks & CAM_QUIRK_HILUNS)            \
239   || (SID_ANSI_REV(&dv->inq_data) > SCSI_REV_2 && cam_srch_hi)))
240
241 #define CAN_SRCH_HI_DENSE(dv)                           \
242   (((dv->quirk->quirks & CAM_QUIRK_NOHILUNS) == 0)      \
243   && ((dv->quirk->quirks & CAM_QUIRK_HILUNS)            \
244   || (SID_ANSI_REV(&dv->inq_data) > SCSI_REV_2)))
245
246 typedef enum {
247         XPT_FLAG_OPEN           = 0x01
248 } xpt_flags;
249
250 struct xpt_softc {
251         xpt_flags               flags;
252         u_int32_t               xpt_generation;
253
254         /* number of high powered commands that can go through right now */
255         STAILQ_HEAD(highpowerlist, ccb_hdr)     highpowerq;
256         int                     num_highpower;
257
258         /* queue for handling async rescan requests. */
259         TAILQ_HEAD(, ccb_hdr) ccb_scanq;
260
261         /* Registered busses */
262         TAILQ_HEAD(,cam_eb)     xpt_busses;
263         u_int                   bus_generation;
264
265         struct intr_config_hook *xpt_config_hook;
266
267         struct mtx              xpt_topo_lock;
268         struct mtx              xpt_lock;
269 };
270
271 static const char quantum[] = "QUANTUM";
272 static const char sony[] = "SONY";
273 static const char west_digital[] = "WDIGTL";
274 static const char samsung[] = "SAMSUNG";
275 static const char seagate[] = "SEAGATE";
276 static const char microp[] = "MICROP";
277
278 static struct xpt_quirk_entry xpt_quirk_table[] =
279 {
280         {
281                 /* Reports QUEUE FULL for temporary resource shortages */
282                 { T_DIRECT, SIP_MEDIA_FIXED, quantum, "XP39100*", "*" },
283                 /*quirks*/0, /*mintags*/24, /*maxtags*/32
284         },
285         {
286                 /* Reports QUEUE FULL for temporary resource shortages */
287                 { T_DIRECT, SIP_MEDIA_FIXED, quantum, "XP34550*", "*" },
288                 /*quirks*/0, /*mintags*/24, /*maxtags*/32
289         },
290         {
291                 /* Reports QUEUE FULL for temporary resource shortages */
292                 { T_DIRECT, SIP_MEDIA_FIXED, quantum, "XP32275*", "*" },
293                 /*quirks*/0, /*mintags*/24, /*maxtags*/32
294         },
295         {
296                 /* Broken tagged queuing drive */
297                 { T_DIRECT, SIP_MEDIA_FIXED, microp, "4421-07*", "*" },
298                 /*quirks*/0, /*mintags*/0, /*maxtags*/0
299         },
300         {
301                 /* Broken tagged queuing drive */
302                 { T_DIRECT, SIP_MEDIA_FIXED, "HP", "C372*", "*" },
303                 /*quirks*/0, /*mintags*/0, /*maxtags*/0
304         },
305         {
306                 /* Broken tagged queuing drive */
307                 { T_DIRECT, SIP_MEDIA_FIXED, microp, "3391*", "x43h" },
308                 /*quirks*/0, /*mintags*/0, /*maxtags*/0
309         },
310         {
311                 /*
312                  * Unfortunately, the Quantum Atlas III has the same
313                  * problem as the Atlas II drives above.
314                  * Reported by: "Johan Granlund" <johan@granlund.nu>
315                  *
316                  * For future reference, the drive with the problem was:
317                  * QUANTUM QM39100TD-SW N1B0
318                  *
319                  * It's possible that Quantum will fix the problem in later
320                  * firmware revisions.  If that happens, the quirk entry
321                  * will need to be made specific to the firmware revisions
322                  * with the problem.
323                  *
324                  */
325                 /* Reports QUEUE FULL for temporary resource shortages */
326                 { T_DIRECT, SIP_MEDIA_FIXED, quantum, "QM39100*", "*" },
327                 /*quirks*/0, /*mintags*/24, /*maxtags*/32
328         },
329         {
330                 /*
331                  * 18 Gig Atlas III, same problem as the 9G version.
332                  * Reported by: Andre Albsmeier
333                  *              <andre.albsmeier@mchp.siemens.de>
334                  *
335                  * For future reference, the drive with the problem was:
336                  * QUANTUM QM318000TD-S N491
337                  */
338                 /* Reports QUEUE FULL for temporary resource shortages */
339                 { T_DIRECT, SIP_MEDIA_FIXED, quantum, "QM318000*", "*" },
340                 /*quirks*/0, /*mintags*/24, /*maxtags*/32
341         },
342         {
343                 /*
344                  * Broken tagged queuing drive
345                  * Reported by: Bret Ford <bford@uop.cs.uop.edu>
346                  *         and: Martin Renters <martin@tdc.on.ca>
347                  */
348                 { T_DIRECT, SIP_MEDIA_FIXED, seagate, "ST410800*", "71*" },
349                 /*quirks*/0, /*mintags*/0, /*maxtags*/0
350         },
351                 /*
352                  * The Seagate Medalist Pro drives have very poor write
353                  * performance with anything more than 2 tags.
354                  *
355                  * Reported by:  Paul van der Zwan <paulz@trantor.xs4all.nl>
356                  * Drive:  <SEAGATE ST36530N 1444>
357                  *
358                  * Reported by:  Jeremy Lea <reg@shale.csir.co.za>
359                  * Drive:  <SEAGATE ST34520W 1281>
360                  *
361                  * No one has actually reported that the 9G version
362                  * (ST39140*) of the Medalist Pro has the same problem, but
363                  * we're assuming that it does because the 4G and 6.5G
364                  * versions of the drive are broken.
365                  */
366         {
367                 { T_DIRECT, SIP_MEDIA_FIXED, seagate, "ST34520*", "*"},
368                 /*quirks*/0, /*mintags*/2, /*maxtags*/2
369         },
370         {
371                 { T_DIRECT, SIP_MEDIA_FIXED, seagate, "ST36530*", "*"},
372                 /*quirks*/0, /*mintags*/2, /*maxtags*/2
373         },
374         {
375                 { T_DIRECT, SIP_MEDIA_FIXED, seagate, "ST39140*", "*"},
376                 /*quirks*/0, /*mintags*/2, /*maxtags*/2
377         },
378         {
379                 /*
380                  * Slow when tagged queueing is enabled.  Write performance
381                  * steadily drops off with more and more concurrent
382                  * transactions.  Best sequential write performance with
383                  * tagged queueing turned off and write caching turned on.
384                  *
385                  * PR:  kern/10398
386                  * Submitted by:  Hideaki Okada <hokada@isl.melco.co.jp>
387                  * Drive:  DCAS-34330 w/ "S65A" firmware.
388                  *
389                  * The drive with the problem had the "S65A" firmware
390                  * revision, and has also been reported (by Stephen J.
391                  * Roznowski <sjr@home.net>) for a drive with the "S61A"
392                  * firmware revision.
393                  *
394                  * Although no one has reported problems with the 2 gig
395                  * version of the DCAS drive, the assumption is that it
396                  * has the same problems as the 4 gig version.  Therefore
397                  * this quirk entries disables tagged queueing for all
398                  * DCAS drives.
399                  */
400                 { T_DIRECT, SIP_MEDIA_FIXED, "IBM", "DCAS*", "*" },
401                 /*quirks*/0, /*mintags*/0, /*maxtags*/0
402         },
403         {
404                 /* Broken tagged queuing drive */
405                 { T_DIRECT, SIP_MEDIA_REMOVABLE, "iomega", "jaz*", "*" },
406                 /*quirks*/0, /*mintags*/0, /*maxtags*/0
407         },
408         {
409                 /* Broken tagged queuing drive */
410                 { T_DIRECT, SIP_MEDIA_FIXED, "CONNER", "CFP2107*", "*" },
411                 /*quirks*/0, /*mintags*/0, /*maxtags*/0
412         },
413         {
414                 /* This does not support other than LUN 0 */
415                 { T_DIRECT, SIP_MEDIA_FIXED, "VMware*", "*", "*" },
416                 CAM_QUIRK_NOLUNS, /*mintags*/2, /*maxtags*/255
417         },
418         {
419                 /*
420                  * Broken tagged queuing drive.
421                  * Submitted by:
422                  * NAKAJI Hiroyuki <nakaji@zeisei.dpri.kyoto-u.ac.jp>
423                  * in PR kern/9535
424                  */
425                 { T_DIRECT, SIP_MEDIA_FIXED, samsung, "WN34324U*", "*" },
426                 /*quirks*/0, /*mintags*/0, /*maxtags*/0
427         },
428         {
429                 /*
430                  * Slow when tagged queueing is enabled. (1.5MB/sec versus
431                  * 8MB/sec.)
432                  * Submitted by: Andrew Gallatin <gallatin@cs.duke.edu>
433                  * Best performance with these drives is achieved with
434                  * tagged queueing turned off, and write caching turned on.
435                  */
436                 { T_DIRECT, SIP_MEDIA_FIXED, west_digital, "WDE*", "*" },
437                 /*quirks*/0, /*mintags*/0, /*maxtags*/0
438         },
439         {
440                 /*
441                  * Slow when tagged queueing is enabled. (1.5MB/sec versus
442                  * 8MB/sec.)
443                  * Submitted by: Andrew Gallatin <gallatin@cs.duke.edu>
444                  * Best performance with these drives is achieved with
445                  * tagged queueing turned off, and write caching turned on.
446                  */
447                 { T_DIRECT, SIP_MEDIA_FIXED, west_digital, "ENTERPRISE", "*" },
448                 /*quirks*/0, /*mintags*/0, /*maxtags*/0
449         },
450         {
451                 /*
452                  * Doesn't handle queue full condition correctly,
453                  * so we need to limit maxtags to what the device
454                  * can handle instead of determining this automatically.
455                  */
456                 { T_DIRECT, SIP_MEDIA_FIXED, samsung, "WN321010S*", "*" },
457                 /*quirks*/0, /*mintags*/2, /*maxtags*/32
458         },
459         {
460                 /* Really only one LUN */
461                 { T_ENCLOSURE, SIP_MEDIA_FIXED, "SUN", "SENA", "*" },
462                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
463         },
464         {
465                 /* I can't believe we need a quirk for DPT volumes. */
466                 { T_ANY, SIP_MEDIA_FIXED|SIP_MEDIA_REMOVABLE, "DPT", "*", "*" },
467                 CAM_QUIRK_NOLUNS,
468                 /*mintags*/0, /*maxtags*/255
469         },
470         {
471                 /*
472                  * Many Sony CDROM drives don't like multi-LUN probing.
473                  */
474                 { T_CDROM, SIP_MEDIA_REMOVABLE, sony, "CD-ROM CDU*", "*" },
475                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
476         },
477         {
478                 /*
479                  * This drive doesn't like multiple LUN probing.
480                  * Submitted by:  Parag Patel <parag@cgt.com>
481                  */
482                 { T_WORM, SIP_MEDIA_REMOVABLE, sony, "CD-R   CDU9*", "*" },
483                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
484         },
485         {
486                 { T_WORM, SIP_MEDIA_REMOVABLE, "YAMAHA", "CDR100*", "*" },
487                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
488         },
489         {
490                 /*
491                  * The 8200 doesn't like multi-lun probing, and probably
492                  * don't like serial number requests either.
493                  */
494                 {
495                         T_SEQUENTIAL, SIP_MEDIA_REMOVABLE, "EXABYTE",
496                         "EXB-8200*", "*"
497                 },
498                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
499         },
500         {
501                 /*
502                  * Let's try the same as above, but for a drive that says
503                  * it's an IPL-6860 but is actually an EXB 8200.
504                  */
505                 {
506                         T_SEQUENTIAL, SIP_MEDIA_REMOVABLE, "EXABYTE",
507                         "IPL-6860*", "*"
508                 },
509                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
510         },
511         {
512                 /*
513                  * These Hitachi drives don't like multi-lun probing.
514                  * The PR submitter has a DK319H, but says that the Linux
515                  * kernel has a similar work-around for the DK312 and DK314,
516                  * so all DK31* drives are quirked here.
517                  * PR:            misc/18793
518                  * Submitted by:  Paul Haddad <paul@pth.com>
519                  */
520                 { T_DIRECT, SIP_MEDIA_FIXED, "HITACHI", "DK31*", "*" },
521                 CAM_QUIRK_NOLUNS, /*mintags*/2, /*maxtags*/255
522         },
523         {
524                 /*
525                  * The Hitachi CJ series with J8A8 firmware apparantly has
526                  * problems with tagged commands.
527                  * PR: 23536
528                  * Reported by: amagai@nue.org
529                  */
530                 { T_DIRECT, SIP_MEDIA_FIXED, "HITACHI", "DK32CJ*", "J8A8" },
531                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
532         },
533         {
534                 /*
535                  * These are the large storage arrays.
536                  * Submitted by:  William Carrel <william.carrel@infospace.com>
537                  */
538                 { T_DIRECT, SIP_MEDIA_FIXED, "HITACHI", "OPEN*", "*" },
539                 CAM_QUIRK_HILUNS, 2, 1024
540         },
541         {
542                 /*
543                  * This old revision of the TDC3600 is also SCSI-1, and
544                  * hangs upon serial number probing.
545                  */
546                 {
547                         T_SEQUENTIAL, SIP_MEDIA_REMOVABLE, "TANDBERG",
548                         " TDC 3600", "U07:"
549                 },
550                 CAM_QUIRK_NOSERIAL, /*mintags*/0, /*maxtags*/0
551         },
552         {
553                 /*
554                  * Would repond to all LUNs if asked for.
555                  */
556                 {
557                         T_SEQUENTIAL, SIP_MEDIA_REMOVABLE, "CALIPER",
558                         "CP150", "*"
559                 },
560                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
561         },
562         {
563                 /*
564                  * Would repond to all LUNs if asked for.
565                  */
566                 {
567                         T_SEQUENTIAL, SIP_MEDIA_REMOVABLE, "KENNEDY",
568                         "96X2*", "*"
569                 },
570                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
571         },
572         {
573                 /* Submitted by: Matthew Dodd <winter@jurai.net> */
574                 { T_PROCESSOR, SIP_MEDIA_FIXED, "Cabletrn", "EA41*", "*" },
575                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
576         },
577         {
578                 /* Submitted by: Matthew Dodd <winter@jurai.net> */
579                 { T_PROCESSOR, SIP_MEDIA_FIXED, "CABLETRN", "EA41*", "*" },
580                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
581         },
582         {
583                 /* TeraSolutions special settings for TRC-22 RAID */
584                 { T_DIRECT, SIP_MEDIA_FIXED, "TERASOLU", "TRC-22", "*" },
585                   /*quirks*/0, /*mintags*/55, /*maxtags*/255
586         },
587         {
588                 /* Veritas Storage Appliance */
589                 { T_DIRECT, SIP_MEDIA_FIXED, "VERITAS", "*", "*" },
590                   CAM_QUIRK_HILUNS, /*mintags*/2, /*maxtags*/1024
591         },
592         {
593                 /*
594                  * Would respond to all LUNs.  Device type and removable
595                  * flag are jumper-selectable.
596                  */
597                 { T_ANY, SIP_MEDIA_REMOVABLE|SIP_MEDIA_FIXED, "MaxOptix",
598                   "Tahiti 1", "*"
599                 },
600                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
601         },
602         {
603                 /* EasyRAID E5A aka. areca ARC-6010 */
604                 { T_DIRECT, SIP_MEDIA_FIXED, "easyRAID", "*", "*" },
605                   CAM_QUIRK_NOHILUNS, /*mintags*/2, /*maxtags*/255
606         },
607         {
608                 { T_ENCLOSURE, SIP_MEDIA_FIXED, "DP", "BACKPLANE", "*" },
609                 CAM_QUIRK_NOLUNS, /*mintags*/0, /*maxtags*/0
610         },
611         {
612                 /* Default tagged queuing parameters for all devices */
613                 {
614                   T_ANY, SIP_MEDIA_REMOVABLE|SIP_MEDIA_FIXED,
615                   /*vendor*/"*", /*product*/"*", /*revision*/"*"
616                 },
617                 /*quirks*/0, /*mintags*/2, /*maxtags*/255
618         },
619 };
620
621 static const int xpt_quirk_table_size =
622         sizeof(xpt_quirk_table) / sizeof(*xpt_quirk_table);
623
624 typedef enum {
625         DM_RET_COPY             = 0x01,
626         DM_RET_FLAG_MASK        = 0x0f,
627         DM_RET_NONE             = 0x00,
628         DM_RET_STOP             = 0x10,
629         DM_RET_DESCEND          = 0x20,
630         DM_RET_ERROR            = 0x30,
631         DM_RET_ACTION_MASK      = 0xf0
632 } dev_match_ret;
633
634 typedef enum {
635         XPT_DEPTH_BUS,
636         XPT_DEPTH_TARGET,
637         XPT_DEPTH_DEVICE,
638         XPT_DEPTH_PERIPH
639 } xpt_traverse_depth;
640
641 struct xpt_traverse_config {
642         xpt_traverse_depth      depth;
643         void                    *tr_func;
644         void                    *tr_arg;
645 };
646
647 typedef int     xpt_busfunc_t (struct cam_eb *bus, void *arg);
648 typedef int     xpt_targetfunc_t (struct cam_et *target, void *arg);
649 typedef int     xpt_devicefunc_t (struct cam_ed *device, void *arg);
650 typedef int     xpt_periphfunc_t (struct cam_periph *periph, void *arg);
651 typedef int     xpt_pdrvfunc_t (struct periph_driver **pdrv, void *arg);
652
653 /* Transport layer configuration information */
654 static struct xpt_softc xsoftc;
655
656 /* Queues for our software interrupt handler */
657 typedef TAILQ_HEAD(cam_isrq, ccb_hdr) cam_isrq_t;
658 typedef TAILQ_HEAD(cam_simq, cam_sim) cam_simq_t;
659 static cam_simq_t cam_simq;
660 static struct mtx cam_simq_lock;
661
662 /* Pointers to software interrupt handlers */
663 static void *cambio_ih;
664
665 struct cam_periph *xpt_periph;
666
667 static periph_init_t xpt_periph_init;
668
669 static periph_init_t probe_periph_init;
670
671 static struct periph_driver xpt_driver =
672 {
673         xpt_periph_init, "xpt",
674         TAILQ_HEAD_INITIALIZER(xpt_driver.units)
675 };
676
677 static struct periph_driver probe_driver =
678 {
679         probe_periph_init, "probe",
680         TAILQ_HEAD_INITIALIZER(probe_driver.units)
681 };
682
683 PERIPHDRIVER_DECLARE(xpt, xpt_driver);
684 PERIPHDRIVER_DECLARE(probe, probe_driver);
685
686
687 static d_open_t xptopen;
688 static d_close_t xptclose;
689 static d_ioctl_t xptioctl;
690
691 static struct cdevsw xpt_cdevsw = {
692         .d_version =    D_VERSION,
693         .d_flags =      0,
694         .d_open =       xptopen,
695         .d_close =      xptclose,
696         .d_ioctl =      xptioctl,
697         .d_name =       "xpt",
698 };
699
700
701 /* Storage for debugging datastructures */
702 #ifdef  CAMDEBUG
703 struct cam_path *cam_dpath;
704 u_int32_t cam_dflags;
705 u_int32_t cam_debug_delay;
706 #endif
707
708 #if defined(CAM_DEBUG_FLAGS) && !defined(CAMDEBUG)
709 #error "You must have options CAMDEBUG to use options CAM_DEBUG_FLAGS"
710 #endif
711
712 /*
713  * In order to enable the CAM_DEBUG_* options, the user must have CAMDEBUG
714  * enabled.  Also, the user must have either none, or all of CAM_DEBUG_BUS,
715  * CAM_DEBUG_TARGET, and CAM_DEBUG_LUN specified.
716  */
717 #if defined(CAM_DEBUG_BUS) || defined(CAM_DEBUG_TARGET) \
718     || defined(CAM_DEBUG_LUN)
719 #ifdef CAMDEBUG
720 #if !defined(CAM_DEBUG_BUS) || !defined(CAM_DEBUG_TARGET) \
721     || !defined(CAM_DEBUG_LUN)
722 #error "You must define all or none of CAM_DEBUG_BUS, CAM_DEBUG_TARGET \
723         and CAM_DEBUG_LUN"
724 #endif /* !CAM_DEBUG_BUS || !CAM_DEBUG_TARGET || !CAM_DEBUG_LUN */
725 #else /* !CAMDEBUG */
726 #error "You must use options CAMDEBUG if you use the CAM_DEBUG_* options"
727 #endif /* CAMDEBUG */
728 #endif /* CAM_DEBUG_BUS || CAM_DEBUG_TARGET || CAM_DEBUG_LUN */
729
730 /* Our boot-time initialization hook */
731 static int cam_module_event_handler(module_t, int /*modeventtype_t*/, void *);
732
733 static moduledata_t cam_moduledata = {
734         "cam",
735         cam_module_event_handler,
736         NULL
737 };
738
739 static int      xpt_init(void *);
740
741 DECLARE_MODULE(cam, cam_moduledata, SI_SUB_CONFIGURE, SI_ORDER_SECOND);
742 MODULE_VERSION(cam, 1);
743
744
745 static cam_status       xpt_compile_path(struct cam_path *new_path,
746                                          struct cam_periph *perph,
747                                          path_id_t path_id,
748                                          target_id_t target_id,
749                                          lun_id_t lun_id);
750
751 static void             xpt_release_path(struct cam_path *path);
752
753 static void             xpt_async_bcast(struct async_list *async_head,
754                                         u_int32_t async_code,
755                                         struct cam_path *path,
756                                         void *async_arg);
757 static void             xpt_dev_async(u_int32_t async_code,
758                                       struct cam_eb *bus,
759                                       struct cam_et *target,
760                                       struct cam_ed *device,
761                                       void *async_arg);
762 static path_id_t xptnextfreepathid(void);
763 static path_id_t xptpathid(const char *sim_name, int sim_unit, int sim_bus);
764 static union ccb *xpt_get_ccb(struct cam_ed *device);
765 static int       xpt_schedule_dev(struct camq *queue, cam_pinfo *dev_pinfo,
766                                   u_int32_t new_priority);
767 static void      xpt_run_dev_allocq(struct cam_eb *bus);
768 static void      xpt_run_dev_sendq(struct cam_eb *bus);
769 static timeout_t xpt_release_devq_timeout;
770 static void      xpt_release_simq_timeout(void *arg) __unused;
771 static void      xpt_release_bus(struct cam_eb *bus);
772 static void      xpt_release_devq_device(struct cam_ed *dev, u_int count,
773                                          int run_queue);
774 static struct cam_et*
775                  xpt_alloc_target(struct cam_eb *bus, target_id_t target_id);
776 static void      xpt_release_target(struct cam_eb *bus, struct cam_et *target);
777 static struct cam_ed*
778                  xpt_alloc_device(struct cam_eb *bus, struct cam_et *target,
779                                   lun_id_t lun_id);
780 static void      xpt_release_device(struct cam_eb *bus, struct cam_et *target,
781                                     struct cam_ed *device);
782 static u_int32_t xpt_dev_ccbq_resize(struct cam_path *path, int newopenings);
783 static struct cam_eb*
784                  xpt_find_bus(path_id_t path_id);
785 static struct cam_et*
786                  xpt_find_target(struct cam_eb *bus, target_id_t target_id);
787 static struct cam_ed*
788                  xpt_find_device(struct cam_et *target, lun_id_t lun_id);
789 static void      xpt_scan_bus(struct cam_periph *periph, union ccb *ccb);
790 static void      xpt_scan_lun(struct cam_periph *periph,
791                               struct cam_path *path, cam_flags flags,
792                               union ccb *ccb);
793 static void      xptscandone(struct cam_periph *periph, union ccb *done_ccb);
794 static xpt_busfunc_t    xptconfigbuscountfunc;
795 static xpt_busfunc_t    xptconfigfunc;
796 static void      xpt_config(void *arg);
797 static xpt_devicefunc_t xptpassannouncefunc;
798 static void      xpt_finishconfig(struct cam_periph *periph, union ccb *ccb);
799 static void      xptaction(struct cam_sim *sim, union ccb *work_ccb);
800 static void      xptpoll(struct cam_sim *sim);
801 static void      camisr(void *);
802 static void      camisr_runqueue(void *);
803 static dev_match_ret    xptbusmatch(struct dev_match_pattern *patterns,
804                                     u_int num_patterns, struct cam_eb *bus);
805 static dev_match_ret    xptdevicematch(struct dev_match_pattern *patterns,
806                                        u_int num_patterns,
807                                        struct cam_ed *device);
808 static dev_match_ret    xptperiphmatch(struct dev_match_pattern *patterns,
809                                        u_int num_patterns,
810                                        struct cam_periph *periph);
811 static xpt_busfunc_t    xptedtbusfunc;
812 static xpt_targetfunc_t xptedttargetfunc;
813 static xpt_devicefunc_t xptedtdevicefunc;
814 static xpt_periphfunc_t xptedtperiphfunc;
815 static xpt_pdrvfunc_t   xptplistpdrvfunc;
816 static xpt_periphfunc_t xptplistperiphfunc;
817 static int              xptedtmatch(struct ccb_dev_match *cdm);
818 static int              xptperiphlistmatch(struct ccb_dev_match *cdm);
819 static int              xptbustraverse(struct cam_eb *start_bus,
820                                        xpt_busfunc_t *tr_func, void *arg);
821 static int              xpttargettraverse(struct cam_eb *bus,
822                                           struct cam_et *start_target,
823                                           xpt_targetfunc_t *tr_func, void *arg);
824 static int              xptdevicetraverse(struct cam_et *target,
825                                           struct cam_ed *start_device,
826                                           xpt_devicefunc_t *tr_func, void *arg);
827 static int              xptperiphtraverse(struct cam_ed *device,
828                                           struct cam_periph *start_periph,
829                                           xpt_periphfunc_t *tr_func, void *arg);
830 static int              xptpdrvtraverse(struct periph_driver **start_pdrv,
831                                         xpt_pdrvfunc_t *tr_func, void *arg);
832 static int              xptpdperiphtraverse(struct periph_driver **pdrv,
833                                             struct cam_periph *start_periph,
834                                             xpt_periphfunc_t *tr_func,
835                                             void *arg);
836 static xpt_busfunc_t    xptdefbusfunc;
837 static xpt_targetfunc_t xptdeftargetfunc;
838 static xpt_devicefunc_t xptdefdevicefunc;
839 static xpt_periphfunc_t xptdefperiphfunc;
840 static int              xpt_for_all_busses(xpt_busfunc_t *tr_func, void *arg);
841 static int              xpt_for_all_devices(xpt_devicefunc_t *tr_func,
842                                             void *arg);
843 static xpt_devicefunc_t xptsetasyncfunc;
844 static xpt_busfunc_t    xptsetasyncbusfunc;
845 static cam_status       xptregister(struct cam_periph *periph,
846                                     void *arg);
847 static cam_status       proberegister(struct cam_periph *periph,
848                                       void *arg);
849 static void      probeschedule(struct cam_periph *probe_periph);
850 static void      probestart(struct cam_periph *periph, union ccb *start_ccb);
851 static void      proberequestdefaultnegotiation(struct cam_periph *periph);
852 static int       proberequestbackoff(struct cam_periph *periph,
853                                      struct cam_ed *device);
854 static void      probedone(struct cam_periph *periph, union ccb *done_ccb);
855 static void      probecleanup(struct cam_periph *periph);
856 static void      xpt_find_quirk(struct cam_ed *device);
857 static void      xpt_devise_transport(struct cam_path *path);
858 static void      xpt_set_transfer_settings(struct ccb_trans_settings *cts,
859                                            struct cam_ed *device,
860                                            int async_update);
861 static void      xpt_toggle_tags(struct cam_path *path);
862 static void      xpt_start_tags(struct cam_path *path);
863 static __inline int xpt_schedule_dev_allocq(struct cam_eb *bus,
864                                             struct cam_ed *dev);
865 static __inline int xpt_schedule_dev_sendq(struct cam_eb *bus,
866                                            struct cam_ed *dev);
867 static __inline int periph_is_queued(struct cam_periph *periph);
868 static __inline int device_is_alloc_queued(struct cam_ed *device);
869 static __inline int device_is_send_queued(struct cam_ed *device);
870 static __inline int dev_allocq_is_runnable(struct cam_devq *devq);
871
872 static __inline int
873 xpt_schedule_dev_allocq(struct cam_eb *bus, struct cam_ed *dev)
874 {
875         int retval;
876
877         if (dev->ccbq.devq_openings > 0) {
878                 if ((dev->flags & CAM_DEV_RESIZE_QUEUE_NEEDED) != 0) {
879                         cam_ccbq_resize(&dev->ccbq,
880                                         dev->ccbq.dev_openings
881                                         + dev->ccbq.dev_active);
882                         dev->flags &= ~CAM_DEV_RESIZE_QUEUE_NEEDED;
883                 }
884                 /*
885                  * The priority of a device waiting for CCB resources
886                  * is that of the the highest priority peripheral driver
887                  * enqueued.
888                  */
889                 retval = xpt_schedule_dev(&bus->sim->devq->alloc_queue,
890                                           &dev->alloc_ccb_entry.pinfo,
891                                           CAMQ_GET_HEAD(&dev->drvq)->priority);
892         } else {
893                 retval = 0;
894         }
895
896         return (retval);
897 }
898
899 static __inline int
900 xpt_schedule_dev_sendq(struct cam_eb *bus, struct cam_ed *dev)
901 {
902         int     retval;
903
904         if (dev->ccbq.dev_openings > 0) {
905                 /*
906                  * The priority of a device waiting for controller
907                  * resources is that of the the highest priority CCB
908                  * enqueued.
909                  */
910                 retval =
911                     xpt_schedule_dev(&bus->sim->devq->send_queue,
912                                      &dev->send_ccb_entry.pinfo,
913                                      CAMQ_GET_HEAD(&dev->ccbq.queue)->priority);
914         } else {
915                 retval = 0;
916         }
917         return (retval);
918 }
919
920 static __inline int
921 periph_is_queued(struct cam_periph *periph)
922 {
923         return (periph->pinfo.index != CAM_UNQUEUED_INDEX);
924 }
925
926 static __inline int
927 device_is_alloc_queued(struct cam_ed *device)
928 {
929         return (device->alloc_ccb_entry.pinfo.index != CAM_UNQUEUED_INDEX);
930 }
931
932 static __inline int
933 device_is_send_queued(struct cam_ed *device)
934 {
935         return (device->send_ccb_entry.pinfo.index != CAM_UNQUEUED_INDEX);
936 }
937
938 static __inline int
939 dev_allocq_is_runnable(struct cam_devq *devq)
940 {
941         /*
942          * Have work to do.
943          * Have space to do more work.
944          * Allowed to do work.
945          */
946         return ((devq->alloc_queue.qfrozen_cnt == 0)
947              && (devq->alloc_queue.entries > 0)
948              && (devq->alloc_openings > 0));
949 }
950
951 static void
952 xpt_periph_init()
953 {
954         make_dev(&xpt_cdevsw, 0, UID_ROOT, GID_OPERATOR, 0600, "xpt0");
955 }
956
957 static void
958 probe_periph_init()
959 {
960 }
961
962
963 static void
964 xptdone(struct cam_periph *periph, union ccb *done_ccb)
965 {
966         /* Caller will release the CCB */
967         wakeup(&done_ccb->ccb_h.cbfcnp);
968 }
969
970 static int
971 xptopen(struct cdev *dev, int flags, int fmt, struct thread *td)
972 {
973
974         /*
975          * Only allow read-write access.
976          */
977         if (((flags & FWRITE) == 0) || ((flags & FREAD) == 0))
978                 return(EPERM);
979
980         /*
981          * We don't allow nonblocking access.
982          */
983         if ((flags & O_NONBLOCK) != 0) {
984                 printf("%s: can't do nonblocking access\n", devtoname(dev));
985                 return(ENODEV);
986         }
987
988         /* Mark ourselves open */
989         mtx_lock(&xsoftc.xpt_lock);
990         xsoftc.flags |= XPT_FLAG_OPEN;
991         mtx_unlock(&xsoftc.xpt_lock);
992
993         return(0);
994 }
995
996 static int
997 xptclose(struct cdev *dev, int flag, int fmt, struct thread *td)
998 {
999
1000         /* Mark ourselves closed */
1001         mtx_lock(&xsoftc.xpt_lock);
1002         xsoftc.flags &= ~XPT_FLAG_OPEN;
1003         mtx_unlock(&xsoftc.xpt_lock);
1004
1005         return(0);
1006 }
1007
1008 /*
1009  * Don't automatically grab the xpt softc lock here even though this is going
1010  * through the xpt device.  The xpt device is really just a back door for
1011  * accessing other devices and SIMs, so the right thing to do is to grab
1012  * the appropriate SIM lock once the bus/SIM is located.
1013  */
1014 static int
1015 xptioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag, struct thread *td)
1016 {
1017         int error;
1018
1019         error = 0;
1020
1021         switch(cmd) {
1022         /*
1023          * For the transport layer CAMIOCOMMAND ioctl, we really only want
1024          * to accept CCB types that don't quite make sense to send through a
1025          * passthrough driver. XPT_PATH_INQ is an exception to this, as stated
1026          * in the CAM spec.
1027          */
1028         case CAMIOCOMMAND: {
1029                 union ccb *ccb;
1030                 union ccb *inccb;
1031                 struct cam_eb *bus;
1032
1033                 inccb = (union ccb *)addr;
1034
1035                 bus = xpt_find_bus(inccb->ccb_h.path_id);
1036                 if (bus == NULL) {
1037                         error = EINVAL;
1038                         break;
1039                 }
1040
1041                 switch(inccb->ccb_h.func_code) {
1042                 case XPT_SCAN_BUS:
1043                 case XPT_RESET_BUS:
1044                         if ((inccb->ccb_h.target_id != CAM_TARGET_WILDCARD)
1045                          || (inccb->ccb_h.target_lun != CAM_LUN_WILDCARD)) {
1046                                 error = EINVAL;
1047                                 break;
1048                         }
1049                         /* FALLTHROUGH */
1050                 case XPT_PATH_INQ:
1051                 case XPT_ENG_INQ:
1052                 case XPT_SCAN_LUN:
1053
1054                         ccb = xpt_alloc_ccb();
1055
1056                         CAM_SIM_LOCK(bus->sim);
1057
1058                         /*
1059                          * Create a path using the bus, target, and lun the
1060                          * user passed in.
1061                          */
1062                         if (xpt_create_path(&ccb->ccb_h.path, xpt_periph,
1063                                             inccb->ccb_h.path_id,
1064                                             inccb->ccb_h.target_id,
1065                                             inccb->ccb_h.target_lun) !=
1066                                             CAM_REQ_CMP){
1067                                 error = EINVAL;
1068                                 CAM_SIM_UNLOCK(bus->sim);
1069                                 xpt_free_ccb(ccb);
1070                                 break;
1071                         }
1072                         /* Ensure all of our fields are correct */
1073                         xpt_setup_ccb(&ccb->ccb_h, ccb->ccb_h.path,
1074                                       inccb->ccb_h.pinfo.priority);
1075                         xpt_merge_ccb(ccb, inccb);
1076                         ccb->ccb_h.cbfcnp = xptdone;
1077                         cam_periph_runccb(ccb, NULL, 0, 0, NULL);
1078                         bcopy(ccb, inccb, sizeof(union ccb));
1079                         xpt_free_path(ccb->ccb_h.path);
1080                         xpt_free_ccb(ccb);
1081                         CAM_SIM_UNLOCK(bus->sim);
1082                         break;
1083
1084                 case XPT_DEBUG: {
1085                         union ccb ccb;
1086
1087                         /*
1088                          * This is an immediate CCB, so it's okay to
1089                          * allocate it on the stack.
1090                          */
1091
1092                         CAM_SIM_LOCK(bus->sim);
1093
1094                         /*
1095                          * Create a path using the bus, target, and lun the
1096                          * user passed in.
1097                          */
1098                         if (xpt_create_path(&ccb.ccb_h.path, xpt_periph,
1099                                             inccb->ccb_h.path_id,
1100                                             inccb->ccb_h.target_id,
1101                                             inccb->ccb_h.target_lun) !=
1102                                             CAM_REQ_CMP){
1103                                 error = EINVAL;
1104                                 CAM_SIM_UNLOCK(bus->sim);
1105                                 break;
1106                         }
1107                         /* Ensure all of our fields are correct */
1108                         xpt_setup_ccb(&ccb.ccb_h, ccb.ccb_h.path,
1109                                       inccb->ccb_h.pinfo.priority);
1110                         xpt_merge_ccb(&ccb, inccb);
1111                         ccb.ccb_h.cbfcnp = xptdone;
1112                         xpt_action(&ccb);
1113                         CAM_SIM_UNLOCK(bus->sim);
1114                         bcopy(&ccb, inccb, sizeof(union ccb));
1115                         xpt_free_path(ccb.ccb_h.path);
1116                         break;
1117
1118                 }
1119                 case XPT_DEV_MATCH: {
1120                         struct cam_periph_map_info mapinfo;
1121                         struct cam_path *old_path;
1122
1123                         /*
1124                          * We can't deal with physical addresses for this
1125                          * type of transaction.
1126                          */
1127                         if (inccb->ccb_h.flags & CAM_DATA_PHYS) {
1128                                 error = EINVAL;
1129                                 break;
1130                         }
1131
1132                         /*
1133                          * Save this in case the caller had it set to
1134                          * something in particular.
1135                          */
1136                         old_path = inccb->ccb_h.path;
1137
1138                         /*
1139                          * We really don't need a path for the matching
1140                          * code.  The path is needed because of the
1141                          * debugging statements in xpt_action().  They
1142                          * assume that the CCB has a valid path.
1143                          */
1144                         inccb->ccb_h.path = xpt_periph->path;
1145
1146                         bzero(&mapinfo, sizeof(mapinfo));
1147
1148                         /*
1149                          * Map the pattern and match buffers into kernel
1150                          * virtual address space.
1151                          */
1152                         error = cam_periph_mapmem(inccb, &mapinfo);
1153
1154                         if (error) {
1155                                 inccb->ccb_h.path = old_path;
1156                                 break;
1157                         }
1158
1159                         /*
1160                          * This is an immediate CCB, we can send it on directly.
1161                          */
1162                         xpt_action(inccb);
1163
1164                         /*
1165                          * Map the buffers back into user space.
1166                          */
1167                         cam_periph_unmapmem(inccb, &mapinfo);
1168
1169                         inccb->ccb_h.path = old_path;
1170
1171                         error = 0;
1172                         break;
1173                 }
1174                 default:
1175                         error = ENOTSUP;
1176                         break;
1177                 }
1178                 xpt_release_bus(bus);
1179                 break;
1180         }
1181         /*
1182          * This is the getpassthru ioctl. It takes a XPT_GDEVLIST ccb as input,
1183          * with the periphal driver name and unit name filled in.  The other
1184          * fields don't really matter as input.  The passthrough driver name
1185          * ("pass"), and unit number are passed back in the ccb.  The current
1186          * device generation number, and the index into the device peripheral
1187          * driver list, and the status are also passed back.  Note that
1188          * since we do everything in one pass, unlike the XPT_GDEVLIST ccb,
1189          * we never return a status of CAM_GDEVLIST_LIST_CHANGED.  It is
1190          * (or rather should be) impossible for the device peripheral driver
1191          * list to change since we look at the whole thing in one pass, and
1192          * we do it with lock protection.
1193          *
1194          */
1195         case CAMGETPASSTHRU: {
1196                 union ccb *ccb;
1197                 struct cam_periph *periph;
1198                 struct periph_driver **p_drv;
1199                 char   *name;
1200                 u_int unit;
1201                 u_int cur_generation;
1202                 int base_periph_found;
1203                 int splbreaknum;
1204
1205                 ccb = (union ccb *)addr;
1206                 unit = ccb->cgdl.unit_number;
1207                 name = ccb->cgdl.periph_name;
1208                 /*
1209                  * Every 100 devices, we want to drop our lock protection to
1210                  * give the software interrupt handler a chance to run.
1211                  * Most systems won't run into this check, but this should
1212                  * avoid starvation in the software interrupt handler in
1213                  * large systems.
1214                  */
1215                 splbreaknum = 100;
1216
1217                 ccb = (union ccb *)addr;
1218
1219                 base_periph_found = 0;
1220
1221                 /*
1222                  * Sanity check -- make sure we don't get a null peripheral
1223                  * driver name.
1224                  */
1225                 if (*ccb->cgdl.periph_name == '\0') {
1226                         error = EINVAL;
1227                         break;
1228                 }
1229
1230                 /* Keep the list from changing while we traverse it */
1231                 mtx_lock(&xsoftc.xpt_topo_lock);
1232 ptstartover:
1233                 cur_generation = xsoftc.xpt_generation;
1234
1235                 /* first find our driver in the list of drivers */
1236                 for (p_drv = periph_drivers; *p_drv != NULL; p_drv++)
1237                         if (strcmp((*p_drv)->driver_name, name) == 0)
1238                                 break;
1239
1240                 if (*p_drv == NULL) {
1241                         mtx_unlock(&xsoftc.xpt_topo_lock);
1242                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1243                         ccb->cgdl.status = CAM_GDEVLIST_ERROR;
1244                         *ccb->cgdl.periph_name = '\0';
1245                         ccb->cgdl.unit_number = 0;
1246                         error = ENOENT;
1247                         break;
1248                 }
1249
1250                 /*
1251                  * Run through every peripheral instance of this driver
1252                  * and check to see whether it matches the unit passed
1253                  * in by the user.  If it does, get out of the loops and
1254                  * find the passthrough driver associated with that
1255                  * peripheral driver.
1256                  */
1257                 for (periph = TAILQ_FIRST(&(*p_drv)->units); periph != NULL;
1258                      periph = TAILQ_NEXT(periph, unit_links)) {
1259
1260                         if (periph->unit_number == unit) {
1261                                 break;
1262                         } else if (--splbreaknum == 0) {
1263                                 mtx_unlock(&xsoftc.xpt_topo_lock);
1264                                 mtx_lock(&xsoftc.xpt_topo_lock);
1265                                 splbreaknum = 100;
1266                                 if (cur_generation != xsoftc.xpt_generation)
1267                                        goto ptstartover;
1268                         }
1269                 }
1270                 /*
1271                  * If we found the peripheral driver that the user passed
1272                  * in, go through all of the peripheral drivers for that
1273                  * particular device and look for a passthrough driver.
1274                  */
1275                 if (periph != NULL) {
1276                         struct cam_ed *device;
1277                         int i;
1278
1279                         base_periph_found = 1;
1280                         device = periph->path->device;
1281                         for (i = 0, periph = SLIST_FIRST(&device->periphs);
1282                              periph != NULL;
1283                              periph = SLIST_NEXT(periph, periph_links), i++) {
1284                                 /*
1285                                  * Check to see whether we have a
1286                                  * passthrough device or not.
1287                                  */
1288                                 if (strcmp(periph->periph_name, "pass") == 0) {
1289                                         /*
1290                                          * Fill in the getdevlist fields.
1291                                          */
1292                                         strcpy(ccb->cgdl.periph_name,
1293                                                periph->periph_name);
1294                                         ccb->cgdl.unit_number =
1295                                                 periph->unit_number;
1296                                         if (SLIST_NEXT(periph, periph_links))
1297                                                 ccb->cgdl.status =
1298                                                         CAM_GDEVLIST_MORE_DEVS;
1299                                         else
1300                                                 ccb->cgdl.status =
1301                                                        CAM_GDEVLIST_LAST_DEVICE;
1302                                         ccb->cgdl.generation =
1303                                                 device->generation;
1304                                         ccb->cgdl.index = i;
1305                                         /*
1306                                          * Fill in some CCB header fields
1307                                          * that the user may want.
1308                                          */
1309                                         ccb->ccb_h.path_id =
1310                                                 periph->path->bus->path_id;
1311                                         ccb->ccb_h.target_id =
1312                                                 periph->path->target->target_id;
1313                                         ccb->ccb_h.target_lun =
1314                                                 periph->path->device->lun_id;
1315                                         ccb->ccb_h.status = CAM_REQ_CMP;
1316                                         break;
1317                                 }
1318                         }
1319                 }
1320
1321                 /*
1322                  * If the periph is null here, one of two things has
1323                  * happened.  The first possibility is that we couldn't
1324                  * find the unit number of the particular peripheral driver
1325                  * that the user is asking about.  e.g. the user asks for
1326                  * the passthrough driver for "da11".  We find the list of
1327                  * "da" peripherals all right, but there is no unit 11.
1328                  * The other possibility is that we went through the list
1329                  * of peripheral drivers attached to the device structure,
1330                  * but didn't find one with the name "pass".  Either way,
1331                  * we return ENOENT, since we couldn't find something.
1332                  */
1333                 if (periph == NULL) {
1334                         ccb->ccb_h.status = CAM_REQ_CMP_ERR;
1335                         ccb->cgdl.status = CAM_GDEVLIST_ERROR;
1336                         *ccb->cgdl.periph_name = '\0';
1337                         ccb->cgdl.unit_number = 0;
1338                         error = ENOENT;
1339                         /*
1340                          * It is unfortunate that this is even necessary,
1341                          * but there are many, many clueless users out there.
1342                          * If this is true, the user is looking for the
1343                          * passthrough driver, but doesn't have one in his
1344                          * kernel.
1345                          */
1346                         if (base_periph_found == 1) {
1347                                 printf("xptioctl: pass driver is not in the "
1348                                        "kernel\n");
1349                                 printf("xptioctl: put \"device pass\" in "
1350                                        "your kernel config file\n");
1351                         }
1352                 }
1353                 mtx_unlock(&xsoftc.xpt_topo_lock);
1354                 break;
1355                 }
1356         default:
1357                 error = ENOTTY;
1358                 break;
1359         }
1360
1361         return(error);
1362 }
1363
1364 static int
1365 cam_module_event_handler(module_t mod, int what, void *arg)
1366 {
1367         int error;
1368
1369         switch (what) {
1370         case MOD_LOAD:
1371                 if ((error = xpt_init(NULL)) != 0)
1372                         return (error);
1373                 break;
1374         case MOD_UNLOAD:
1375                 return EBUSY;
1376         default:
1377                 return EOPNOTSUPP;
1378         }
1379
1380         return 0;
1381 }
1382
1383 /* thread to handle bus rescans */
1384 static void
1385 xpt_scanner_thread(void *dummy)
1386 {
1387         cam_isrq_t      queue;
1388         union ccb       *ccb;
1389         struct cam_sim  *sim;
1390
1391         for (;;) {
1392                 /*
1393                  * Wait for a rescan request to come in.  When it does, splice
1394                  * it onto a queue from local storage so that the xpt lock
1395                  * doesn't need to be held while the requests are being
1396                  * processed.
1397                  */
1398                 xpt_lock_buses();
1399                 msleep(&xsoftc.ccb_scanq, &xsoftc.xpt_topo_lock, PRIBIO,
1400                     "ccb_scanq", 0);
1401                 TAILQ_INIT(&queue);
1402                 TAILQ_CONCAT(&queue, &xsoftc.ccb_scanq, sim_links.tqe);
1403                 xpt_unlock_buses();
1404
1405                 while ((ccb = (union ccb *)TAILQ_FIRST(&queue)) != NULL) {
1406                         TAILQ_REMOVE(&queue, &ccb->ccb_h, sim_links.tqe);
1407
1408                         sim = ccb->ccb_h.path->bus->sim;
1409                         CAM_SIM_LOCK(sim);
1410
1411                         ccb->ccb_h.func_code = XPT_SCAN_BUS;
1412                         ccb->ccb_h.cbfcnp = xptdone;
1413                         xpt_setup_ccb(&ccb->ccb_h, ccb->ccb_h.path, 5);
1414                         cam_periph_runccb(ccb, NULL, 0, 0, NULL);
1415                         xpt_free_path(ccb->ccb_h.path);
1416                         xpt_free_ccb(ccb);
1417                         CAM_SIM_UNLOCK(sim);
1418                 }
1419         }
1420 }
1421
1422 void
1423 xpt_rescan(union ccb *ccb)
1424 {
1425         struct ccb_hdr *hdr;
1426
1427         /*
1428          * Don't make duplicate entries for the same paths.
1429          */
1430         xpt_lock_buses();
1431         TAILQ_FOREACH(hdr, &xsoftc.ccb_scanq, sim_links.tqe) {
1432                 if (xpt_path_comp(hdr->path, ccb->ccb_h.path) == 0) {
1433                         xpt_unlock_buses();
1434                         xpt_print(ccb->ccb_h.path, "rescan already queued\n");
1435                         xpt_free_path(ccb->ccb_h.path);
1436                         xpt_free_ccb(ccb);
1437                         return;
1438                 }
1439         }
1440         TAILQ_INSERT_TAIL(&xsoftc.ccb_scanq, &ccb->ccb_h, sim_links.tqe);
1441         wakeup(&xsoftc.ccb_scanq);
1442         xpt_unlock_buses();
1443 }
1444
1445 /* Functions accessed by the peripheral drivers */
1446 static int
1447 xpt_init(void *dummy)
1448 {
1449         struct cam_sim *xpt_sim;
1450         struct cam_path *path;
1451         struct cam_devq *devq;
1452         cam_status status;
1453
1454         TAILQ_INIT(&xsoftc.xpt_busses);
1455         TAILQ_INIT(&cam_simq);
1456         TAILQ_INIT(&xsoftc.ccb_scanq);
1457         STAILQ_INIT(&xsoftc.highpowerq);
1458         xsoftc.num_highpower = CAM_MAX_HIGHPOWER;
1459
1460         mtx_init(&cam_simq_lock, "CAM SIMQ lock", NULL, MTX_DEF);
1461         mtx_init(&xsoftc.xpt_lock, "XPT lock", NULL, MTX_DEF);
1462         mtx_init(&xsoftc.xpt_topo_lock, "XPT topology lock", NULL, MTX_DEF);
1463
1464         /*
1465          * The xpt layer is, itself, the equivelent of a SIM.
1466          * Allow 16 ccbs in the ccb pool for it.  This should
1467          * give decent parallelism when we probe busses and
1468          * perform other XPT functions.
1469          */
1470         devq = cam_simq_alloc(16);
1471         xpt_sim = cam_sim_alloc(xptaction,
1472                                 xptpoll,
1473                                 "xpt",
1474                                 /*softc*/NULL,
1475                                 /*unit*/0,
1476                                 /*mtx*/&xsoftc.xpt_lock,
1477                                 /*max_dev_transactions*/0,
1478                                 /*max_tagged_dev_transactions*/0,
1479                                 devq);
1480         if (xpt_sim == NULL)
1481                 return (ENOMEM);
1482
1483         xpt_sim->max_ccbs = 16;
1484
1485         mtx_lock(&xsoftc.xpt_lock);
1486         if ((status = xpt_bus_register(xpt_sim, NULL, 0)) != CAM_SUCCESS) {
1487                 printf("xpt_init: xpt_bus_register failed with status %#x,"
1488                        " failing attach\n", status);
1489                 return (EINVAL);
1490         }
1491
1492         /*
1493          * Looking at the XPT from the SIM layer, the XPT is
1494          * the equivelent of a peripheral driver.  Allocate
1495          * a peripheral driver entry for us.
1496          */
1497         if ((status = xpt_create_path(&path, NULL, CAM_XPT_PATH_ID,
1498                                       CAM_TARGET_WILDCARD,
1499                                       CAM_LUN_WILDCARD)) != CAM_REQ_CMP) {
1500                 printf("xpt_init: xpt_create_path failed with status %#x,"
1501                        " failing attach\n", status);
1502                 return (EINVAL);
1503         }
1504
1505         cam_periph_alloc(xptregister, NULL, NULL, NULL, "xpt", CAM_PERIPH_BIO,
1506                          path, NULL, 0, xpt_sim);
1507         xpt_free_path(path);
1508         mtx_unlock(&xsoftc.xpt_lock);
1509
1510         /*
1511          * Register a callback for when interrupts are enabled.
1512          */
1513         xsoftc.xpt_config_hook =
1514             (struct intr_config_hook *)malloc(sizeof(struct intr_config_hook),
1515                                               M_CAMXPT, M_NOWAIT | M_ZERO);
1516         if (xsoftc.xpt_config_hook == NULL) {
1517                 printf("xpt_init: Cannot malloc config hook "
1518                        "- failing attach\n");
1519                 return (ENOMEM);
1520         }
1521
1522         xsoftc.xpt_config_hook->ich_func = xpt_config;
1523         if (config_intrhook_establish(xsoftc.xpt_config_hook) != 0) {
1524                 free (xsoftc.xpt_config_hook, M_CAMXPT);
1525                 printf("xpt_init: config_intrhook_establish failed "
1526                        "- failing attach\n");
1527         }
1528
1529         /* fire up rescan thread */
1530         if (kproc_create(xpt_scanner_thread, NULL, NULL, 0, 0, "xpt_thrd")) {
1531                 printf("xpt_init: failed to create rescan thread\n");
1532         }
1533         /* Install our software interrupt handlers */
1534         swi_add(NULL, "cambio", camisr, NULL, SWI_CAMBIO, INTR_MPSAFE, &cambio_ih);
1535
1536         return (0);
1537 }
1538
1539 static cam_status
1540 xptregister(struct cam_periph *periph, void *arg)
1541 {
1542         struct cam_sim *xpt_sim;
1543
1544         if (periph == NULL) {
1545                 printf("xptregister: periph was NULL!!\n");
1546                 return(CAM_REQ_CMP_ERR);
1547         }
1548
1549         xpt_sim = (struct cam_sim *)arg;
1550         xpt_sim->softc = periph;
1551         xpt_periph = periph;
1552         periph->softc = NULL;
1553
1554         return(CAM_REQ_CMP);
1555 }
1556
1557 int32_t
1558 xpt_add_periph(struct cam_periph *periph)
1559 {
1560         struct cam_ed *device;
1561         int32_t  status;
1562         struct periph_list *periph_head;
1563
1564         mtx_assert(periph->sim->mtx, MA_OWNED);
1565
1566         device = periph->path->device;
1567
1568         periph_head = &device->periphs;
1569
1570         status = CAM_REQ_CMP;
1571
1572         if (device != NULL) {
1573                 /*
1574                  * Make room for this peripheral
1575                  * so it will fit in the queue
1576                  * when it's scheduled to run
1577                  */
1578                 status = camq_resize(&device->drvq,
1579                                      device->drvq.array_size + 1);
1580
1581                 device->generation++;
1582
1583                 SLIST_INSERT_HEAD(periph_head, periph, periph_links);
1584         }
1585
1586         mtx_lock(&xsoftc.xpt_topo_lock);
1587         xsoftc.xpt_generation++;
1588         mtx_unlock(&xsoftc.xpt_topo_lock);
1589
1590         return (status);
1591 }
1592
1593 void
1594 xpt_remove_periph(struct cam_periph *periph)
1595 {
1596         struct cam_ed *device;
1597
1598         mtx_assert(periph->sim->mtx, MA_OWNED);
1599
1600         device = periph->path->device;
1601
1602         if (device != NULL) {
1603                 struct periph_list *periph_head;
1604
1605                 periph_head = &device->periphs;
1606
1607                 /* Release the slot for this peripheral */
1608                 camq_resize(&device->drvq, device->drvq.array_size - 1);
1609
1610                 device->generation++;
1611
1612                 SLIST_REMOVE(periph_head, periph, cam_periph, periph_links);
1613         }
1614
1615         mtx_lock(&xsoftc.xpt_topo_lock);
1616         xsoftc.xpt_generation++;
1617         mtx_unlock(&xsoftc.xpt_topo_lock);
1618 }
1619
1620
1621 void
1622 xpt_announce_periph(struct cam_periph *periph, char *announce_string)
1623 {
1624         struct  ccb_pathinq cpi;
1625         struct  ccb_trans_settings cts;
1626         struct  cam_path *path;
1627         u_int   speed;
1628         u_int   freq;
1629         u_int   mb;
1630
1631         mtx_assert(periph->sim->mtx, MA_OWNED);
1632
1633         path = periph->path;
1634         /*
1635          * To ensure that this is printed in one piece,
1636          * mask out CAM interrupts.
1637          */
1638         printf("%s%d at %s%d bus %d target %d lun %d\n",
1639                periph->periph_name, periph->unit_number,
1640                path->bus->sim->sim_name,
1641                path->bus->sim->unit_number,
1642                path->bus->sim->bus_id,
1643                path->target->target_id,
1644                path->device->lun_id);
1645         printf("%s%d: ", periph->periph_name, periph->unit_number);
1646         scsi_print_inquiry(&path->device->inq_data);
1647         if (bootverbose && path->device->serial_num_len > 0) {
1648                 /* Don't wrap the screen  - print only the first 60 chars */
1649                 printf("%s%d: Serial Number %.60s\n", periph->periph_name,
1650                        periph->unit_number, path->device->serial_num);
1651         }
1652         xpt_setup_ccb(&cts.ccb_h, path, /*priority*/1);
1653         cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS;
1654         cts.type = CTS_TYPE_CURRENT_SETTINGS;
1655         xpt_action((union ccb*)&cts);
1656         if ((cts.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
1657                 return;
1658         }
1659
1660         /* Ask the SIM for its base transfer speed */
1661         xpt_setup_ccb(&cpi.ccb_h, path, /*priority*/1);
1662         cpi.ccb_h.func_code = XPT_PATH_INQ;
1663         xpt_action((union ccb *)&cpi);
1664
1665         speed = cpi.base_transfer_speed;
1666         freq = 0;
1667         if (cts.ccb_h.status == CAM_REQ_CMP && cts.transport == XPORT_SPI) {
1668                 struct  ccb_trans_settings_spi *spi;
1669
1670                 spi = &cts.xport_specific.spi;
1671                 if ((spi->valid & CTS_SPI_VALID_SYNC_OFFSET) != 0
1672                   && spi->sync_offset != 0) {
1673                         freq = scsi_calc_syncsrate(spi->sync_period);
1674                         speed = freq;
1675                 }
1676
1677                 if ((spi->valid & CTS_SPI_VALID_BUS_WIDTH) != 0)
1678                         speed *= (0x01 << spi->bus_width);
1679         }
1680
1681         if (cts.ccb_h.status == CAM_REQ_CMP && cts.transport == XPORT_FC) {
1682                 struct  ccb_trans_settings_fc *fc = &cts.xport_specific.fc;
1683                 if (fc->valid & CTS_FC_VALID_SPEED) {
1684                         speed = fc->bitrate;
1685                 }
1686         }
1687
1688         if (cts.ccb_h.status == CAM_REQ_CMP && cts.transport == XPORT_SAS) {
1689                 struct  ccb_trans_settings_sas *sas = &cts.xport_specific.sas;
1690                 if (sas->valid & CTS_SAS_VALID_SPEED) {
1691                         speed = sas->bitrate;
1692                 }
1693         }
1694
1695         mb = speed / 1000;
1696         if (mb > 0)
1697                 printf("%s%d: %d.%03dMB/s transfers",
1698                        periph->periph_name, periph->unit_number,
1699                        mb, speed % 1000);
1700         else
1701                 printf("%s%d: %dKB/s transfers", periph->periph_name,
1702                        periph->unit_number, speed);
1703         /* Report additional information about SPI connections */
1704         if (cts.ccb_h.status == CAM_REQ_CMP && cts.transport == XPORT_SPI) {
1705                 struct  ccb_trans_settings_spi *spi;
1706
1707                 spi = &cts.xport_specific.spi;
1708                 if (freq != 0) {
1709                         printf(" (%d.%03dMHz%s, offset %d", freq / 1000,
1710                                freq % 1000,
1711                                (spi->ppr_options & MSG_EXT_PPR_DT_REQ) != 0
1712                              ? " DT" : "",
1713                                spi->sync_offset);
1714                 }
1715                 if ((spi->valid & CTS_SPI_VALID_BUS_WIDTH) != 0
1716                  && spi->bus_width > 0) {
1717                         if (freq != 0) {
1718                                 printf(", ");
1719                         } else {
1720                                 printf(" (");
1721                         }
1722                         printf("%dbit)", 8 * (0x01 << spi->bus_width));
1723                 } else if (freq != 0) {
1724                         printf(")");
1725                 }
1726         }
1727         if (cts.ccb_h.status == CAM_REQ_CMP && cts.transport == XPORT_FC) {
1728                 struct  ccb_trans_settings_fc *fc;
1729
1730                 fc = &cts.xport_specific.fc;
1731                 if (fc->valid & CTS_FC_VALID_WWNN)
1732                         printf(" WWNN 0x%llx", (long long) fc->wwnn);
1733                 if (fc->valid & CTS_FC_VALID_WWPN)
1734                         printf(" WWPN 0x%llx", (long long) fc->wwpn);
1735                 if (fc->valid & CTS_FC_VALID_PORT)
1736                         printf(" PortID 0x%x", fc->port);
1737         }
1738
1739         if (path->device->inq_flags & SID_CmdQue
1740          || path->device->flags & CAM_DEV_TAG_AFTER_COUNT) {
1741                 printf("\n%s%d: Command Queueing Enabled",
1742                        periph->periph_name, periph->unit_number);
1743         }
1744         printf("\n");
1745
1746         /*
1747          * We only want to print the caller's announce string if they've
1748          * passed one in..
1749          */
1750         if (announce_string != NULL)
1751                 printf("%s%d: %s\n", periph->periph_name,
1752                        periph->unit_number, announce_string);
1753 }
1754
1755 static dev_match_ret
1756 xptbusmatch(struct dev_match_pattern *patterns, u_int num_patterns,
1757             struct cam_eb *bus)
1758 {
1759         dev_match_ret retval;
1760         int i;
1761
1762         retval = DM_RET_NONE;
1763
1764         /*
1765          * If we aren't given something to match against, that's an error.
1766          */
1767         if (bus == NULL)
1768                 return(DM_RET_ERROR);
1769
1770         /*
1771          * If there are no match entries, then this bus matches no
1772          * matter what.
1773          */
1774         if ((patterns == NULL) || (num_patterns == 0))
1775                 return(DM_RET_DESCEND | DM_RET_COPY);
1776
1777         for (i = 0; i < num_patterns; i++) {
1778                 struct bus_match_pattern *cur_pattern;
1779
1780                 /*
1781                  * If the pattern in question isn't for a bus node, we
1782                  * aren't interested.  However, we do indicate to the
1783                  * calling routine that we should continue descending the
1784                  * tree, since the user wants to match against lower-level
1785                  * EDT elements.
1786                  */
1787                 if (patterns[i].type != DEV_MATCH_BUS) {
1788                         if ((retval & DM_RET_ACTION_MASK) == DM_RET_NONE)
1789                                 retval |= DM_RET_DESCEND;
1790                         continue;
1791                 }
1792
1793                 cur_pattern = &patterns[i].pattern.bus_pattern;
1794
1795                 /*
1796                  * If they want to match any bus node, we give them any
1797                  * device node.
1798                  */
1799                 if (cur_pattern->flags == BUS_MATCH_ANY) {
1800                         /* set the copy flag */
1801                         retval |= DM_RET_COPY;
1802
1803                         /*
1804                          * If we've already decided on an action, go ahead
1805                          * and return.
1806                          */
1807                         if ((retval & DM_RET_ACTION_MASK) != DM_RET_NONE)
1808                                 return(retval);
1809                 }
1810
1811                 /*
1812                  * Not sure why someone would do this...
1813                  */
1814                 if (cur_pattern->flags == BUS_MATCH_NONE)
1815                         continue;
1816
1817                 if (((cur_pattern->flags & BUS_MATCH_PATH) != 0)
1818                  && (cur_pattern->path_id != bus->path_id))
1819                         continue;
1820
1821                 if (((cur_pattern->flags & BUS_MATCH_BUS_ID) != 0)
1822                  && (cur_pattern->bus_id != bus->sim->bus_id))
1823                         continue;
1824
1825                 if (((cur_pattern->flags & BUS_MATCH_UNIT) != 0)
1826                  && (cur_pattern->unit_number != bus->sim->unit_number))
1827                         continue;
1828
1829                 if (((cur_pattern->flags & BUS_MATCH_NAME) != 0)
1830                  && (strncmp(cur_pattern->dev_name, bus->sim->sim_name,
1831                              DEV_IDLEN) != 0))
1832                         continue;
1833
1834                 /*
1835                  * If we get to this point, the user definitely wants
1836                  * information on this bus.  So tell the caller to copy the
1837                  * data out.
1838                  */
1839                 retval |= DM_RET_COPY;
1840
1841                 /*
1842                  * If the return action has been set to descend, then we
1843                  * know that we've already seen a non-bus matching
1844                  * expression, therefore we need to further descend the tree.
1845                  * This won't change by continuing around the loop, so we
1846                  * go ahead and return.  If we haven't seen a non-bus
1847                  * matching expression, we keep going around the loop until
1848                  * we exhaust the matching expressions.  We'll set the stop
1849                  * flag once we fall out of the loop.
1850                  */
1851                 if ((retval & DM_RET_ACTION_MASK) == DM_RET_DESCEND)
1852                         return(retval);
1853         }
1854
1855         /*
1856          * If the return action hasn't been set to descend yet, that means
1857          * we haven't seen anything other than bus matching patterns.  So
1858          * tell the caller to stop descending the tree -- the user doesn't
1859          * want to match against lower level tree elements.
1860          */
1861         if ((retval & DM_RET_ACTION_MASK) == DM_RET_NONE)
1862                 retval |= DM_RET_STOP;
1863
1864         return(retval);
1865 }
1866
1867 static dev_match_ret
1868 xptdevicematch(struct dev_match_pattern *patterns, u_int num_patterns,
1869                struct cam_ed *device)
1870 {
1871         dev_match_ret retval;
1872         int i;
1873
1874         retval = DM_RET_NONE;
1875
1876         /*
1877          * If we aren't given something to match against, that's an error.
1878          */
1879         if (device == NULL)
1880                 return(DM_RET_ERROR);
1881
1882         /*
1883          * If there are no match entries, then this device matches no
1884          * matter what.
1885          */
1886         if ((patterns == NULL) || (num_patterns == 0))
1887                 return(DM_RET_DESCEND | DM_RET_COPY);
1888
1889         for (i = 0; i < num_patterns; i++) {
1890                 struct device_match_pattern *cur_pattern;
1891
1892                 /*
1893                  * If the pattern in question isn't for a device node, we
1894                  * aren't interested.
1895                  */
1896                 if (patterns[i].type != DEV_MATCH_DEVICE) {
1897                         if ((patterns[i].type == DEV_MATCH_PERIPH)
1898                          && ((retval & DM_RET_ACTION_MASK) == DM_RET_NONE))
1899                                 retval |= DM_RET_DESCEND;
1900                         continue;
1901                 }
1902
1903                 cur_pattern = &patterns[i].pattern.device_pattern;
1904
1905                 /*
1906                  * If they want to match any device node, we give them any
1907                  * device node.
1908                  */
1909                 if (cur_pattern->flags == DEV_MATCH_ANY) {
1910                         /* set the copy flag */
1911                         retval |= DM_RET_COPY;
1912
1913
1914                         /*
1915                          * If we've already decided on an action, go ahead
1916                          * and return.
1917                          */
1918                         if ((retval & DM_RET_ACTION_MASK) != DM_RET_NONE)
1919                                 return(retval);
1920                 }
1921
1922                 /*
1923                  * Not sure why someone would do this...
1924                  */
1925                 if (cur_pattern->flags == DEV_MATCH_NONE)
1926                         continue;
1927
1928                 if (((cur_pattern->flags & DEV_MATCH_PATH) != 0)
1929                  && (cur_pattern->path_id != device->target->bus->path_id))
1930                         continue;
1931
1932                 if (((cur_pattern->flags & DEV_MATCH_TARGET) != 0)
1933                  && (cur_pattern->target_id != device->target->target_id))
1934                         continue;
1935
1936                 if (((cur_pattern->flags & DEV_MATCH_LUN) != 0)
1937                  && (cur_pattern->target_lun != device->lun_id))
1938                         continue;
1939
1940                 if (((cur_pattern->flags & DEV_MATCH_INQUIRY) != 0)
1941                  && (cam_quirkmatch((caddr_t)&device->inq_data,
1942                                     (caddr_t)&cur_pattern->inq_pat,
1943                                     1, sizeof(cur_pattern->inq_pat),
1944                                     scsi_static_inquiry_match) == NULL))
1945                         continue;
1946
1947                 /*
1948                  * If we get to this point, the user definitely wants
1949                  * information on this device.  So tell the caller to copy
1950                  * the data out.
1951                  */
1952                 retval |= DM_RET_COPY;
1953
1954                 /*
1955                  * If the return action has been set to descend, then we
1956                  * know that we've already seen a peripheral matching
1957                  * expression, therefore we need to further descend the tree.
1958                  * This won't change by continuing around the loop, so we
1959                  * go ahead and return.  If we haven't seen a peripheral
1960                  * matching expression, we keep going around the loop until
1961                  * we exhaust the matching expressions.  We'll set the stop
1962                  * flag once we fall out of the loop.
1963                  */
1964                 if ((retval & DM_RET_ACTION_MASK) == DM_RET_DESCEND)
1965                         return(retval);
1966         }
1967
1968         /*
1969          * If the return action hasn't been set to descend yet, that means
1970          * we haven't seen any peripheral matching patterns.  So tell the
1971          * caller to stop descending the tree -- the user doesn't want to
1972          * match against lower level tree elements.
1973          */
1974         if ((retval & DM_RET_ACTION_MASK) == DM_RET_NONE)
1975                 retval |= DM_RET_STOP;
1976
1977         return(retval);
1978 }
1979
1980 /*
1981  * Match a single peripheral against any number of match patterns.
1982  */
1983 static dev_match_ret
1984 xptperiphmatch(struct dev_match_pattern *patterns, u_int num_patterns,
1985                struct cam_periph *periph)
1986 {
1987         dev_match_ret retval;
1988         int i;
1989
1990         /*
1991          * If we aren't given something to match against, that's an error.
1992          */
1993         if (periph == NULL)
1994                 return(DM_RET_ERROR);
1995
1996         /*
1997          * If there are no match entries, then this peripheral matches no
1998          * matter what.
1999          */
2000         if ((patterns == NULL) || (num_patterns == 0))
2001                 return(DM_RET_STOP | DM_RET_COPY);
2002
2003         /*
2004          * There aren't any nodes below a peripheral node, so there's no
2005          * reason to descend the tree any further.
2006          */
2007         retval = DM_RET_STOP;
2008
2009         for (i = 0; i < num_patterns; i++) {
2010                 struct periph_match_pattern *cur_pattern;
2011
2012                 /*
2013                  * If the pattern in question isn't for a peripheral, we
2014                  * aren't interested.
2015                  */
2016                 if (patterns[i].type != DEV_MATCH_PERIPH)
2017                         continue;
2018
2019                 cur_pattern = &patterns[i].pattern.periph_pattern;
2020
2021                 /*
2022                  * If they want to match on anything, then we will do so.
2023                  */
2024                 if (cur_pattern->flags == PERIPH_MATCH_ANY) {
2025                         /* set the copy flag */
2026                         retval |= DM_RET_COPY;
2027
2028                         /*
2029                          * We've already set the return action to stop,
2030                          * since there are no nodes below peripherals in
2031                          * the tree.
2032                          */
2033                         return(retval);
2034                 }
2035
2036                 /*
2037                  * Not sure why someone would do this...
2038                  */
2039                 if (cur_pattern->flags == PERIPH_MATCH_NONE)
2040                         continue;
2041
2042                 if (((cur_pattern->flags & PERIPH_MATCH_PATH) != 0)
2043                  && (cur_pattern->path_id != periph->path->bus->path_id))
2044                         continue;
2045
2046                 /*
2047                  * For the target and lun id's, we have to make sure the
2048                  * target and lun pointers aren't NULL.  The xpt peripheral
2049                  * has a wildcard target and device.
2050                  */
2051                 if (((cur_pattern->flags & PERIPH_MATCH_TARGET) != 0)
2052                  && ((periph->path->target == NULL)
2053                  ||(cur_pattern->target_id != periph->path->target->target_id)))
2054                         continue;
2055
2056                 if (((cur_pattern->flags & PERIPH_MATCH_LUN) != 0)
2057                  && ((periph->path->device == NULL)
2058                  || (cur_pattern->target_lun != periph->path->device->lun_id)))
2059                         continue;
2060
2061                 if (((cur_pattern->flags & PERIPH_MATCH_UNIT) != 0)
2062                  && (cur_pattern->unit_number != periph->unit_number))
2063                         continue;
2064
2065                 if (((cur_pattern->flags & PERIPH_MATCH_NAME) != 0)
2066                  && (strncmp(cur_pattern->periph_name, periph->periph_name,
2067                              DEV_IDLEN) != 0))
2068                         continue;
2069
2070                 /*
2071                  * If we get to this point, the user definitely wants
2072                  * information on this peripheral.  So tell the caller to
2073                  * copy the data out.
2074                  */
2075                 retval |= DM_RET_COPY;
2076
2077                 /*
2078                  * The return action has already been set to stop, since
2079                  * peripherals don't have any nodes below them in the EDT.
2080                  */
2081                 return(retval);
2082         }
2083
2084         /*
2085          * If we get to this point, the peripheral that was passed in
2086          * doesn't match any of the patterns.
2087          */
2088         return(retval);
2089 }
2090
2091 static int
2092 xptedtbusfunc(struct cam_eb *bus, void *arg)
2093 {
2094         struct ccb_dev_match *cdm;
2095         dev_match_ret retval;
2096
2097         cdm = (struct ccb_dev_match *)arg;
2098
2099         /*
2100          * If our position is for something deeper in the tree, that means
2101          * that we've already seen this node.  So, we keep going down.
2102          */
2103         if ((cdm->pos.position_type & CAM_DEV_POS_BUS)
2104          && (cdm->pos.cookie.bus == bus)
2105          && (cdm->pos.position_type & CAM_DEV_POS_TARGET)
2106          && (cdm->pos.cookie.target != NULL))
2107                 retval = DM_RET_DESCEND;
2108         else
2109                 retval = xptbusmatch(cdm->patterns, cdm->num_patterns, bus);
2110
2111         /*
2112          * If we got an error, bail out of the search.
2113          */
2114         if ((retval & DM_RET_ACTION_MASK) == DM_RET_ERROR) {
2115                 cdm->status = CAM_DEV_MATCH_ERROR;
2116                 return(0);
2117         }
2118
2119         /*
2120          * If the copy flag is set, copy this bus out.
2121          */
2122         if (retval & DM_RET_COPY) {
2123                 int spaceleft, j;
2124
2125                 spaceleft = cdm->match_buf_len - (cdm->num_matches *
2126                         sizeof(struct dev_match_result));
2127
2128                 /*
2129                  * If we don't have enough space to put in another
2130                  * match result, save our position and tell the
2131                  * user there are more devices to check.
2132                  */
2133                 if (spaceleft < sizeof(struct dev_match_result)) {
2134                         bzero(&cdm->pos, sizeof(cdm->pos));
2135                         cdm->pos.position_type =
2136                                 CAM_DEV_POS_EDT | CAM_DEV_POS_BUS;
2137
2138                         cdm->pos.cookie.bus = bus;
2139                         cdm->pos.generations[CAM_BUS_GENERATION]=
2140                                 xsoftc.bus_generation;
2141                         cdm->status = CAM_DEV_MATCH_MORE;
2142                         return(0);
2143                 }
2144                 j = cdm->num_matches;
2145                 cdm->num_matches++;
2146                 cdm->matches[j].type = DEV_MATCH_BUS;
2147                 cdm->matches[j].result.bus_result.path_id = bus->path_id;
2148                 cdm->matches[j].result.bus_result.bus_id = bus->sim->bus_id;
2149                 cdm->matches[j].result.bus_result.unit_number =
2150                         bus->sim->unit_number;
2151                 strncpy(cdm->matches[j].result.bus_result.dev_name,
2152                         bus->sim->sim_name, DEV_IDLEN);
2153         }
2154
2155         /*
2156          * If the user is only interested in busses, there's no
2157          * reason to descend to the next level in the tree.
2158          */
2159         if ((retval & DM_RET_ACTION_MASK) == DM_RET_STOP)
2160                 return(1);
2161
2162         /*
2163          * If there is a target generation recorded, check it to
2164          * make sure the target list hasn't changed.
2165          */
2166         if ((cdm->pos.position_type & CAM_DEV_POS_BUS)
2167          && (bus == cdm->pos.cookie.bus)
2168          && (cdm->pos.position_type & CAM_DEV_POS_TARGET)
2169          && (cdm->pos.generations[CAM_TARGET_GENERATION] != 0)
2170          && (cdm->pos.generations[CAM_TARGET_GENERATION] !=
2171              bus->generation)) {
2172                 cdm->status = CAM_DEV_MATCH_LIST_CHANGED;
2173                 return(0);
2174         }
2175
2176         if ((cdm->pos.position_type & CAM_DEV_POS_BUS)
2177          && (cdm->pos.cookie.bus == bus)
2178          && (cdm->pos.position_type & CAM_DEV_POS_TARGET)
2179          && (cdm->pos.cookie.target != NULL))
2180                 return(xpttargettraverse(bus,
2181                                         (struct cam_et *)cdm->pos.cookie.target,
2182                                          xptedttargetfunc, arg));
2183         else
2184                 return(xpttargettraverse(bus, NULL, xptedttargetfunc, arg));
2185 }
2186
2187 static int
2188 xptedttargetfunc(struct cam_et *target, void *arg)
2189 {
2190         struct ccb_dev_match *cdm;
2191
2192         cdm = (struct ccb_dev_match *)arg;
2193
2194         /*
2195          * If there is a device list generation recorded, check it to
2196          * make sure the device list hasn't changed.
2197          */
2198         if ((cdm->pos.position_type & CAM_DEV_POS_BUS)
2199          && (cdm->pos.cookie.bus == target->bus)
2200          && (cdm->pos.position_type & CAM_DEV_POS_TARGET)
2201          && (cdm->pos.cookie.target == target)
2202          && (cdm->pos.position_type & CAM_DEV_POS_DEVICE)
2203          && (cdm->pos.generations[CAM_DEV_GENERATION] != 0)
2204          && (cdm->pos.generations[CAM_DEV_GENERATION] !=
2205              target->generation)) {
2206                 cdm->status = CAM_DEV_MATCH_LIST_CHANGED;
2207                 return(0);
2208         }
2209
2210         if ((cdm->pos.position_type & CAM_DEV_POS_BUS)
2211          && (cdm->pos.cookie.bus == target->bus)
2212          && (cdm->pos.position_type & CAM_DEV_POS_TARGET)
2213          && (cdm->pos.cookie.target == target)
2214          && (cdm->pos.position_type & CAM_DEV_POS_DEVICE)
2215          && (cdm->pos.cookie.device != NULL))
2216                 return(xptdevicetraverse(target,
2217                                         (struct cam_ed *)cdm->pos.cookie.device,
2218                                          xptedtdevicefunc, arg));
2219         else
2220                 return(xptdevicetraverse(target, NULL, xptedtdevicefunc, arg));
2221 }
2222
2223 static int
2224 xptedtdevicefunc(struct cam_ed *device, void *arg)
2225 {
2226
2227         struct ccb_dev_match *cdm;
2228         dev_match_ret retval;
2229
2230         cdm = (struct ccb_dev_match *)arg;
2231
2232         /*
2233          * If our position is for something deeper in the tree, that means
2234          * that we've already seen this node.  So, we keep going down.
2235          */
2236         if ((cdm->pos.position_type & CAM_DEV_POS_DEVICE)
2237          && (cdm->pos.cookie.device == device)
2238          && (cdm->pos.position_type & CAM_DEV_POS_PERIPH)
2239          && (cdm->pos.cookie.periph != NULL))
2240                 retval = DM_RET_DESCEND;
2241         else
2242                 retval = xptdevicematch(cdm->patterns, cdm->num_patterns,
2243                                         device);
2244
2245         if ((retval & DM_RET_ACTION_MASK) == DM_RET_ERROR) {
2246                 cdm->status = CAM_DEV_MATCH_ERROR;
2247                 return(0);
2248         }
2249
2250         /*
2251          * If the copy flag is set, copy this device out.
2252          */
2253         if (retval & DM_RET_COPY) {
2254                 int spaceleft, j;
2255
2256                 spaceleft = cdm->match_buf_len - (cdm->num_matches *
2257                         sizeof(struct dev_match_result));
2258
2259                 /*
2260                  * If we don't have enough space to put in another
2261                  * match result, save our position and tell the
2262                  * user there are more devices to check.
2263                  */
2264                 if (spaceleft < sizeof(struct dev_match_result)) {
2265                         bzero(&cdm->pos, sizeof(cdm->pos));
2266                         cdm->pos.position_type =
2267                                 CAM_DEV_POS_EDT | CAM_DEV_POS_BUS |
2268                                 CAM_DEV_POS_TARGET | CAM_DEV_POS_DEVICE;
2269
2270                         cdm->pos.cookie.bus = device->target->bus;
2271                         cdm->pos.generations[CAM_BUS_GENERATION]=
2272                                 xsoftc.bus_generation;
2273                         cdm->pos.cookie.target = device->target;
2274                         cdm->pos.generations[CAM_TARGET_GENERATION] =
2275                                 device->target->bus->generation;
2276                         cdm->pos.cookie.device = device;
2277                         cdm->pos.generations[CAM_DEV_GENERATION] =
2278                                 device->target->generation;
2279                         cdm->status = CAM_DEV_MATCH_MORE;
2280                         return(0);
2281                 }
2282                 j = cdm->num_matches;
2283                 cdm->num_matches++;
2284                 cdm->matches[j].type = DEV_MATCH_DEVICE;
2285                 cdm->matches[j].result.device_result.path_id =
2286                         device->target->bus->path_id;
2287                 cdm->matches[j].result.device_result.target_id =
2288                         device->target->target_id;
2289                 cdm->matches[j].result.device_result.target_lun =
2290                         device->lun_id;
2291                 bcopy(&device->inq_data,
2292                       &cdm->matches[j].result.device_result.inq_data,
2293                       sizeof(struct scsi_inquiry_data));
2294
2295                 /* Let the user know whether this device is unconfigured */
2296                 if (device->flags & CAM_DEV_UNCONFIGURED)
2297                         cdm->matches[j].result.device_result.flags =
2298                                 DEV_RESULT_UNCONFIGURED;
2299                 else
2300                         cdm->matches[j].result.device_result.flags =
2301                                 DEV_RESULT_NOFLAG;
2302         }
2303
2304         /*
2305          * If the user isn't interested in peripherals, don't descend
2306          * the tree any further.
2307          */
2308         if ((retval & DM_RET_ACTION_MASK) == DM_RET_STOP)
2309                 return(1);
2310
2311         /*
2312          * If there is a peripheral list generation recorded, make sure
2313          * it hasn't changed.
2314          */
2315         if ((cdm->pos.position_type & CAM_DEV_POS_BUS)
2316          && (device->target->bus == cdm->pos.cookie.bus)
2317          && (cdm->pos.position_type & CAM_DEV_POS_TARGET)
2318          && (device->target == cdm->pos.cookie.target)
2319          && (cdm->pos.position_type & CAM_DEV_POS_DEVICE)
2320          && (device == cdm->pos.cookie.device)
2321          && (cdm->pos.position_type & CAM_DEV_POS_PERIPH)
2322          && (cdm->pos.generations[CAM_PERIPH_GENERATION] != 0)
2323          && (cdm->pos.generations[CAM_PERIPH_GENERATION] !=
2324              device->generation)){
2325                 cdm->status = CAM_DEV_MATCH_LIST_CHANGED;
2326                 return(0);
2327         }
2328
2329         if ((cdm->pos.position_type & CAM_DEV_POS_BUS)
2330          && (cdm->pos.cookie.bus == device->target->bus)
2331          && (cdm->pos.position_type & CAM_DEV_POS_TARGET)
2332          && (cdm->pos.cookie.target == device->target)
2333          && (cdm->pos.position_type & CAM_DEV_POS_DEVICE)
2334          && (cdm->pos.cookie.device == device)
2335          && (cdm->pos.position_type & CAM_DEV_POS_PERIPH)
2336          && (cdm->pos.cookie.periph != NULL))
2337                 return(xptperiphtraverse(device,
2338                                 (struct cam_periph *)cdm->pos.cookie.periph,
2339                                 xptedtperiphfunc, arg));
2340         else
2341                 return(xptperiphtraverse(device, NULL, xptedtperiphfunc, arg));
2342 }
2343
2344 static int
2345 xptedtperiphfunc(struct cam_periph *periph, void *arg)
2346 {
2347         struct ccb_dev_match *cdm;
2348         dev_match_ret retval;
2349
2350         cdm = (struct ccb_dev_match *)arg;
2351
2352         retval = xptperiphmatch(cdm->patterns, cdm->num_patterns, periph);
2353
2354         if ((retval & DM_RET_ACTION_MASK) == DM_RET_ERROR) {
2355                 cdm->status = CAM_DEV_MATCH_ERROR;
2356                 return(0);
2357         }
2358
2359         /*
2360          * If the copy flag is set, copy this peripheral out.
2361          */
2362         if (retval & DM_RET_COPY) {
2363                 int spaceleft, j;
2364
2365                 spaceleft = cdm->match_buf_len - (cdm->num_matches *
2366                         sizeof(struct dev_match_result));
2367
2368                 /*
2369                  * If we don't have enough space to put in another
2370                  * match result, save our position and tell the
2371                  * user there are more devices to check.
2372                  */
2373                 if (spaceleft < sizeof(struct dev_match_result)) {
2374                         bzero(&cdm->pos, sizeof(cdm->pos));
2375                         cdm->pos.position_type =
2376                                 CAM_DEV_POS_EDT | CAM_DEV_POS_BUS |
2377                                 CAM_DEV_POS_TARGET | CAM_DEV_POS_DEVICE |
2378                                 CAM_DEV_POS_PERIPH;
2379
2380                         cdm->pos.cookie.bus = periph->path->bus;
2381                         cdm->pos.generations[CAM_BUS_GENERATION]=
2382                                 xsoftc.bus_generation;
2383                         cdm->pos.cookie.target = periph->path->target;
2384                         cdm->pos.generations[CAM_TARGET_GENERATION] =
2385                                 periph->path->bus->generation;
2386                         cdm->pos.cookie.device = periph->path->device;
2387                         cdm->pos.generations[CAM_DEV_GENERATION] =
2388                                 periph->path->target->generation;
2389                         cdm->pos.cookie.periph = periph;
2390                         cdm->pos.generations[CAM_PERIPH_GENERATION] =
2391                                 periph->path->device->generation;
2392                         cdm->status = CAM_DEV_MATCH_MORE;
2393                         return(0);
2394                 }
2395
2396                 j = cdm->num_matches;
2397                 cdm->num_matches++;
2398                 cdm->matches[j].type = DEV_MATCH_PERIPH;
2399                 cdm->matches[j].result.periph_result.path_id =
2400                         periph->path->bus->path_id;
2401                 cdm->matches[j].result.periph_result.target_id =
2402                         periph->path->target->target_id;
2403                 cdm->matches[j].result.periph_result.target_lun =
2404                         periph->path->device->lun_id;
2405                 cdm->matches[j].result.periph_result.unit_number =
2406                         periph->unit_number;
2407                 strncpy(cdm->matches[j].result.periph_result.periph_name,
2408                         periph->periph_name, DEV_IDLEN);
2409         }
2410
2411         return(1);
2412 }
2413
2414 static int
2415 xptedtmatch(struct ccb_dev_match *cdm)
2416 {
2417         int ret;
2418
2419         cdm->num_matches = 0;
2420
2421         /*
2422          * Check the bus list generation.  If it has changed, the user
2423          * needs to reset everything and start over.
2424          */
2425         if ((cdm->pos.position_type & CAM_DEV_POS_BUS)
2426          && (cdm->pos.generations[CAM_BUS_GENERATION] != 0)
2427          && (cdm->pos.generations[CAM_BUS_GENERATION] != xsoftc.bus_generation)) {
2428                 cdm->status = CAM_DEV_MATCH_LIST_CHANGED;
2429                 return(0);
2430         }
2431
2432         if ((cdm->pos.position_type & CAM_DEV_POS_BUS)
2433          && (cdm->pos.cookie.bus != NULL))
2434                 ret = xptbustraverse((struct cam_eb *)cdm->pos.cookie.bus,
2435                                      xptedtbusfunc, cdm);
2436         else
2437                 ret = xptbustraverse(NULL, xptedtbusfunc, cdm);
2438
2439         /*
2440          * If we get back 0, that means that we had to stop before fully
2441          * traversing the EDT.  It also means that one of the subroutines
2442          * has set the status field to the proper value.  If we get back 1,
2443          * we've fully traversed the EDT and copied out any matching entries.
2444          */
2445         if (ret == 1)
2446                 cdm->status = CAM_DEV_MATCH_LAST;
2447
2448         return(ret);
2449 }
2450
2451 static int
2452 xptplistpdrvfunc(struct periph_driver **pdrv, void *arg)
2453 {
2454         struct ccb_dev_match *cdm;
2455
2456         cdm = (struct ccb_dev_match *)arg;
2457
2458         if ((cdm->pos.position_type & CAM_DEV_POS_PDPTR)
2459          && (cdm->pos.cookie.pdrv == pdrv)
2460          && (cdm->pos.position_type & CAM_DEV_POS_PERIPH)
2461          && (cdm->pos.generations[CAM_PERIPH_GENERATION] != 0)
2462          && (cdm->pos.generations[CAM_PERIPH_GENERATION] !=
2463              (*pdrv)->generation)) {
2464                 cdm->status = CAM_DEV_MATCH_LIST_CHANGED;
2465                 return(0);
2466         }
2467
2468         if ((cdm->pos.position_type & CAM_DEV_POS_PDPTR)
2469          && (cdm->pos.cookie.pdrv == pdrv)
2470          && (cdm->pos.position_type & CAM_DEV_POS_PERIPH)
2471          && (cdm->pos.cookie.periph != NULL))
2472                 return(xptpdperiphtraverse(pdrv,
2473                                 (struct cam_periph *)cdm->pos.cookie.periph,
2474                                 xptplistperiphfunc, arg));
2475         else
2476                 return(xptpdperiphtraverse(pdrv, NULL,xptplistperiphfunc, arg));
2477 }
2478
2479 static int
2480 xptplistperiphfunc(struct cam_periph *periph, void *arg)
2481 {
2482         struct ccb_dev_match *cdm;
2483         dev_match_ret retval;
2484
2485         cdm = (struct ccb_dev_match *)arg;
2486
2487         retval = xptperiphmatch(cdm->patterns, cdm->num_patterns, periph);
2488
2489         if ((retval & DM_RET_ACTION_MASK) == DM_RET_ERROR) {
2490                 cdm->status = CAM_DEV_MATCH_ERROR;
2491                 return(0);
2492         }
2493
2494         /*
2495          * If the copy flag is set, copy this peripheral out.
2496          */
2497         if (retval & DM_RET_COPY) {
2498                 int spaceleft, j;
2499
2500                 spaceleft = cdm->match_buf_len - (cdm->num_matches *
2501                         sizeof(struct dev_match_result));
2502
2503                 /*
2504                  * If we don't have enough space to put in another
2505                  * match result, save our position and tell the
2506                  * user there are more devices to check.
2507                  */
2508                 if (spaceleft < sizeof(struct dev_match_result)) {
2509                         struct periph_driver **pdrv;
2510
2511                         pdrv = NULL;
2512                         bzero(&cdm->pos, sizeof(cdm->pos));
2513                         cdm->pos.position_type =
2514                                 CAM_DEV_POS_PDRV | CAM_DEV_POS_PDPTR |
2515                                 CAM_DEV_POS_PERIPH;
2516
2517                         /*
2518                          * This may look a bit non-sensical, but it is
2519                          * actually quite logical.  There are very few
2520                          * peripheral drivers, and bloating every peripheral
2521                          * structure with a pointer back to its parent
2522                          * peripheral driver linker set entry would cost
2523                          * more in the long run than doing this quick lookup.
2524                          */
2525                         for (pdrv = periph_drivers; *pdrv != NULL; pdrv++) {
2526                                 if (strcmp((*pdrv)->driver_name,
2527                                     periph->periph_name) == 0)
2528                                         break;
2529                         }
2530
2531                         if (*pdrv == NULL) {
2532                                 cdm->status = CAM_DEV_MATCH_ERROR;
2533                                 return(0);
2534                         }
2535
2536                         cdm->pos.cookie.pdrv = pdrv;
2537                         /*
2538                          * The periph generation slot does double duty, as
2539                          * does the periph pointer slot.  They are used for
2540                          * both edt and pdrv lookups and positioning.
2541                          */
2542                         cdm->pos.cookie.periph = periph;
2543                         cdm->pos.generations[CAM_PERIPH_GENERATION] =
2544                                 (*pdrv)->generation;
2545                         cdm->status = CAM_DEV_MATCH_MORE;
2546                         return(0);
2547                 }
2548
2549                 j = cdm->num_matches;
2550                 cdm->num_matches++;
2551                 cdm->matches[j].type = DEV_MATCH_PERIPH;
2552                 cdm->matches[j].result.periph_result.path_id =
2553                         periph->path->bus->path_id;
2554
2555                 /*
2556                  * The transport layer peripheral doesn't have a target or
2557                  * lun.
2558                  */
2559                 if (periph->path->target)
2560                         cdm->matches[j].result.periph_result.target_id =
2561                                 periph->path->target->target_id;
2562                 else
2563                         cdm->matches[j].result.periph_result.target_id = -1;
2564
2565                 if (periph->path->device)
2566                         cdm->matches[j].result.periph_result.target_lun =
2567                                 periph->path->device->lun_id;
2568                 else
2569                         cdm->matches[j].result.periph_result.target_lun = -1;
2570
2571                 cdm->matches[j].result.periph_result.unit_number =
2572                         periph->unit_number;
2573                 strncpy(cdm->matches[j].result.periph_result.periph_name,
2574                         periph->periph_name, DEV_IDLEN);
2575         }
2576
2577         return(1);
2578 }
2579
2580 static int
2581 xptperiphlistmatch(struct ccb_dev_match *cdm)
2582 {
2583         int ret;
2584
2585         cdm->num_matches = 0;
2586
2587         /*
2588          * At this point in the edt traversal function, we check the bus
2589          * list generation to make sure that no busses have been added or
2590          * removed since the user last sent a XPT_DEV_MATCH ccb through.
2591          * For the peripheral driver list traversal function, however, we
2592          * don't have to worry about new peripheral driver types coming or
2593          * going; they're in a linker set, and therefore can't change
2594          * without a recompile.
2595          */
2596
2597         if ((cdm->pos.position_type & CAM_DEV_POS_PDPTR)
2598          && (cdm->pos.cookie.pdrv != NULL))
2599                 ret = xptpdrvtraverse(
2600                                 (struct periph_driver **)cdm->pos.cookie.pdrv,
2601                                 xptplistpdrvfunc, cdm);
2602         else
2603                 ret = xptpdrvtraverse(NULL, xptplistpdrvfunc, cdm);
2604
2605         /*
2606          * If we get back 0, that means that we had to stop before fully
2607          * traversing the peripheral driver tree.  It also means that one of
2608          * the subroutines has set the status field to the proper value.  If
2609          * we get back 1, we've fully traversed the EDT and copied out any
2610          * matching entries.
2611          */
2612         if (ret == 1)
2613                 cdm->status = CAM_DEV_MATCH_LAST;
2614
2615         return(ret);
2616 }
2617
2618 static int
2619 xptbustraverse(struct cam_eb *start_bus, xpt_busfunc_t *tr_func, void *arg)
2620 {
2621         struct cam_eb *bus, *next_bus;
2622         int retval;
2623
2624         retval = 1;
2625
2626         mtx_lock(&xsoftc.xpt_topo_lock);
2627         for (bus = (start_bus ? start_bus : TAILQ_FIRST(&xsoftc.xpt_busses));
2628              bus != NULL;
2629              bus = next_bus) {
2630                 next_bus = TAILQ_NEXT(bus, links);
2631
2632                 mtx_unlock(&xsoftc.xpt_topo_lock);
2633                 CAM_SIM_LOCK(bus->sim);
2634                 retval = tr_func(bus, arg);
2635                 CAM_SIM_UNLOCK(bus->sim);
2636                 if (retval == 0)
2637                         return(retval);
2638                 mtx_lock(&xsoftc.xpt_topo_lock);
2639         }
2640         mtx_unlock(&xsoftc.xpt_topo_lock);
2641
2642         return(retval);
2643 }
2644
2645 int
2646 xpt_sim_opened(struct cam_sim *sim)
2647 {
2648         struct cam_eb *bus;
2649         struct cam_et *target;
2650         struct cam_ed *device;
2651         struct cam_periph *periph;
2652
2653         KASSERT(sim->refcount >= 1, ("sim->refcount >= 1"));
2654         mtx_assert(sim->mtx, MA_OWNED);
2655
2656         mtx_lock(&xsoftc.xpt_topo_lock);
2657         TAILQ_FOREACH(bus, &xsoftc.xpt_busses, links) {
2658                 if (bus->sim != sim)
2659                         continue;
2660
2661                 TAILQ_FOREACH(target, &bus->et_entries, links) {
2662                         TAILQ_FOREACH(device, &target->ed_entries, links) {
2663                                 SLIST_FOREACH(periph, &device->periphs,
2664                                     periph_links) {
2665                                         if (periph->refcount > 0) {
2666                                                 mtx_unlock(&xsoftc.xpt_topo_lock);
2667                                                 return (1);
2668                                         }
2669                                 }
2670                         }
2671                 }
2672         }
2673
2674         mtx_unlock(&xsoftc.xpt_topo_lock);
2675         return (0);
2676 }
2677
2678 static int
2679 xpttargettraverse(struct cam_eb *bus, struct cam_et *start_target,
2680                   xpt_targetfunc_t *tr_func, void *arg)
2681 {
2682         struct cam_et *target, *next_target;
2683         int retval;
2684
2685         retval = 1;
2686         for (target = (start_target ? start_target :
2687                        TAILQ_FIRST(&bus->et_entries));
2688              target != NULL; target = next_target) {
2689
2690                 next_target = TAILQ_NEXT(target, links);
2691
2692                 retval = tr_func(target, arg);
2693
2694                 if (retval == 0)
2695                         return(retval);
2696         }
2697
2698         return(retval);
2699 }
2700
2701 static int
2702 xptdevicetraverse(struct cam_et *target, struct cam_ed *start_device,
2703                   xpt_devicefunc_t *tr_func, void *arg)
2704 {
2705         struct cam_ed *device, *next_device;
2706         int retval;
2707
2708         retval = 1;
2709         for (device = (start_device ? start_device :
2710                        TAILQ_FIRST(&target->ed_entries));
2711              device != NULL;
2712              device = next_device) {
2713
2714                 next_device = TAILQ_NEXT(device, links);
2715
2716                 retval = tr_func(device, arg);
2717
2718                 if (retval == 0)
2719                         return(retval);
2720         }
2721
2722         return(retval);
2723 }
2724
2725 static int
2726 xptperiphtraverse(struct cam_ed *device, struct cam_periph *start_periph,
2727                   xpt_periphfunc_t *tr_func, void *arg)
2728 {
2729         struct cam_periph *periph, *next_periph;
2730         int retval;
2731
2732         retval = 1;
2733
2734         for (periph = (start_periph ? start_periph :
2735                        SLIST_FIRST(&device->periphs));
2736              periph != NULL;
2737              periph = next_periph) {
2738
2739                 next_periph = SLIST_NEXT(periph, periph_links);
2740
2741                 retval = tr_func(periph, arg);
2742                 if (retval == 0)
2743                         return(retval);
2744         }
2745
2746         return(retval);
2747 }
2748
2749 static int
2750 xptpdrvtraverse(struct periph_driver **start_pdrv,
2751                 xpt_pdrvfunc_t *tr_func, void *arg)
2752 {
2753         struct periph_driver **pdrv;
2754         int retval;
2755
2756         retval = 1;
2757
2758         /*
2759          * We don't traverse the peripheral driver list like we do the
2760          * other lists, because it is a linker set, and therefore cannot be
2761          * changed during runtime.  If the peripheral driver list is ever
2762          * re-done to be something other than a linker set (i.e. it can
2763          * change while the system is running), the list traversal should
2764          * be modified to work like the other traversal functions.
2765          */
2766         for (pdrv = (start_pdrv ? start_pdrv : periph_drivers);
2767              *pdrv != NULL; pdrv++) {
2768                 retval = tr_func(pdrv, arg);
2769
2770                 if (retval == 0)
2771                         return(retval);
2772         }
2773
2774         return(retval);
2775 }
2776
2777 static int
2778 xptpdperiphtraverse(struct periph_driver **pdrv,
2779                     struct cam_periph *start_periph,
2780                     xpt_periphfunc_t *tr_func, void *arg)
2781 {
2782         struct cam_periph *periph, *next_periph;
2783         int retval;
2784
2785         retval = 1;
2786
2787         for (periph = (start_periph ? start_periph :
2788              TAILQ_FIRST(&(*pdrv)->units)); periph != NULL;
2789              periph = next_periph) {
2790
2791                 next_periph = TAILQ_NEXT(periph, unit_links);
2792
2793                 retval = tr_func(periph, arg);
2794                 if (retval == 0)
2795                         return(retval);
2796         }
2797         return(retval);
2798 }
2799
2800 static int
2801 xptdefbusfunc(struct cam_eb *bus, void *arg)
2802 {
2803         struct xpt_traverse_config *tr_config;
2804
2805         tr_config = (struct xpt_traverse_config *)arg;
2806
2807         if (tr_config->depth == XPT_DEPTH_BUS) {
2808                 xpt_busfunc_t *tr_func;
2809
2810                 tr_func = (xpt_busfunc_t *)tr_config->tr_func;
2811
2812                 return(tr_func(bus, tr_config->tr_arg));
2813         } else
2814                 return(xpttargettraverse(bus, NULL, xptdeftargetfunc, arg));
2815 }
2816
2817 static int
2818 xptdeftargetfunc(struct cam_et *target, void *arg)
2819 {
2820         struct xpt_traverse_config *tr_config;
2821
2822         tr_config = (struct xpt_traverse_config *)arg;
2823
2824         if (tr_config->depth == XPT_DEPTH_TARGET) {
2825                 xpt_targetfunc_t *tr_func;
2826
2827                 tr_func = (xpt_targetfunc_t *)tr_config->tr_func;
2828
2829                 return(tr_func(target, tr_config->tr_arg));
2830         } else
2831                 return(xptdevicetraverse(target, NULL, xptdefdevicefunc, arg));
2832 }
2833
2834 static int
2835 xptdefdevicefunc(struct cam_ed *device, void *arg)
2836 {
2837         struct xpt_traverse_config *tr_config;
2838
2839         tr_config = (struct xpt_traverse_config *)arg;
2840
2841         if (tr_config->depth == XPT_DEPTH_DEVICE) {
2842                 xpt_devicefunc_t *tr_func;
2843
2844                 tr_func = (xpt_devicefunc_t *)tr_config->tr_func;
2845
2846                 return(tr_func(device, tr_config->tr_arg));
2847         } else
2848                 return(xptperiphtraverse(device, NULL, xptdefperiphfunc, arg));
2849 }
2850
2851 static int
2852 xptdefperiphfunc(struct cam_periph *periph, void *arg)
2853 {
2854         struct xpt_traverse_config *tr_config;
2855         xpt_periphfunc_t *tr_func;
2856
2857         tr_config = (struct xpt_traverse_config *)arg;
2858
2859         tr_func = (xpt_periphfunc_t *)tr_config->tr_func;
2860
2861         /*
2862          * Unlike the other default functions, we don't check for depth
2863          * here.  The peripheral driver level is the last level in the EDT,
2864          * so if we're here, we should execute the function in question.
2865          */
2866         return(tr_func(periph, tr_config->tr_arg));
2867 }
2868
2869 /*
2870  * Execute the given function for every bus in the EDT.
2871  */
2872 static int
2873 xpt_for_all_busses(xpt_busfunc_t *tr_func, void *arg)
2874 {
2875         struct xpt_traverse_config tr_config;
2876
2877         tr_config.depth = XPT_DEPTH_BUS;
2878         tr_config.tr_func = tr_func;
2879         tr_config.tr_arg = arg;
2880
2881         return(xptbustraverse(NULL, xptdefbusfunc, &tr_config));
2882 }
2883
2884 /*
2885  * Execute the given function for every device in the EDT.
2886  */
2887 static int
2888 xpt_for_all_devices(xpt_devicefunc_t *tr_func, void *arg)
2889 {
2890         struct xpt_traverse_config tr_config;
2891
2892         tr_config.depth = XPT_DEPTH_DEVICE;
2893         tr_config.tr_func = tr_func;
2894         tr_config.tr_arg = arg;
2895
2896         return(xptbustraverse(NULL, xptdefbusfunc, &tr_config));
2897 }
2898
2899 static int
2900 xptsetasyncfunc(struct cam_ed *device, void *arg)
2901 {
2902         struct cam_path path;
2903         struct ccb_getdev cgd;
2904         struct async_node *cur_entry;
2905
2906         cur_entry = (struct async_node *)arg;
2907
2908         /*
2909          * Don't report unconfigured devices (Wildcard devs,
2910          * devices only for target mode, device instances
2911          * that have been invalidated but are waiting for
2912          * their last reference count to be released).
2913          */
2914         if ((device->flags & CAM_DEV_UNCONFIGURED) != 0)
2915                 return (1);
2916
2917         xpt_compile_path(&path,
2918                          NULL,
2919                          device->target->bus->path_id,
2920                          device->target->target_id,
2921                          device->lun_id);
2922         xpt_setup_ccb(&cgd.ccb_h, &path, /*priority*/1);
2923         cgd.ccb_h.func_code = XPT_GDEV_TYPE;
2924         xpt_action((union ccb *)&cgd);
2925         cur_entry->callback(cur_entry->callback_arg,
2926                             AC_FOUND_DEVICE,
2927                             &path, &cgd);
2928         xpt_release_path(&path);
2929
2930         return(1);
2931 }
2932
2933 static int
2934 xptsetasyncbusfunc(struct cam_eb *bus, void *arg)
2935 {
2936         struct cam_path path;
2937         struct ccb_pathinq cpi;
2938         struct async_node *cur_entry;
2939
2940         cur_entry = (struct async_node *)arg;
2941
2942         xpt_compile_path(&path, /*periph*/NULL,
2943                          bus->sim->path_id,
2944                          CAM_TARGET_WILDCARD,
2945                          CAM_LUN_WILDCARD);
2946         xpt_setup_ccb(&cpi.ccb_h, &path, /*priority*/1);
2947         cpi.ccb_h.func_code = XPT_PATH_INQ;
2948         xpt_action((union ccb *)&cpi);
2949         cur_entry->callback(cur_entry->callback_arg,
2950                             AC_PATH_REGISTERED,
2951                             &path, &cpi);
2952         xpt_release_path(&path);
2953
2954         return(1);
2955 }
2956
2957 static void
2958 xpt_action_sasync_cb(void *context, int pending)
2959 {
2960         struct async_node *cur_entry;
2961         struct xpt_task *task;
2962         uint32_t added;
2963
2964         task = (struct xpt_task *)context;
2965         cur_entry = (struct async_node *)task->data1;
2966         added = task->data2;
2967
2968         if ((added & AC_FOUND_DEVICE) != 0) {
2969                 /*
2970                  * Get this peripheral up to date with all
2971                  * the currently existing devices.
2972                  */
2973                 xpt_for_all_devices(xptsetasyncfunc, cur_entry);
2974         }
2975         if ((added & AC_PATH_REGISTERED) != 0) {
2976                 /*
2977                  * Get this peripheral up to date with all
2978                  * the currently existing busses.
2979                  */
2980                 xpt_for_all_busses(xptsetasyncbusfunc, cur_entry);
2981         }
2982
2983         free(task, M_CAMXPT);
2984 }
2985
2986 void
2987 xpt_action(union ccb *start_ccb)
2988 {
2989
2990         CAM_DEBUG(start_ccb->ccb_h.path, CAM_DEBUG_TRACE, ("xpt_action\n"));
2991
2992         start_ccb->ccb_h.status = CAM_REQ_INPROG;
2993
2994         switch (start_ccb->ccb_h.func_code) {
2995         case XPT_SCSI_IO:
2996         {
2997                 struct cam_ed *device;
2998 #ifdef CAMDEBUG
2999                 char cdb_str[(SCSI_MAX_CDBLEN * 3) + 1];
3000                 struct cam_path *path;
3001
3002                 path = start_ccb->ccb_h.path;
3003 #endif
3004
3005                 /*
3006                  * For the sake of compatibility with SCSI-1
3007                  * devices that may not understand the identify
3008                  * message, we include lun information in the
3009                  * second byte of all commands.  SCSI-1 specifies
3010                  * that luns are a 3 bit value and reserves only 3
3011                  * bits for lun information in the CDB.  Later
3012                  * revisions of the SCSI spec allow for more than 8
3013                  * luns, but have deprecated lun information in the
3014                  * CDB.  So, if the lun won't fit, we must omit.
3015                  *
3016                  * Also be aware that during initial probing for devices,
3017                  * the inquiry information is unknown but initialized to 0.
3018                  * This means that this code will be exercised while probing
3019                  * devices with an ANSI revision greater than 2.
3020                  */
3021                 device = start_ccb->ccb_h.path->device;
3022                 if (device->protocol_version <= SCSI_REV_2
3023                  && start_ccb->ccb_h.target_lun < 8
3024                  && (start_ccb->ccb_h.flags & CAM_CDB_POINTER) == 0) {
3025
3026                         start_ccb->csio.cdb_io.cdb_bytes[1] |=
3027                             start_ccb->ccb_h.target_lun << 5;
3028                 }
3029                 start_ccb->csio.scsi_status = SCSI_STATUS_OK;
3030                 CAM_DEBUG(path, CAM_DEBUG_CDB,("%s. CDB: %s\n",
3031                           scsi_op_desc(start_ccb->csio.cdb_io.cdb_bytes[0],
3032                                        &path->device->inq_data),
3033                           scsi_cdb_string(start_ccb->csio.cdb_io.cdb_bytes,
3034                                           cdb_str, sizeof(cdb_str))));
3035         }
3036         /* FALLTHROUGH */
3037         case XPT_TARGET_IO:
3038         case XPT_CONT_TARGET_IO:
3039                 start_ccb->csio.sense_resid = 0;
3040                 start_ccb->csio.resid = 0;
3041                 /* FALLTHROUGH */
3042         case XPT_RESET_DEV:
3043         case XPT_ENG_EXEC:
3044         {
3045                 struct cam_path *path;
3046                 int runq;
3047
3048                 path = start_ccb->ccb_h.path;
3049
3050                 cam_ccbq_insert_ccb(&path->device->ccbq, start_ccb);
3051                 if (path->device->qfrozen_cnt == 0)
3052                         runq = xpt_schedule_dev_sendq(path->bus, path->device);
3053                 else
3054                         runq = 0;
3055                 if (runq != 0)
3056                         xpt_run_dev_sendq(path->bus);
3057                 break;
3058         }
3059         case XPT_SET_TRAN_SETTINGS:
3060         {
3061                 xpt_set_transfer_settings(&start_ccb->cts,
3062                                           start_ccb->ccb_h.path->device,
3063                                           /*async_update*/FALSE);
3064                 break;
3065         }
3066         case XPT_CALC_GEOMETRY:
3067         {
3068                 struct cam_sim *sim;
3069
3070                 /* Filter out garbage */
3071                 if (start_ccb->ccg.block_size == 0
3072                  || start_ccb->ccg.volume_size == 0) {
3073                         start_ccb->ccg.cylinders = 0;
3074                         start_ccb->ccg.heads = 0;
3075                         start_ccb->ccg.secs_per_track = 0;
3076                         start_ccb->ccb_h.status = CAM_REQ_CMP;
3077                         break;
3078                 }
3079 #ifdef PC98
3080                 /*
3081                  * In a PC-98 system, geometry translation depens on
3082                  * the "real" device geometry obtained from mode page 4.
3083                  * SCSI geometry translation is performed in the
3084                  * initialization routine of the SCSI BIOS and the result
3085                  * stored in host memory.  If the translation is available
3086                  * in host memory, use it.  If not, rely on the default
3087                  * translation the device driver performs.
3088                  */
3089                 if (scsi_da_bios_params(&start_ccb->ccg) != 0) {
3090                         start_ccb->ccb_h.status = CAM_REQ_CMP;
3091                         break;
3092                 }
3093 #endif
3094                 sim = start_ccb->ccb_h.path->bus->sim;
3095                 (*(sim->sim_action))(sim, start_ccb);
3096                 break;
3097         }
3098         case XPT_ABORT:
3099         {
3100                 union ccb* abort_ccb;
3101
3102                 abort_ccb = start_ccb->cab.abort_ccb;
3103                 if (XPT_FC_IS_DEV_QUEUED(abort_ccb)) {
3104
3105                         if (abort_ccb->ccb_h.pinfo.index >= 0) {
3106                                 struct cam_ccbq *ccbq;
3107
3108                                 ccbq = &abort_ccb->ccb_h.path->device->ccbq;
3109                                 cam_ccbq_remove_ccb(ccbq, abort_ccb);
3110                                 abort_ccb->ccb_h.status =
3111                                     CAM_REQ_ABORTED|CAM_DEV_QFRZN;
3112                                 xpt_freeze_devq(abort_ccb->ccb_h.path, 1);
3113                                 xpt_done(abort_ccb);
3114                                 start_ccb->ccb_h.status = CAM_REQ_CMP;
3115                                 break;
3116                         }
3117                         if (abort_ccb->ccb_h.pinfo.index == CAM_UNQUEUED_INDEX
3118                          && (abort_ccb->ccb_h.status & CAM_SIM_QUEUED) == 0) {
3119                                 /*
3120                                  * We've caught this ccb en route to
3121                                  * the SIM.  Flag it for abort and the
3122                                  * SIM will do so just before starting
3123                                  * real work on the CCB.
3124                                  */
3125                                 abort_ccb->ccb_h.status =
3126                                     CAM_REQ_ABORTED|CAM_DEV_QFRZN;
3127                                 xpt_freeze_devq(abort_ccb->ccb_h.path, 1);
3128                                 start_ccb->ccb_h.status = CAM_REQ_CMP;
3129                                 break;
3130                         }
3131                 }
3132                 if (XPT_FC_IS_QUEUED(abort_ccb)
3133                  && (abort_ccb->ccb_h.pinfo.index == CAM_DONEQ_INDEX)) {
3134                         /*
3135                          * It's already completed but waiting
3136                          * for our SWI to get to it.
3137                          */
3138                         start_ccb->ccb_h.status = CAM_UA_ABORT;
3139                         break;
3140                 }
3141                 /*
3142                  * If we weren't able to take care of the abort request
3143                  * in the XPT, pass the request down to the SIM for processing.
3144                  */
3145         }
3146         /* FALLTHROUGH */
3147         case XPT_ACCEPT_TARGET_IO:
3148         case XPT_EN_LUN:
3149         case XPT_IMMED_NOTIFY:
3150         case XPT_NOTIFY_ACK:
3151         case XPT_GET_TRAN_SETTINGS:
3152         case XPT_RESET_BUS:
3153         {
3154                 struct cam_sim *sim;
3155
3156                 sim = start_ccb->ccb_h.path->bus->sim;
3157                 (*(sim->sim_action))(sim, start_ccb);
3158                 break;
3159         }
3160         case XPT_PATH_INQ:
3161         {
3162                 struct cam_sim *sim;
3163
3164                 sim = start_ccb->ccb_h.path->bus->sim;
3165                 (*(sim->sim_action))(sim, start_ccb);
3166                 break;
3167         }
3168         case XPT_PATH_STATS:
3169                 start_ccb->cpis.last_reset =
3170                         start_ccb->ccb_h.path->bus->last_reset;
3171                 start_ccb->ccb_h.status = CAM_REQ_CMP;
3172                 break;
3173         case XPT_GDEV_TYPE:
3174         {
3175                 struct cam_ed *dev;
3176
3177                 dev = start_ccb->ccb_h.path->device;
3178                 if ((dev->flags & CAM_DEV_UNCONFIGURED) != 0) {
3179                         start_ccb->ccb_h.status = CAM_DEV_NOT_THERE;
3180                 } else {
3181                         struct ccb_getdev *cgd;
3182                         struct cam_eb *bus;
3183                         struct cam_et *tar;
3184
3185                         cgd = &start_ccb->cgd;
3186                         bus = cgd->ccb_h.path->bus;
3187                         tar = cgd->ccb_h.path->target;
3188                         cgd->inq_data = dev->inq_data;
3189                         cgd->ccb_h.status = CAM_REQ_CMP;
3190                         cgd->serial_num_len = dev->serial_num_len;
3191                         if ((dev->serial_num_len > 0)
3192                          && (dev->serial_num != NULL))
3193                                 bcopy(dev->serial_num, cgd->serial_num,
3194                                       dev->serial_num_len);
3195                 }
3196                 break;
3197         }
3198         case XPT_GDEV_STATS:
3199         {
3200                 struct cam_ed *dev;
3201
3202                 dev = start_ccb->ccb_h.path->device;
3203                 if ((dev->flags & CAM_DEV_UNCONFIGURED) != 0) {
3204                         start_ccb->ccb_h.status = CAM_DEV_NOT_THERE;
3205                 } else {
3206                         struct ccb_getdevstats *cgds;
3207                         struct cam_eb *bus;
3208                         struct cam_et *tar;
3209
3210                         cgds = &start_ccb->cgds;
3211                         bus = cgds->ccb_h.path->bus;
3212                         tar = cgds->ccb_h.path->target;
3213                         cgds->dev_openings = dev->ccbq.dev_openings;
3214                         cgds->dev_active = dev->ccbq.dev_active;
3215                         cgds->devq_openings = dev->ccbq.devq_openings;
3216                         cgds->devq_queued = dev->ccbq.queue.entries;
3217                         cgds->held = dev->ccbq.held;
3218                         cgds->last_reset = tar->last_reset;
3219                         cgds->maxtags = dev->quirk->maxtags;
3220                         cgds->mintags = dev->quirk->mintags;
3221                         if (timevalcmp(&tar->last_reset, &bus->last_reset, <))
3222                                 cgds->last_reset = bus->last_reset;
3223                         cgds->ccb_h.status = CAM_REQ_CMP;
3224                 }
3225                 break;
3226         }
3227         case XPT_GDEVLIST:
3228         {
3229                 struct cam_periph       *nperiph;
3230                 struct periph_list      *periph_head;
3231                 struct ccb_getdevlist   *cgdl;
3232                 u_int                   i;
3233                 struct cam_ed           *device;
3234                 int                     found;
3235
3236
3237                 found = 0;
3238
3239                 /*
3240                  * Don't want anyone mucking with our data.
3241                  */
3242                 device = start_ccb->ccb_h.path->device;
3243                 periph_head = &device->periphs;
3244                 cgdl = &start_ccb->cgdl;
3245
3246                 /*
3247                  * Check and see if the list has changed since the user
3248                  * last requested a list member.  If so, tell them that the
3249                  * list has changed, and therefore they need to start over
3250                  * from the beginning.
3251                  */
3252                 if ((cgdl->index != 0) &&
3253                     (cgdl->generation != device->generation)) {
3254                         cgdl->status = CAM_GDEVLIST_LIST_CHANGED;
3255                         break;
3256                 }
3257
3258                 /*
3259                  * Traverse the list of peripherals and attempt to find
3260                  * the requested peripheral.
3261                  */
3262                 for (nperiph = SLIST_FIRST(periph_head), i = 0;
3263                      (nperiph != NULL) && (i <= cgdl->index);
3264                      nperiph = SLIST_NEXT(nperiph, periph_links), i++) {
3265                         if (i == cgdl->index) {
3266                                 strncpy(cgdl->periph_name,
3267                                         nperiph->periph_name,
3268                                         DEV_IDLEN);
3269                                 cgdl->unit_number = nperiph->unit_number;
3270                                 found = 1;
3271                         }
3272                 }
3273                 if (found == 0) {
3274                         cgdl->status = CAM_GDEVLIST_ERROR;
3275                         break;
3276                 }
3277
3278                 if (nperiph == NULL)
3279                         cgdl->status = CAM_GDEVLIST_LAST_DEVICE;
3280                 else
3281                         cgdl->status = CAM_GDEVLIST_MORE_DEVS;
3282
3283                 cgdl->index++;
3284                 cgdl->generation = device->generation;
3285
3286                 cgdl->ccb_h.status = CAM_REQ_CMP;
3287                 break;
3288         }
3289         case XPT_DEV_MATCH:
3290         {
3291                 dev_pos_type position_type;
3292                 struct ccb_dev_match *cdm;
3293
3294                 cdm = &start_ccb->cdm;
3295
3296                 /*
3297                  * There are two ways of getting at information in the EDT.
3298                  * The first way is via the primary EDT tree.  It starts
3299                  * with a list of busses, then a list of targets on a bus,
3300                  * then devices/luns on a target, and then peripherals on a
3301                  * device/lun.  The "other" way is by the peripheral driver
3302                  * lists.  The peripheral driver lists are organized by
3303                  * peripheral driver.  (obviously)  So it makes sense to
3304                  * use the peripheral driver list if the user is looking
3305                  * for something like "da1", or all "da" devices.  If the
3306                  * user is looking for something on a particular bus/target
3307                  * or lun, it's generally better to go through the EDT tree.
3308                  */
3309
3310                 if (cdm->pos.position_type != CAM_DEV_POS_NONE)
3311                         position_type = cdm->pos.position_type;
3312                 else {
3313                         u_int i;
3314
3315                         position_type = CAM_DEV_POS_NONE;
3316
3317                         for (i = 0; i < cdm->num_patterns; i++) {
3318                                 if ((cdm->patterns[i].type == DEV_MATCH_BUS)
3319                                  ||(cdm->patterns[i].type == DEV_MATCH_DEVICE)){
3320                                         position_type = CAM_DEV_POS_EDT;
3321                                         break;
3322                                 }
3323                         }
3324
3325                         if (cdm->num_patterns == 0)
3326                                 position_type = CAM_DEV_POS_EDT;
3327                         else if (position_type == CAM_DEV_POS_NONE)
3328                                 position_type = CAM_DEV_POS_PDRV;
3329                 }
3330
3331                 switch(position_type & CAM_DEV_POS_TYPEMASK) {
3332                 case CAM_DEV_POS_EDT:
3333                         xptedtmatch(cdm);
3334                         break;
3335                 case CAM_DEV_POS_PDRV:
3336                         xptperiphlistmatch(cdm);
3337                         break;
3338                 default:
3339                         cdm->status = CAM_DEV_MATCH_ERROR;
3340                         break;
3341                 }
3342
3343                 if (cdm->status == CAM_DEV_MATCH_ERROR)
3344                         start_ccb->ccb_h.status = CAM_REQ_CMP_ERR;
3345                 else
3346                         start_ccb->ccb_h.status = CAM_REQ_CMP;
3347
3348                 break;
3349         }
3350         case XPT_SASYNC_CB:
3351         {
3352                 struct ccb_setasync *csa;
3353                 struct async_node *cur_entry;
3354                 struct async_list *async_head;
3355                 u_int32_t added;
3356
3357                 csa = &start_ccb->csa;
3358                 added = csa->event_enable;
3359                 async_head = &csa->ccb_h.path->device->asyncs;
3360
3361                 /*
3362                  * If there is already an entry for us, simply
3363                  * update it.
3364                  */
3365                 cur_entry = SLIST_FIRST(async_head);
3366                 while (cur_entry != NULL) {
3367                         if ((cur_entry->callback_arg == csa->callback_arg)
3368                          && (cur_entry->callback == csa->callback))
3369                                 break;
3370                         cur_entry = SLIST_NEXT(cur_entry, links);
3371                 }
3372
3373                 if (cur_entry != NULL) {
3374                         /*
3375                          * If the request has no flags set,
3376                          * remove the entry.
3377                          */
3378                         added &= ~cur_entry->event_enable;
3379                         if (csa->event_enable == 0) {
3380                                 SLIST_REMOVE(async_head, cur_entry,
3381                                              async_node, links);
3382                                 csa->ccb_h.path->device->refcount--;
3383                                 free(cur_entry, M_CAMXPT);
3384                         } else {
3385                                 cur_entry->event_enable = csa->event_enable;
3386                         }
3387                 } else {
3388                         cur_entry = malloc(sizeof(*cur_entry), M_CAMXPT,
3389                                            M_NOWAIT);
3390                         if (cur_entry == NULL) {
3391                                 csa->ccb_h.status = CAM_RESRC_UNAVAIL;
3392                                 break;
3393                         }
3394                         cur_entry->event_enable = csa->event_enable;
3395                         cur_entry->callback_arg = csa->callback_arg;
3396                         cur_entry->callback = csa->callback;
3397                         SLIST_INSERT_HEAD(async_head, cur_entry, links);
3398                         csa->ccb_h.path->device->refcount++;
3399                 }
3400
3401                 /*
3402                  * Need to decouple this operation via a taqskqueue so that
3403                  * the locking doesn't become a mess.
3404                  */
3405                 if ((added & (AC_FOUND_DEVICE | AC_PATH_REGISTERED)) != 0) {
3406                         struct xpt_task *task;
3407
3408                         task = malloc(sizeof(struct xpt_task), M_CAMXPT,
3409                                       M_NOWAIT);
3410                         if (task == NULL) {
3411                                 csa->ccb_h.status = CAM_RESRC_UNAVAIL;
3412                                 break;
3413                         }
3414
3415                         TASK_INIT(&task->task, 0, xpt_action_sasync_cb, task);
3416                         task->data1 = cur_entry;
3417                         task->data2 = added;
3418                         taskqueue_enqueue(taskqueue_thread, &task->task);
3419                 }
3420
3421                 start_ccb->ccb_h.status = CAM_REQ_CMP;
3422                 break;
3423         }
3424         case XPT_REL_SIMQ:
3425         {
3426                 struct ccb_relsim *crs;
3427                 struct cam_ed *dev;
3428
3429                 crs = &start_ccb->crs;
3430                 dev = crs->ccb_h.path->device;
3431                 if (dev == NULL) {
3432
3433                         crs->ccb_h.status = CAM_DEV_NOT_THERE;
3434                         break;
3435                 }
3436
3437                 if ((crs->release_flags & RELSIM_ADJUST_OPENINGS) != 0) {
3438
3439                         if (INQ_DATA_TQ_ENABLED(&dev->inq_data)) {
3440                                 /* Don't ever go below one opening */
3441                                 if (crs->openings > 0) {
3442                                         xpt_dev_ccbq_resize(crs->ccb_h.path,
3443                                                             crs->openings);
3444
3445                                         if (bootverbose) {
3446                                                 xpt_print(crs->ccb_h.path,
3447                                                     "tagged openings now %d\n",
3448                                                     crs->openings);
3449                                         }
3450                                 }
3451                         }
3452                 }
3453
3454                 if ((crs->release_flags & RELSIM_RELEASE_AFTER_TIMEOUT) != 0) {
3455
3456                         if ((dev->flags & CAM_DEV_REL_TIMEOUT_PENDING) != 0) {
3457
3458                                 /*
3459                                  * Just extend the old timeout and decrement
3460                                  * the freeze count so that a single timeout
3461                                  * is sufficient for releasing the queue.
3462                                  */
3463                                 start_ccb->ccb_h.flags &= ~CAM_DEV_QFREEZE;
3464                                 callout_stop(&dev->callout);
3465                         } else {
3466
3467                                 start_ccb->ccb_h.flags |= CAM_DEV_QFREEZE;
3468                         }
3469
3470                         callout_reset(&dev->callout,
3471                             (crs->release_timeout * hz) / 1000,
3472                             xpt_release_devq_timeout, dev);
3473
3474                         dev->flags |= CAM_DEV_REL_TIMEOUT_PENDING;
3475
3476                 }
3477
3478                 if ((crs->release_flags & RELSIM_RELEASE_AFTER_CMDCMPLT) != 0) {
3479
3480                         if ((dev->flags & CAM_DEV_REL_ON_COMPLETE) != 0) {
3481                                 /*
3482                                  * Decrement the freeze count so that a single
3483                                  * completion is still sufficient to unfreeze
3484                                  * the queue.
3485                                  */
3486                                 start_ccb->ccb_h.flags &= ~CAM_DEV_QFREEZE;
3487                         } else {
3488
3489                                 dev->flags |= CAM_DEV_REL_ON_COMPLETE;
3490                                 start_ccb->ccb_h.flags |= CAM_DEV_QFREEZE;
3491                         }
3492                 }
3493
3494                 if ((crs->release_flags & RELSIM_RELEASE_AFTER_QEMPTY) != 0) {
3495
3496                         if ((dev->flags & CAM_DEV_REL_ON_QUEUE_EMPTY) != 0
3497                          || (dev->ccbq.dev_active == 0)) {
3498
3499                                 start_ccb->ccb_h.flags &= ~CAM_DEV_QFREEZE;
3500                         } else {
3501
3502                                 dev->flags |= CAM_DEV_REL_ON_QUEUE_EMPTY;
3503                                 start_ccb->ccb_h.flags |= CAM_DEV_QFREEZE;
3504                         }
3505                 }
3506
3507                 if ((start_ccb->ccb_h.flags & CAM_DEV_QFREEZE) == 0) {
3508
3509                         xpt_release_devq(crs->ccb_h.path, /*count*/1,
3510                                          /*run_queue*/TRUE);
3511                 }
3512                 start_ccb->crs.qfrozen_cnt = dev->qfrozen_cnt;
3513                 start_ccb->ccb_h.status = CAM_REQ_CMP;
3514                 break;
3515         }
3516         case XPT_SCAN_BUS:
3517                 xpt_scan_bus(start_ccb->ccb_h.path->periph, start_ccb);
3518                 break;
3519         case XPT_SCAN_LUN:
3520                 xpt_scan_lun(start_ccb->ccb_h.path->periph,
3521                              start_ccb->ccb_h.path, start_ccb->crcn.flags,
3522                              start_ccb);
3523                 break;
3524         case XPT_DEBUG: {
3525 #ifdef CAMDEBUG
3526 #ifdef CAM_DEBUG_DELAY
3527                 cam_debug_delay = CAM_DEBUG_DELAY;
3528 #endif
3529                 cam_dflags = start_ccb->cdbg.flags;
3530                 if (cam_dpath != NULL) {
3531                         xpt_free_path(cam_dpath);
3532                         cam_dpath = NULL;
3533                 }
3534
3535                 if (cam_dflags != CAM_DEBUG_NONE) {
3536                         if (xpt_create_path(&cam_dpath, xpt_periph,
3537                                             start_ccb->ccb_h.path_id,
3538                                             start_ccb->ccb_h.target_id,
3539                                             start_ccb->ccb_h.target_lun) !=
3540                                             CAM_REQ_CMP) {
3541                                 start_ccb->ccb_h.status = CAM_RESRC_UNAVAIL;
3542                                 cam_dflags = CAM_DEBUG_NONE;
3543                         } else {
3544                                 start_ccb->ccb_h.status = CAM_REQ_CMP;
3545                                 xpt_print(cam_dpath, "debugging flags now %x\n",
3546                                     cam_dflags);
3547                         }
3548                 } else {
3549                         cam_dpath = NULL;
3550                         start_ccb->ccb_h.status = CAM_REQ_CMP;
3551                 }
3552 #else /* !CAMDEBUG */
3553                 start_ccb->ccb_h.status = CAM_FUNC_NOTAVAIL;
3554 #endif /* CAMDEBUG */
3555                 break;
3556         }
3557         case XPT_NOOP:
3558                 if ((start_ccb->ccb_h.flags & CAM_DEV_QFREEZE) != 0)
3559                         xpt_freeze_devq(start_ccb->ccb_h.path, 1);
3560                 start_ccb->ccb_h.status = CAM_REQ_CMP;
3561                 break;
3562         default:
3563         case XPT_SDEV_TYPE:
3564         case XPT_TERM_IO:
3565         case XPT_ENG_INQ:
3566                 /* XXX Implement */
3567                 start_ccb->ccb_h.status = CAM_PROVIDE_FAIL;
3568                 break;
3569         }
3570 }
3571
3572 void
3573 xpt_polled_action(union ccb *start_ccb)
3574 {
3575         u_int32_t timeout;
3576         struct    cam_sim *sim;
3577         struct    cam_devq *devq;
3578         struct    cam_ed *dev;
3579
3580
3581         timeout = start_ccb->ccb_h.timeout;
3582         sim = start_ccb->ccb_h.path->bus->sim;
3583         devq = sim->devq;
3584         dev = start_ccb->ccb_h.path->device;
3585
3586         mtx_assert(sim->mtx, MA_OWNED);
3587
3588         /*
3589          * Steal an opening so that no other queued requests
3590          * can get it before us while we simulate interrupts.
3591          */
3592         dev->ccbq.devq_openings--;
3593         dev->ccbq.dev_openings--;
3594
3595         while(((devq != NULL && devq->send_openings <= 0) ||
3596            dev->ccbq.dev_openings < 0) && (--timeout > 0)) {
3597                 DELAY(1000);
3598                 (*(sim->sim_poll))(sim);
3599                 camisr_runqueue(&sim->sim_doneq);
3600         }
3601
3602         dev->ccbq.devq_openings++;
3603         dev->ccbq.dev_openings++;
3604
3605         if (timeout != 0) {
3606                 xpt_action(start_ccb);
3607                 while(--timeout > 0) {
3608                         (*(sim->sim_poll))(sim);
3609                         camisr_runqueue(&sim->sim_doneq);
3610                         if ((start_ccb->ccb_h.status  & CAM_STATUS_MASK)
3611                             != CAM_REQ_INPROG)
3612                                 break;
3613                         DELAY(1000);
3614                 }
3615                 if (timeout == 0) {
3616                         /*
3617                          * XXX Is it worth adding a sim_timeout entry
3618                          * point so we can attempt recovery?  If
3619                          * this is only used for dumps, I don't think
3620                          * it is.
3621                          */
3622                         start_ccb->ccb_h.status = CAM_CMD_TIMEOUT;
3623                 }
3624         } else {
3625                 start_ccb->ccb_h.status = CAM_RESRC_UNAVAIL;
3626         }
3627 }
3628
3629 /*
3630  * Schedule a peripheral driver to receive a ccb when it's
3631  * target device has space for more transactions.
3632  */
3633 void
3634 xpt_schedule(struct cam_periph *perph, u_int32_t new_priority)
3635 {
3636         struct cam_ed *device;
3637         int runq;
3638
3639         mtx_assert(perph->sim->mtx, MA_OWNED);
3640
3641         CAM_DEBUG(perph->path, CAM_DEBUG_TRACE, ("xpt_schedule\n"));
3642         device = perph->path->device;
3643         if (periph_is_queued(perph)) {
3644                 /* Simply reorder based on new priority */
3645                 CAM_DEBUG(perph->path, CAM_DEBUG_SUBTRACE,
3646                           ("   change priority to %d\n", new_priority));
3647                 if (new_priority < perph->pinfo.priority) {
3648                         camq_change_priority(&device->drvq,
3649                                              perph->pinfo.index,
3650                                              new_priority);
3651                 }
3652                 runq = 0;
3653         } else {
3654                 /* New entry on the queue */
3655                 CAM_DEBUG(perph->path, CAM_DEBUG_SUBTRACE,
3656                           ("   added periph to queue\n"));
3657                 perph->pinfo.priority = new_priority;
3658                 perph->pinfo.generation = ++device->drvq.generation;
3659                 camq_insert(&device->drvq, &perph->pinfo);
3660                 runq = xpt_schedule_dev_allocq(perph->path->bus, device);
3661         }
3662         if (runq != 0) {
3663                 CAM_DEBUG(perph->path, CAM_DEBUG_SUBTRACE,
3664                           ("   calling xpt_run_devq\n"));
3665                 xpt_run_dev_allocq(perph->path->bus);
3666         }
3667 }
3668
3669
3670 /*
3671  * Schedule a device to run on a given queue.
3672  * If the device was inserted as a new entry on the queue,
3673  * return 1 meaning the device queue should be run. If we
3674  * were already queued, implying someone else has already
3675  * started the queue, return 0 so the caller doesn't attempt
3676  * to run the queue.
3677  */
3678 static int
3679 xpt_schedule_dev(struct camq *queue, cam_pinfo *pinfo,
3680                  u_int32_t new_priority)
3681 {
3682         int retval;
3683         u_int32_t old_priority;
3684
3685         CAM_DEBUG_PRINT(CAM_DEBUG_XPT, ("xpt_schedule_dev\n"));
3686
3687         old_priority = pinfo->priority;
3688
3689         /*
3690          * Are we already queued?
3691          */
3692         if (pinfo->index != CAM_UNQUEUED_INDEX) {
3693                 /* Simply reorder based on new priority */
3694                 if (new_priority < old_priority) {
3695                         camq_change_priority(queue, pinfo->index,
3696                                              new_priority);
3697                         CAM_DEBUG_PRINT(CAM_DEBUG_XPT,
3698                                         ("changed priority to %d\n",
3699                                          new_priority));
3700                 }
3701                 retval = 0;
3702         } else {
3703                 /* New entry on the queue */
3704                 if (new_priority < old_priority)
3705                         pinfo->priority = new_priority;
3706
3707                 CAM_DEBUG_PRINT(CAM_DEBUG_XPT,
3708                                 ("Inserting onto queue\n"));
3709                 pinfo->generation = ++queue->generation;
3710                 camq_insert(queue, pinfo);
3711                 retval = 1;
3712         }
3713         return (retval);
3714 }
3715
3716 static void
3717 xpt_run_dev_allocq(struct cam_eb *bus)
3718 {
3719         struct  cam_devq *devq;
3720
3721         CAM_DEBUG_PRINT(CAM_DEBUG_XPT, ("xpt_run_dev_allocq\n"));
3722         devq = bus->sim->devq;
3723
3724         CAM_DEBUG_PRINT(CAM_DEBUG_XPT,
3725                         ("   qfrozen_cnt == 0x%x, entries == %d, "
3726                          "openings == %d, active == %d\n",
3727                          devq->alloc_queue.qfrozen_cnt,
3728                          devq->alloc_queue.entries,
3729                          devq->alloc_openings,
3730                          devq->alloc_active));
3731
3732         devq->alloc_queue.qfrozen_cnt++;
3733         while ((devq->alloc_queue.entries > 0)
3734             && (devq->alloc_openings > 0)
3735             && (devq->alloc_queue.qfrozen_cnt <= 1)) {
3736                 struct  cam_ed_qinfo *qinfo;
3737                 struct  cam_ed *device;
3738                 union   ccb *work_ccb;
3739                 struct  cam_periph *drv;
3740                 struct  camq *drvq;
3741
3742                 qinfo = (struct cam_ed_qinfo *)camq_remove(&devq->alloc_queue,
3743                                                            CAMQ_HEAD);
3744                 device = qinfo->device;
3745
3746                 CAM_DEBUG_PRINT(CAM_DEBUG_XPT,
3747                                 ("running device %p\n", device));
3748
3749                 drvq = &device->drvq;
3750
3751 #ifdef CAMDEBUG
3752                 if (drvq->entries <= 0) {
3753                         panic("xpt_run_dev_allocq: "
3754                               "Device on queue without any work to do");
3755                 }
3756 #endif
3757                 if ((work_ccb = xpt_get_ccb(device)) != NULL) {
3758                         devq->alloc_openings--;
3759                         devq->alloc_active++;
3760                         drv = (struct cam_periph*)camq_remove(drvq, CAMQ_HEAD);
3761                         xpt_setup_ccb(&work_ccb->ccb_h, drv->path,
3762                                       drv->pinfo.priority);
3763                         CAM_DEBUG_PRINT(CAM_DEBUG_XPT,
3764                                         ("calling periph start\n"));
3765                         drv->periph_start(drv, work_ccb);
3766                 } else {
3767                         /*
3768                          * Malloc failure in alloc_ccb
3769                          */
3770                         /*
3771                          * XXX add us to a list to be run from free_ccb
3772                          * if we don't have any ccbs active on this
3773                          * device queue otherwise we may never get run
3774                          * again.
3775                          */
3776                         break;
3777                 }
3778
3779                 if (drvq->entries > 0) {
3780                         /* We have more work.  Attempt to reschedule */
3781                         xpt_schedule_dev_allocq(bus, device);
3782                 }
3783         }
3784         devq->alloc_queue.qfrozen_cnt--;
3785 }
3786
3787 static void
3788 xpt_run_dev_sendq(struct cam_eb *bus)
3789 {
3790         struct  cam_devq *devq;
3791
3792         CAM_DEBUG_PRINT(CAM_DEBUG_XPT, ("xpt_run_dev_sendq\n"));
3793
3794         devq = bus->sim->devq;
3795
3796         devq->send_queue.qfrozen_cnt++;
3797         while ((devq->send_queue.entries > 0)
3798             && (devq->send_openings > 0)) {
3799                 struct  cam_ed_qinfo *qinfo;
3800                 struct  cam_ed *device;
3801                 union ccb *work_ccb;
3802                 struct  cam_sim *sim;
3803
3804                 if (devq->send_queue.qfrozen_cnt > 1) {
3805                         break;
3806                 }
3807
3808                 qinfo = (struct cam_ed_qinfo *)camq_remove(&devq->send_queue,
3809                                                            CAMQ_HEAD);
3810                 device = qinfo->device;
3811
3812                 /*
3813                  * If the device has been "frozen", don't attempt
3814                  * to run it.
3815                  */
3816                 if (device->qfrozen_cnt > 0) {
3817                         continue;
3818                 }
3819
3820                 CAM_DEBUG_PRINT(CAM_DEBUG_XPT,
3821                                 ("running device %p\n", device));
3822
3823                 work_ccb = cam_ccbq_peek_ccb(&device->ccbq, CAMQ_HEAD);
3824                 if (work_ccb == NULL) {
3825                         printf("device on run queue with no ccbs???\n");
3826                         continue;
3827                 }
3828
3829                 if ((work_ccb->ccb_h.flags & CAM_HIGH_POWER) != 0) {
3830
3831                         mtx_lock(&xsoftc.xpt_lock);
3832                         if (xsoftc.num_highpower <= 0) {
3833                                 /*
3834                                  * We got a high power command, but we
3835                                  * don't have any available slots.  Freeze
3836                                  * the device queue until we have a slot
3837                                  * available.
3838                                  */
3839                                 device->qfrozen_cnt++;
3840                                 STAILQ_INSERT_TAIL(&xsoftc.highpowerq,
3841                                                    &work_ccb->ccb_h,
3842                                                    xpt_links.stqe);
3843
3844                                 mtx_unlock(&xsoftc.xpt_lock);
3845                                 continue;
3846                         } else {
3847                                 /*
3848                                  * Consume a high power slot while
3849                                  * this ccb runs.
3850                                  */
3851                                 xsoftc.num_highpower--;
3852                         }
3853                         mtx_unlock(&xsoftc.xpt_lock);
3854                 }
3855                 devq->active_dev = device;
3856                 cam_ccbq_remove_ccb(&device->ccbq, work_ccb);
3857
3858                 cam_ccbq_send_ccb(&device->ccbq, work_ccb);
3859
3860                 devq->send_openings--;
3861                 devq->send_active++;
3862
3863                 if (device->ccbq.queue.entries > 0)
3864                         xpt_schedule_dev_sendq(bus, device);
3865
3866                 if (work_ccb && (work_ccb->ccb_h.flags & CAM_DEV_QFREEZE) != 0){
3867                         /*
3868                          * The client wants to freeze the queue
3869                          * after this CCB is sent.
3870                          */
3871                         device->qfrozen_cnt++;
3872                 }
3873
3874                 /* In Target mode, the peripheral driver knows best... */
3875                 if (work_ccb->ccb_h.func_code == XPT_SCSI_IO) {
3876                         if ((device->inq_flags & SID_CmdQue) != 0
3877                          && work_ccb->csio.tag_action != CAM_TAG_ACTION_NONE)
3878                                 work_ccb->ccb_h.flags |= CAM_TAG_ACTION_VALID;
3879                         else
3880                                 /*
3881                                  * Clear this in case of a retried CCB that
3882                                  * failed due to a rejected tag.
3883                                  */
3884                                 work_ccb->ccb_h.flags &= ~CAM_TAG_ACTION_VALID;
3885                 }
3886
3887                 /*
3888                  * Device queues can be shared among multiple sim instances
3889                  * that reside on different busses.  Use the SIM in the queue
3890                  * CCB's path, rather than the one in the bus that was passed
3891                  * into this function.
3892                  */
3893                 sim = work_ccb->ccb_h.path->bus->sim;
3894                 (*(sim->sim_action))(sim, work_ccb);
3895
3896                 devq->active_dev = NULL;
3897         }
3898         devq->send_queue.qfrozen_cnt--;
3899 }
3900
3901 /*
3902  * This function merges stuff from the slave ccb into the master ccb, while
3903  * keeping important fields in the master ccb constant.
3904  */
3905 void
3906 xpt_merge_ccb(union ccb *master_ccb, union ccb *slave_ccb)
3907 {
3908
3909         /*
3910          * Pull fields that are valid for peripheral drivers to set
3911          * into the master CCB along with the CCB "payload".
3912          */
3913         master_ccb->ccb_h.retry_count = slave_ccb->ccb_h.retry_count;
3914         master_ccb->ccb_h.func_code = slave_ccb->ccb_h.func_code;
3915         master_ccb->ccb_h.timeout = slave_ccb->ccb_h.timeout;
3916         master_ccb->ccb_h.flags = slave_ccb->ccb_h.flags;
3917         bcopy(&(&slave_ccb->ccb_h)[1], &(&master_ccb->ccb_h)[1],
3918               sizeof(union ccb) - sizeof(struct ccb_hdr));
3919 }
3920
3921 void
3922 xpt_setup_ccb(struct ccb_hdr *ccb_h, struct cam_path *path, u_int32_t priority)
3923 {
3924
3925         CAM_DEBUG(path, CAM_DEBUG_TRACE, ("xpt_setup_ccb\n"));
3926         ccb_h->pinfo.priority = priority;
3927         ccb_h->path = path;
3928         ccb_h->path_id = path->bus->path_id;
3929         if (path->target)
3930                 ccb_h->target_id = path->target->target_id;
3931         else
3932                 ccb_h->target_id = CAM_TARGET_WILDCARD;
3933         if (path->device) {
3934                 ccb_h->target_lun = path->device->lun_id;
3935                 ccb_h->pinfo.generation = ++path->device->ccbq.queue.generation;
3936         } else {
3937                 ccb_h->target_lun = CAM_TARGET_WILDCARD;
3938         }
3939         ccb_h->pinfo.index = CAM_UNQUEUED_INDEX;
3940         ccb_h->flags = 0;
3941 }
3942
3943 /* Path manipulation functions */
3944 cam_status
3945 xpt_create_path(struct cam_path **new_path_ptr, struct cam_periph *perph,
3946                 path_id_t path_id, target_id_t target_id, lun_id_t lun_id)
3947 {
3948         struct     cam_path *path;
3949         cam_status status;
3950
3951         path = (struct cam_path *)malloc(sizeof(*path), M_CAMXPT, M_NOWAIT);
3952
3953         if (path == NULL) {
3954                 status = CAM_RESRC_UNAVAIL;
3955                 return(status);
3956         }
3957         status = xpt_compile_path(path, perph, path_id, target_id, lun_id);
3958         if (status != CAM_REQ_CMP) {
3959                 free(path, M_CAMXPT);
3960                 path = NULL;
3961         }
3962         *new_path_ptr = path;
3963         return (status);
3964 }
3965
3966 cam_status
3967 xpt_create_path_unlocked(struct cam_path **new_path_ptr,
3968                          struct cam_periph *periph, path_id_t path_id,
3969                          target_id_t target_id, lun_id_t lun_id)
3970 {
3971         struct     cam_path *path;
3972         struct     cam_eb *bus = NULL;
3973         cam_status status;
3974         int        need_unlock = 0;
3975
3976         path = (struct cam_path *)malloc(sizeof(*path), M_CAMXPT, M_WAITOK);
3977
3978         if (path_id != CAM_BUS_WILDCARD) {
3979                 bus = xpt_find_bus(path_id);
3980                 if (bus != NULL) {
3981                         need_unlock = 1;
3982                         CAM_SIM_LOCK(bus->sim);
3983                 }
3984         }
3985         status = xpt_compile_path(path, periph, path_id, target_id, lun_id);
3986         if (need_unlock)
3987                 CAM_SIM_UNLOCK(bus->sim);
3988         if (status != CAM_REQ_CMP) {
3989                 free(path, M_CAMXPT);
3990                 path = NULL;
3991         }
3992         *new_path_ptr = path;
3993         return (status);
3994 }
3995
3996 static cam_status
3997 xpt_compile_path(struct cam_path *new_path, struct cam_periph *perph,
3998                  path_id_t path_id, target_id_t target_id, lun_id_t lun_id)
3999 {
4000         struct       cam_eb *bus;
4001         struct       cam_et *target;
4002         struct       cam_ed *device;
4003         cam_status   status;
4004
4005         status = CAM_REQ_CMP;   /* Completed without error */
4006         target = NULL;          /* Wildcarded */
4007         device = NULL;          /* Wildcarded */
4008
4009         /*
4010          * We will potentially modify the EDT, so block interrupts
4011          * that may attempt to create cam paths.
4012          */
4013         bus = xpt_find_bus(path_id);
4014         if (bus == NULL) {
4015                 status = CAM_PATH_INVALID;
4016         } else {
4017                 target = xpt_find_target(bus, target_id);
4018                 if (target == NULL) {
4019                         /* Create one */
4020                         struct cam_et *new_target;
4021
4022                         new_target = xpt_alloc_target(bus, target_id);
4023                         if (new_target == NULL) {
4024                                 status = CAM_RESRC_UNAVAIL;
4025                         } else {
4026                                 target = new_target;
4027                         }
4028                 }
4029                 if (target != NULL) {
4030                         device = xpt_find_device(target, lun_id);
4031                         if (device == NULL) {
4032                                 /* Create one */
4033                                 struct cam_ed *new_device;
4034
4035                                 new_device = xpt_alloc_device(bus,
4036                                                               target,
4037                                                               lun_id);
4038                                 if (new_device == NULL) {
4039                                         status = CAM_RESRC_UNAVAIL;
4040                                 } else {
4041                                         device = new_device;
4042                                 }
4043                         }
4044                 }
4045         }
4046
4047         /*
4048          * Only touch the user's data if we are successful.
4049          */
4050         if (status == CAM_REQ_CMP) {
4051                 new_path->periph = perph;
4052                 new_path->bus = bus;
4053                 new_path->target = target;
4054                 new_path->device = device;
4055                 CAM_DEBUG(new_path, CAM_DEBUG_TRACE, ("xpt_compile_path\n"));
4056         } else {
4057                 if (device != NULL)
4058                         xpt_release_device(bus, target, device);
4059                 if (target != NULL)
4060                         xpt_release_target(bus, target);
4061                 if (bus != NULL)
4062                         xpt_release_bus(bus);
4063         }
4064         return (status);
4065 }
4066
4067 static void
4068 xpt_release_path(struct cam_path *path)
4069 {
4070         CAM_DEBUG(path, CAM_DEBUG_TRACE, ("xpt_release_path\n"));
4071         if (path->device != NULL) {
4072                 xpt_release_device(path->bus, path->target, path->device);
4073                 path->device = NULL;
4074         }
4075         if (path->target != NULL) {
4076                 xpt_release_target(path->bus, path->target);
4077                 path->target = NULL;
4078         }
4079         if (path->bus != NULL) {
4080                 xpt_release_bus(path->bus);
4081                 path->bus = NULL;
4082         }
4083 }
4084
4085 void
4086 xpt_free_path(struct cam_path *path)
4087 {
4088
4089         CAM_DEBUG(path, CAM_DEBUG_TRACE, ("xpt_free_path\n"));
4090         xpt_release_path(path);
4091         free(path, M_CAMXPT);
4092 }
4093
4094
4095 /*
4096  * Return -1 for failure, 0 for exact match, 1 for match with wildcards
4097  * in path1, 2 for match with wildcards in path2.
4098  */
4099 int
4100 xpt_path_comp(struct cam_path *path1, struct cam_path *path2)
4101 {
4102         int retval = 0;
4103
4104         if (path1->bus != path2->bus) {
4105                 if (path1->bus->path_id == CAM_BUS_WILDCARD)
4106                         retval = 1;
4107                 else if (path2->bus->path_id == CAM_BUS_WILDCARD)
4108                         retval = 2;
4109                 else
4110                         return (-1);
4111         }
4112         if (path1->target != path2->target) {
4113                 if (path1->target->target_id == CAM_TARGET_WILDCARD) {
4114                         if (retval == 0)
4115                                 retval = 1;
4116                 } else if (path2->target->target_id == CAM_TARGET_WILDCARD)
4117                         retval = 2;
4118                 else
4119                         return (-1);
4120         }
4121         if (path1->device != path2->device) {
4122                 if (path1->device->lun_id == CAM_LUN_WILDCARD) {
4123                         if (retval == 0)
4124                                 retval = 1;
4125                 } else if (path2->device->lun_id == CAM_LUN_WILDCARD)
4126                         retval = 2;
4127                 else
4128                         return (-1);
4129         }
4130         return (retval);
4131 }
4132
4133 void
4134 xpt_print_path(struct cam_path *path)
4135 {
4136
4137         if (path == NULL)
4138                 printf("(nopath): ");
4139         else {
4140                 if (path->periph != NULL)
4141                         printf("(%s%d:", path->periph->periph_name,
4142                                path->periph->unit_number);
4143                 else
4144                         printf("(noperiph:");
4145
4146                 if (path->bus != NULL)
4147                         printf("%s%d:%d:", path->bus->sim->sim_name,
4148                                path->bus->sim->unit_number,
4149                                path->bus->sim->bus_id);
4150                 else
4151                         printf("nobus:");
4152
4153                 if (path->target != NULL)
4154                         printf("%d:", path->target->target_id);
4155                 else
4156                         printf("X:");
4157
4158                 if (path->device != NULL)
4159                         printf("%d): ", path->device->lun_id);
4160                 else
4161                         printf("X): ");
4162         }
4163 }
4164
4165 void
4166 xpt_print(struct cam_path *path, const char *fmt, ...)
4167 {
4168         va_list ap;
4169         xpt_print_path(path);
4170         va_start(ap, fmt);
4171         vprintf(fmt, ap);
4172         va_end(ap);
4173 }
4174
4175 int
4176 xpt_path_string(struct cam_path *path, char *str, size_t str_len)
4177 {
4178         struct sbuf sb;
4179
4180         mtx_assert(path->bus->sim->mtx, MA_OWNED);
4181
4182         sbuf_new(&sb, str, str_len, 0);
4183
4184         if (path == NULL)
4185                 sbuf_printf(&sb, "(nopath): ");
4186         else {
4187                 if (path->periph != NULL)
4188                         sbuf_printf(&sb, "(%s%d:", path->periph->periph_name,
4189                                     path->periph->unit_number);
4190                 else
4191                         sbuf_printf(&sb, "(noperiph:");
4192
4193                 if (path->bus != NULL)
4194                         sbuf_printf(&sb, "%s%d:%d:", path->bus->sim->sim_name,
4195                                     path->bus->sim->unit_number,
4196                                     path->bus->sim->bus_id);
4197                 else
4198                         sbuf_printf(&sb, "nobus:");
4199
4200                 if (path->target != NULL)
4201                         sbuf_printf(&sb, "%d:", path->target->target_id);
4202                 else
4203                         sbuf_printf(&sb, "X:");
4204
4205                 if (path->device != NULL)
4206                         sbuf_printf(&sb, "%d): ", path->device->lun_id);
4207                 else
4208                         sbuf_printf(&sb, "X): ");
4209         }
4210         sbuf_finish(&sb);
4211
4212         return(sbuf_len(&sb));
4213 }
4214
4215 path_id_t
4216 xpt_path_path_id(struct cam_path *path)
4217 {
4218         mtx_assert(path->bus->sim->mtx, MA_OWNED);
4219
4220         return(path->bus->path_id);
4221 }
4222
4223 target_id_t
4224 xpt_path_target_id(struct cam_path *path)
4225 {
4226         mtx_assert(path->bus->sim->mtx, MA_OWNED);
4227
4228         if (path->target != NULL)
4229                 return (path->target->target_id);
4230         else
4231                 return (CAM_TARGET_WILDCARD);
4232 }
4233
4234 lun_id_t
4235 xpt_path_lun_id(struct cam_path *path)
4236 {
4237         mtx_assert(path->bus->sim->mtx, MA_OWNED);
4238
4239         if (path->device != NULL)
4240                 return (path->device->lun_id);
4241         else
4242                 return (CAM_LUN_WILDCARD);
4243 }
4244
4245 struct cam_sim *
4246 xpt_path_sim(struct cam_path *path)
4247 {
4248
4249         return (path->bus->sim);
4250 }
4251
4252 struct cam_periph*
4253 xpt_path_periph(struct cam_path *path)
4254 {
4255         mtx_assert(path->bus->sim->mtx, MA_OWNED);
4256
4257         return (path->periph);
4258 }
4259
4260 /*
4261  * Release a CAM control block for the caller.  Remit the cost of the structure
4262  * to the device referenced by the path.  If the this device had no 'credits'
4263  * and peripheral drivers have registered async callbacks for this notification
4264  * call them now.
4265  */
4266 void
4267 xpt_release_ccb(union ccb *free_ccb)
4268 {
4269         struct   cam_path *path;
4270         struct   cam_ed *device;
4271         struct   cam_eb *bus;
4272         struct   cam_sim *sim;
4273
4274         CAM_DEBUG_PRINT(CAM_DEBUG_XPT, ("xpt_release_ccb\n"));
4275         path = free_ccb->ccb_h.path;
4276         device = path->device;
4277         bus = path->bus;
4278         sim = bus->sim;
4279
4280         mtx_assert(sim->mtx, MA_OWNED);
4281
4282         cam_ccbq_release_opening(&device->ccbq);
4283         if (sim->ccb_count > sim->max_ccbs) {
4284                 xpt_free_ccb(free_ccb);
4285                 sim->ccb_count--;
4286         } else {
4287                 SLIST_INSERT_HEAD(&sim->ccb_freeq, &free_ccb->ccb_h,
4288                     xpt_links.sle);
4289         }
4290         if (sim->devq == NULL) {
4291                 return;
4292         }
4293         sim->devq->alloc_openings++;
4294         sim->devq->alloc_active--;
4295         /* XXX Turn this into an inline function - xpt_run_device?? */
4296         if ((device_is_alloc_queued(device) == 0)
4297          && (device->drvq.entries > 0)) {
4298                 xpt_schedule_dev_allocq(bus, device);
4299         }
4300         if (dev_allocq_is_runnable(sim->devq))
4301                 xpt_run_dev_allocq(bus);
4302 }
4303
4304 /* Functions accessed by SIM drivers */
4305
4306 /*
4307  * A sim structure, listing the SIM entry points and instance
4308  * identification info is passed to xpt_bus_register to hook the SIM
4309  * into the CAM framework.  xpt_bus_register creates a cam_eb entry
4310  * for this new bus and places it in the array of busses and assigns
4311  * it a path_id.  The path_id may be influenced by "hard wiring"
4312  * information specified by the user.  Once interrupt services are
4313  * available, the bus will be probed.
4314  */
4315 int32_t
4316 xpt_bus_register(struct cam_sim *sim, device_t parent, u_int32_t bus)
4317 {
4318         struct cam_eb *new_bus;
4319         struct cam_eb *old_bus;
4320         struct ccb_pathinq cpi;
4321
4322         mtx_assert(sim->mtx, MA_OWNED);
4323
4324         sim->bus_id = bus;
4325         new_bus = (struct cam_eb *)malloc(sizeof(*new_bus),
4326                                           M_CAMXPT, M_NOWAIT);
4327         if (new_bus == NULL) {
4328                 /* Couldn't satisfy request */
4329                 return (CAM_RESRC_UNAVAIL);
4330         }
4331
4332         if (strcmp(sim->sim_name, "xpt") != 0) {
4333
4334                 sim->path_id =
4335                     xptpathid(sim->sim_name, sim->unit_number, sim->bus_id);
4336         }
4337
4338         TAILQ_INIT(&new_bus->et_entries);
4339         new_bus->path_id = sim->path_id;
4340         cam_sim_hold(sim);
4341         new_bus->sim = sim;
4342         timevalclear(&new_bus->last_reset);
4343         new_bus->flags = 0;
4344         new_bus->refcount = 1;  /* Held until a bus_deregister event */
4345         new_bus->generation = 0;
4346         mtx_lock(&xsoftc.xpt_topo_lock);
4347         old_bus = TAILQ_FIRST(&xsoftc.xpt_busses);
4348         while (old_bus != NULL
4349             && old_bus->path_id < new_bus->path_id)
4350                 old_bus = TAILQ_NEXT(old_bus, links);
4351         if (old_bus != NULL)
4352                 TAILQ_INSERT_BEFORE(old_bus, new_bus, links);
4353         else
4354                 TAILQ_INSERT_TAIL(&xsoftc.xpt_busses, new_bus, links);
4355         xsoftc.bus_generation++;
4356         mtx_unlock(&xsoftc.xpt_topo_lock);
4357
4358         /* Notify interested parties */
4359         if (sim->path_id != CAM_XPT_PATH_ID) {
4360                 struct cam_path path;
4361
4362                 xpt_compile_path(&path, /*periph*/NULL, sim->path_id,
4363                                  CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD);
4364                 xpt_setup_ccb(&cpi.ccb_h, &path, /*priority*/1);
4365                 cpi.ccb_h.func_code = XPT_PATH_INQ;
4366                 xpt_action((union ccb *)&cpi);
4367                 xpt_async(AC_PATH_REGISTERED, &path, &cpi);
4368                 xpt_release_path(&path);
4369         }
4370         return (CAM_SUCCESS);
4371 }
4372
4373 int32_t
4374 xpt_bus_deregister(path_id_t pathid)
4375 {
4376         struct cam_path bus_path;
4377         cam_status status;
4378
4379         status = xpt_compile_path(&bus_path, NULL, pathid,
4380                                   CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD);
4381         if (status != CAM_REQ_CMP)
4382                 return (status);
4383
4384         xpt_async(AC_LOST_DEVICE, &bus_path, NULL);
4385         xpt_async(AC_PATH_DEREGISTERED, &bus_path, NULL);
4386
4387         /* Release the reference count held while registered. */
4388         xpt_release_bus(bus_path.bus);
4389         xpt_release_path(&bus_path);
4390
4391         return (CAM_REQ_CMP);
4392 }
4393
4394 static path_id_t
4395 xptnextfreepathid(void)
4396 {
4397         struct cam_eb *bus;
4398         path_id_t pathid;
4399         const char *strval;
4400
4401         pathid = 0;
4402         mtx_lock(&xsoftc.xpt_topo_lock);
4403         bus = TAILQ_FIRST(&xsoftc.xpt_busses);
4404 retry:
4405         /* Find an unoccupied pathid */
4406         while (bus != NULL && bus->path_id <= pathid) {
4407                 if (bus->path_id == pathid)
4408                         pathid++;
4409                 bus = TAILQ_NEXT(bus, links);
4410         }
4411         mtx_unlock(&xsoftc.xpt_topo_lock);
4412
4413         /*
4414          * Ensure that this pathid is not reserved for
4415          * a bus that may be registered in the future.
4416          */
4417         if (resource_string_value("scbus", pathid, "at", &strval) == 0) {
4418                 ++pathid;
4419                 /* Start the search over */
4420                 mtx_lock(&xsoftc.xpt_topo_lock);
4421                 goto retry;
4422         }
4423         return (pathid);
4424 }
4425
4426 static path_id_t
4427 xptpathid(const char *sim_name, int sim_unit, int sim_bus)
4428 {
4429         path_id_t pathid;
4430         int i, dunit, val;
4431         char buf[32];
4432         const char *dname;
4433
4434         pathid = CAM_XPT_PATH_ID;
4435         snprintf(buf, sizeof(buf), "%s%d", sim_name, sim_unit);
4436         i = 0;
4437         while ((resource_find_match(&i, &dname, &dunit, "at", buf)) == 0) {
4438                 if (strcmp(dname, "scbus")) {
4439                         /* Avoid a bit of foot shooting. */
4440                         continue;
4441                 }
4442                 if (dunit < 0)          /* unwired?! */
4443                         continue;
4444                 if (resource_int_value("scbus", dunit, "bus", &val) == 0) {
4445                         if (sim_bus == val) {
4446                                 pathid = dunit;
4447                                 break;
4448                         }
4449                 } else if (sim_bus == 0) {
4450                         /* Unspecified matches bus 0 */
4451                         pathid = dunit;
4452                         break;
4453                 } else {
4454                         printf("Ambiguous scbus configuration for %s%d "
4455                                "bus %d, cannot wire down.  The kernel "
4456                                "config entry for scbus%d should "
4457                                "specify a controller bus.\n"
4458                                "Scbus will be assigned dynamically.\n",
4459                                sim_name, sim_unit, sim_bus, dunit);
4460                         break;
4461                 }
4462         }
4463
4464         if (pathid == CAM_XPT_PATH_ID)
4465                 pathid = xptnextfreepathid();
4466         return (pathid);
4467 }
4468
4469 void
4470 xpt_async(u_int32_t async_code, struct cam_path *path, void *async_arg)
4471 {
4472         struct cam_eb *bus;
4473         struct cam_et *target, *next_target;
4474         struct cam_ed *device, *next_device;
4475
4476         mtx_assert(path->bus->sim->mtx, MA_OWNED);
4477
4478         CAM_DEBUG(path, CAM_DEBUG_TRACE, ("xpt_async\n"));
4479
4480         /*
4481          * Most async events come from a CAM interrupt context.  In
4482          * a few cases, the error recovery code at the peripheral layer,
4483          * which may run from our SWI or a process context, may signal
4484          * deferred events with a call to xpt_async.
4485          */
4486
4487         bus = path->bus;
4488
4489         if (async_code == AC_BUS_RESET) {
4490                 /* Update our notion of when the last reset occurred */
4491                 microtime(&bus->last_reset);
4492         }
4493
4494         for (target = TAILQ_FIRST(&bus->et_entries);
4495              target != NULL;
4496              target = next_target) {
4497
4498                 next_target = TAILQ_NEXT(target, links);
4499
4500                 if (path->target != target
4501                  && path->target->target_id != CAM_TARGET_WILDCARD
4502                  && target->target_id != CAM_TARGET_WILDCARD)
4503                         continue;
4504
4505                 if (async_code == AC_SENT_BDR) {
4506                         /* Update our notion of when the last reset occurred */
4507                         microtime(&path->target->last_reset);
4508                 }
4509
4510                 for (device = TAILQ_FIRST(&target->ed_entries);
4511                      device != NULL;
4512                      device = next_device) {
4513
4514                         next_device = TAILQ_NEXT(device, links);
4515
4516                         if (path->device != device
4517                          && path->device->lun_id != CAM_LUN_WILDCARD
4518                          && device->lun_id != CAM_LUN_WILDCARD)
4519                                 continue;
4520
4521                         xpt_dev_async(async_code, bus, target,
4522                                       device, async_arg);
4523
4524                         xpt_async_bcast(&device->asyncs, async_code,
4525                                         path, async_arg);
4526                 }
4527         }
4528
4529         /*
4530          * If this wasn't a fully wildcarded async, tell all
4531          * clients that want all async events.
4532          */
4533         if (bus != xpt_periph->path->bus)
4534                 xpt_async_bcast(&xpt_periph->path->device->asyncs, async_code,
4535                                 path, async_arg);
4536 }
4537
4538 static void
4539 xpt_async_bcast(struct async_list *async_head,
4540                 u_int32_t async_code,
4541                 struct cam_path *path, void *async_arg)
4542 {
4543         struct async_node *cur_entry;
4544
4545         cur_entry = SLIST_FIRST(async_head);
4546         while (cur_entry != NULL) {
4547                 struct async_node *next_entry;
4548                 /*
4549                  * Grab the next list entry before we call the current
4550                  * entry's callback.  This is because the callback function
4551                  * can delete its async callback entry.
4552                  */
4553                 next_entry = SLIST_NEXT(cur_entry, links);
4554                 if ((cur_entry->event_enable & async_code) != 0)
4555                         cur_entry->callback(cur_entry->callback_arg,
4556                                             async_code, path,
4557                                             async_arg);
4558                 cur_entry = next_entry;
4559         }
4560 }
4561
4562 /*
4563  * Handle any per-device event notifications that require action by the XPT.
4564  */
4565 static void
4566 xpt_dev_async(u_int32_t async_code, struct cam_eb *bus, struct cam_et *target,
4567               struct cam_ed *device, void *async_arg)
4568 {
4569         cam_status status;
4570         struct cam_path newpath;
4571
4572         /*
4573          * We only need to handle events for real devices.
4574          */
4575         if (target->target_id == CAM_TARGET_WILDCARD
4576          || device->lun_id == CAM_LUN_WILDCARD)
4577                 return;
4578
4579         /*
4580          * We need our own path with wildcards expanded to
4581          * handle certain types of events.
4582          */
4583         if ((async_code == AC_SENT_BDR)
4584          || (async_code == AC_BUS_RESET)
4585          || (async_code == AC_INQ_CHANGED))
4586                 status = xpt_compile_path(&newpath, NULL,
4587                                           bus->path_id,
4588                                           target->target_id,
4589                                           device->lun_id);
4590         else
4591                 status = CAM_REQ_CMP_ERR;
4592
4593         if (status == CAM_REQ_CMP) {
4594
4595                 /*
4596                  * Allow transfer negotiation to occur in a
4597                  * tag free environment.
4598                  */
4599                 if (async_code == AC_SENT_BDR
4600                  || async_code == AC_BUS_RESET)
4601                         xpt_toggle_tags(&newpath);
4602
4603                 if (async_code == AC_INQ_CHANGED) {
4604                         /*
4605                          * We've sent a start unit command, or
4606                          * something similar to a device that
4607                          * may have caused its inquiry data to
4608                          * change. So we re-scan the device to
4609                          * refresh the inquiry data for it.
4610                          */
4611                         xpt_scan_lun(newpath.periph, &newpath,
4612                                      CAM_EXPECT_INQ_CHANGE, NULL);
4613                 }
4614                 xpt_release_path(&newpath);
4615         } else if (async_code == AC_LOST_DEVICE) {
4616                 device->flags |= CAM_DEV_UNCONFIGURED;
4617         } else if (async_code == AC_TRANSFER_NEG) {
4618                 struct ccb_trans_settings *settings;
4619
4620                 settings = (struct ccb_trans_settings *)async_arg;
4621                 xpt_set_transfer_settings(settings, device,
4622                                           /*async_update*/TRUE);
4623         }
4624 }
4625
4626 u_int32_t
4627 xpt_freeze_devq(struct cam_path *path, u_int count)
4628 {
4629         struct ccb_hdr *ccbh;
4630
4631         mtx_assert(path->bus->sim->mtx, MA_OWNED);
4632
4633         path->device->qfrozen_cnt += count;
4634
4635         /*
4636          * Mark the last CCB in the queue as needing
4637          * to be requeued if the driver hasn't
4638          * changed it's state yet.  This fixes a race
4639          * where a ccb is just about to be queued to
4640          * a controller driver when it's interrupt routine
4641          * freezes the queue.  To completly close the
4642          * hole, controller drives must check to see
4643          * if a ccb's status is still CAM_REQ_INPROG
4644          * just before they queue
4645          * the CCB.  See ahc_action/ahc_freeze_devq for
4646          * an example.
4647          */
4648         ccbh = TAILQ_LAST(&path->device->ccbq.active_ccbs, ccb_hdr_tailq);
4649         if (ccbh && ccbh->status == CAM_REQ_INPROG)
4650                 ccbh->status = CAM_REQUEUE_REQ;
4651         return (path->device->qfrozen_cnt);
4652 }
4653
4654 u_int32_t
4655 xpt_freeze_simq(struct cam_sim *sim, u_int count)
4656 {
4657         mtx_assert(sim->mtx, MA_OWNED);
4658
4659         sim->devq->send_queue.qfrozen_cnt += count;
4660         if (sim->devq->active_dev != NULL) {
4661                 struct ccb_hdr *ccbh;
4662
4663                 ccbh = TAILQ_LAST(&sim->devq->active_dev->ccbq.active_ccbs,
4664                                   ccb_hdr_tailq);
4665                 if (ccbh && ccbh->status == CAM_REQ_INPROG)
4666                         ccbh->status = CAM_REQUEUE_REQ;
4667         }
4668         return (sim->devq->send_queue.qfrozen_cnt);
4669 }
4670
4671 static void
4672 xpt_release_devq_timeout(void *arg)
4673 {
4674         struct cam_ed *device;
4675
4676         device = (struct cam_ed *)arg;
4677
4678         xpt_release_devq_device(device, /*count*/1, /*run_queue*/TRUE);
4679 }
4680
4681 void
4682 xpt_release_devq(struct cam_path *path, u_int count, int run_queue)
4683 {
4684         mtx_assert(path->bus->sim->mtx, MA_OWNED);
4685
4686         xpt_release_devq_device(path->device, count, run_queue);
4687 }
4688
4689 static void
4690 xpt_release_devq_device(struct cam_ed *dev, u_int count, int run_queue)
4691 {
4692         int     rundevq;
4693
4694         rundevq = 0;
4695         if (dev->qfrozen_cnt > 0) {
4696
4697                 count = (count > dev->qfrozen_cnt) ? dev->qfrozen_cnt : count;
4698                 dev->qfrozen_cnt -= count;
4699                 if (dev->qfrozen_cnt == 0) {
4700
4701                         /*
4702                          * No longer need to wait for a successful
4703                          * command completion.
4704                          */
4705                         dev->flags &= ~CAM_DEV_REL_ON_COMPLETE;
4706
4707                         /*
4708                          * Remove any timeouts that might be scheduled
4709                          * to release this queue.
4710                          */
4711                         if ((dev->flags & CAM_DEV_REL_TIMEOUT_PENDING) != 0) {
4712                                 callout_stop(&dev->callout);
4713                                 dev->flags &= ~CAM_DEV_REL_TIMEOUT_PENDING;
4714                         }
4715
4716                         /*
4717                          * Now that we are unfrozen schedule the
4718                          * device so any pending transactions are
4719                          * run.
4720                          */
4721                         if ((dev->ccbq.queue.entries > 0)
4722                          && (xpt_schedule_dev_sendq(dev->target->bus, dev))
4723                          && (run_queue != 0)) {
4724                                 rundevq = 1;
4725                         }
4726                 }
4727         }
4728         if (rundevq != 0)
4729                 xpt_run_dev_sendq(dev->target->bus);
4730 }
4731
4732 void
4733 xpt_release_simq(struct cam_sim *sim, int run_queue)
4734 {
4735         struct  camq *sendq;
4736
4737         mtx_assert(sim->mtx, MA_OWNED);
4738
4739         sendq = &(sim->devq->send_queue);
4740         if (sendq->qfrozen_cnt > 0) {
4741
4742                 sendq->qfrozen_cnt--;
4743                 if (sendq->qfrozen_cnt == 0) {
4744                         struct cam_eb *bus;
4745
4746                         /*
4747                          * If there is a timeout scheduled to release this
4748                          * sim queue, remove it.  The queue frozen count is
4749                          * already at 0.
4750                          */
4751                         if ((sim->flags & CAM_SIM_REL_TIMEOUT_PENDING) != 0){
4752                                 callout_stop(&sim->callout);
4753                                 sim->flags &= ~CAM_SIM_REL_TIMEOUT_PENDING;
4754                         }
4755                         bus = xpt_find_bus(sim->path_id);
4756
4757                         if (run_queue) {
4758                                 /*
4759                                  * Now that we are unfrozen run the send queue.
4760                                  */
4761                                 xpt_run_dev_sendq(bus);
4762                         }
4763                         xpt_release_bus(bus);
4764                 }
4765         }
4766 }
4767
4768 /*
4769  * XXX Appears to be unused.
4770  */
4771 static void
4772 xpt_release_simq_timeout(void *arg)
4773 {
4774         struct cam_sim *sim;
4775
4776         sim = (struct cam_sim *)arg;
4777         xpt_release_simq(sim, /* run_queue */ TRUE);
4778 }
4779
4780 void
4781 xpt_done(union ccb *done_ccb)
4782 {
4783         struct cam_sim *sim;
4784
4785         CAM_DEBUG(done_ccb->ccb_h.path, CAM_DEBUG_TRACE, ("xpt_done\n"));
4786         if ((done_ccb->ccb_h.func_code & XPT_FC_QUEUED) != 0) {
4787                 /*
4788                  * Queue up the request for handling by our SWI handler
4789                  * any of the "non-immediate" type of ccbs.
4790                  */
4791                 sim = done_ccb->ccb_h.path->bus->sim;
4792                 switch (done_ccb->ccb_h.path->periph->type) {
4793                 case CAM_PERIPH_BIO:
4794                         TAILQ_INSERT_TAIL(&sim->sim_doneq, &done_ccb->ccb_h,
4795                                           sim_links.tqe);
4796                         done_ccb->ccb_h.pinfo.index = CAM_DONEQ_INDEX;
4797                         if ((sim->flags & CAM_SIM_ON_DONEQ) == 0) {
4798                                 mtx_lock(&cam_simq_lock);
4799                                 TAILQ_INSERT_TAIL(&cam_simq, sim,
4800                                                   links);
4801                                 sim->flags |= CAM_SIM_ON_DONEQ;
4802                                 mtx_unlock(&cam_simq_lock);
4803                         }
4804                         if ((done_ccb->ccb_h.path->periph->flags &
4805                             CAM_PERIPH_POLLED) == 0)
4806                                 swi_sched(cambio_ih, 0);
4807                         break;
4808                 default:
4809                         panic("unknown periph type %d",
4810                             done_ccb->ccb_h.path->periph->type);
4811                 }
4812         }
4813 }
4814
4815 union ccb *
4816 xpt_alloc_ccb()
4817 {
4818         union ccb *new_ccb;
4819
4820         new_ccb = malloc(sizeof(*new_ccb), M_CAMXPT, M_ZERO|M_WAITOK);
4821         return (new_ccb);
4822 }
4823
4824 union ccb *
4825 xpt_alloc_ccb_nowait()
4826 {
4827         union ccb *new_ccb;
4828
4829         new_ccb = malloc(sizeof(*new_ccb), M_CAMXPT, M_ZERO|M_NOWAIT);
4830         return (new_ccb);
4831 }
4832
4833 void
4834 xpt_free_ccb(union ccb *free_ccb)
4835 {
4836         free(free_ccb, M_CAMXPT);
4837 }
4838
4839
4840
4841 /* Private XPT functions */
4842
4843 /*
4844  * Get a CAM control block for the caller. Charge the structure to the device
4845  * referenced by the path.  If the this device has no 'credits' then the
4846  * device already has the maximum number of outstanding operations under way
4847  * and we return NULL. If we don't have sufficient resources to allocate more
4848  * ccbs, we also return NULL.
4849  */
4850 static union ccb *
4851 xpt_get_ccb(struct cam_ed *device)
4852 {
4853         union ccb *new_ccb;
4854         struct cam_sim *sim;
4855
4856         sim = device->sim;
4857         if ((new_ccb = (union ccb *)SLIST_FIRST(&sim->ccb_freeq)) == NULL) {
4858                 new_ccb = xpt_alloc_ccb_nowait();
4859                 if (new_ccb == NULL) {
4860                         return (NULL);
4861                 }
4862                 if ((sim->flags & CAM_SIM_MPSAFE) == 0)
4863                         callout_handle_init(&new_ccb->ccb_h.timeout_ch);
4864                 SLIST_INSERT_HEAD(&sim->ccb_freeq, &new_ccb->ccb_h,
4865                                   xpt_links.sle);
4866                 sim->ccb_count++;
4867         }
4868         cam_ccbq_take_opening(&device->ccbq);
4869         SLIST_REMOVE_HEAD(&sim->ccb_freeq, xpt_links.sle);
4870         return (new_ccb);
4871 }
4872
4873 static void
4874 xpt_release_bus(struct cam_eb *bus)
4875 {
4876
4877         if ((--bus->refcount == 0)
4878          && (TAILQ_FIRST(&bus->et_entries) == NULL)) {
4879                 mtx_lock(&xsoftc.xpt_topo_lock);
4880                 TAILQ_REMOVE(&xsoftc.xpt_busses, bus, links);
4881                 xsoftc.bus_generation++;
4882                 mtx_unlock(&xsoftc.xpt_topo_lock);
4883                 cam_sim_release(bus->sim);
4884                 free(bus, M_CAMXPT);
4885         }
4886 }
4887
4888 static struct cam_et *
4889 xpt_alloc_target(struct cam_eb *bus, target_id_t target_id)
4890 {
4891         struct cam_et *target;
4892
4893         target = (struct cam_et *)malloc(sizeof(*target), M_CAMXPT, M_NOWAIT);
4894         if (target != NULL) {
4895                 struct cam_et *cur_target;
4896
4897                 TAILQ_INIT(&target->ed_entries);
4898                 target->bus = bus;
4899                 target->target_id = target_id;
4900                 target->refcount = 1;
4901                 target->generation = 0;
4902                 timevalclear(&target->last_reset);
4903                 /*
4904                  * Hold a reference to our parent bus so it
4905                  * will not go away before we do.
4906                  */
4907                 bus->refcount++;
4908
4909                 /* Insertion sort into our bus's target list */
4910                 cur_target = TAILQ_FIRST(&bus->et_entries);
4911                 while (cur_target != NULL && cur_target->target_id < target_id)
4912                         cur_target = TAILQ_NEXT(cur_target, links);
4913
4914                 if (cur_target != NULL) {
4915                         TAILQ_INSERT_BEFORE(cur_target, target, links);
4916                 } else {
4917                         TAILQ_INSERT_TAIL(&bus->et_entries, target, links);
4918                 }
4919                 bus->generation++;
4920         }
4921         return (target);
4922 }
4923
4924 static void
4925 xpt_release_target(struct cam_eb *bus, struct cam_et *target)
4926 {
4927
4928         if ((--target->refcount == 0)
4929          && (TAILQ_FIRST(&target->ed_entries) == NULL)) {
4930                 TAILQ_REMOVE(&bus->et_entries, target, links);
4931                 bus->generation++;
4932                 free(target, M_CAMXPT);
4933                 xpt_release_bus(bus);
4934         }
4935 }
4936
4937 static struct cam_ed *
4938 xpt_alloc_device(struct cam_eb *bus, struct cam_et *target, lun_id_t lun_id)
4939 {
4940         struct     cam_path path;
4941         struct     cam_ed *device;
4942         struct     cam_devq *devq;
4943         cam_status status;
4944
4945         /* Make space for us in the device queue on our bus */
4946         devq = bus->sim->devq;
4947         status = cam_devq_resize(devq, devq->alloc_queue.array_size + 1);
4948
4949         if (status != CAM_REQ_CMP) {
4950                 device = NULL;
4951         } else {
4952                 device = (struct cam_ed *)malloc(sizeof(*device),
4953                                                  M_CAMXPT, M_NOWAIT);
4954         }
4955
4956         if (device != NULL) {
4957                 struct cam_ed *cur_device;
4958
4959                 cam_init_pinfo(&device->alloc_ccb_entry.pinfo);
4960                 device->alloc_ccb_entry.device = device;
4961                 cam_init_pinfo(&device->send_ccb_entry.pinfo);
4962                 device->send_ccb_entry.device = device;
4963                 device->target = target;
4964                 device->lun_id = lun_id;
4965                 device->sim = bus->sim;
4966                 /* Initialize our queues */
4967                 if (camq_init(&device->drvq, 0) != 0) {
4968                         free(device, M_CAMXPT);
4969                         return (NULL);
4970                 }
4971                 if (cam_ccbq_init(&device->ccbq,
4972                                   bus->sim->max_dev_openings) != 0) {
4973                         camq_fini(&device->drvq);
4974                         free(device, M_CAMXPT);
4975                         return (NULL);
4976                 }
4977                 SLIST_INIT(&device->asyncs);
4978                 SLIST_INIT(&device->periphs);
4979                 device->generation = 0;
4980                 device->owner = NULL;
4981                 /*
4982                  * Take the default quirk entry until we have inquiry
4983                  * data and can determine a better quirk to use.
4984                  */
4985                 device->quirk = &xpt_quirk_table[xpt_quirk_table_size - 1];
4986                 bzero(&device->inq_data, sizeof(device->inq_data));
4987                 device->inq_flags = 0;
4988                 device->queue_flags = 0;
4989                 device->serial_num = NULL;
4990                 device->serial_num_len = 0;
4991                 device->qfrozen_cnt = 0;
4992                 device->flags = CAM_DEV_UNCONFIGURED;
4993                 device->tag_delay_count = 0;
4994                 device->tag_saved_openings = 0;
4995                 device->refcount = 1;
4996                 if (bus->sim->flags & CAM_SIM_MPSAFE)
4997                         callout_init_mtx(&device->callout, bus->sim->mtx, 0);
4998                 else
4999                         callout_init_mtx(&device->callout, &Giant, 0);
5000
5001                 /*
5002                  * Hold a reference to our parent target so it
5003                  * will not go away before we do.
5004                  */
5005                 target->refcount++;
5006
5007                 /*
5008                  * XXX should be limited by number of CCBs this bus can
5009                  * do.
5010                  */
5011                 bus->sim->max_ccbs += device->ccbq.devq_openings;
5012                 /* Insertion sort into our target's device list */
5013                 cur_device = TAILQ_FIRST(&target->ed_entries);
5014                 while (cur_device != NULL && cur_device->lun_id < lun_id)
5015                         cur_device = TAILQ_NEXT(cur_device, links);
5016                 if (cur_device != NULL) {
5017                         TAILQ_INSERT_BEFORE(cur_device, device, links);
5018                 } else {
5019                         TAILQ_INSERT_TAIL(&target->ed_entries, device, links);
5020                 }
5021                 target->generation++;
5022                 if (lun_id != CAM_LUN_WILDCARD) {
5023                         xpt_compile_path(&path,
5024                                          NULL,
5025                                          bus->path_id,
5026                                          target->target_id,
5027                                          lun_id);
5028                         xpt_devise_transport(&path);
5029                         xpt_release_path(&path);
5030                 }
5031         }
5032         return (device);
5033 }
5034
5035 static void
5036 xpt_release_device(struct cam_eb *bus, struct cam_et *target,
5037                    struct cam_ed *device)
5038 {
5039
5040         if ((--device->refcount == 0)
5041          && ((device->flags & CAM_DEV_UNCONFIGURED) != 0)) {
5042                 struct cam_devq *devq;
5043
5044                 if (device->alloc_ccb_entry.pinfo.index != CAM_UNQUEUED_INDEX
5045                  || device->send_ccb_entry.pinfo.index != CAM_UNQUEUED_INDEX)
5046                         panic("Removing device while still queued for ccbs");
5047
5048                 if ((device->flags & CAM_DEV_REL_TIMEOUT_PENDING) != 0)
5049                                 callout_stop(&device->callout);
5050
5051                 TAILQ_REMOVE(&target->ed_entries, device,links);
5052                 target->generation++;
5053                 bus->sim->max_ccbs -= device->ccbq.devq_openings;
5054                 /* Release our slot in the devq */
5055                 devq = bus->sim->devq;
5056                 cam_devq_resize(devq, devq->alloc_queue.array_size - 1);
5057                 camq_fini(&device->drvq);
5058                 camq_fini(&device->ccbq.queue);
5059                 free(device, M_CAMXPT);
5060                 xpt_release_target(bus, target);
5061         }
5062 }
5063
5064 static u_int32_t
5065 xpt_dev_ccbq_resize(struct cam_path *path, int newopenings)
5066 {
5067         int     diff;
5068         int     result;
5069         struct  cam_ed *dev;
5070
5071         dev = path->device;
5072
5073         diff = newopenings - (dev->ccbq.dev_active + dev->ccbq.dev_openings);
5074         result = cam_ccbq_resize(&dev->ccbq, newopenings);
5075         if (result == CAM_REQ_CMP && (diff < 0)) {
5076                 dev->flags |= CAM_DEV_RESIZE_QUEUE_NEEDED;
5077         }
5078         if ((dev->flags & CAM_DEV_TAG_AFTER_COUNT) != 0
5079          || (dev->inq_flags & SID_CmdQue) != 0)
5080                 dev->tag_saved_openings = newopenings;
5081         /* Adjust the global limit */
5082         dev->sim->max_ccbs += diff;
5083         return (result);
5084 }
5085
5086 static struct cam_eb *
5087 xpt_find_bus(path_id_t path_id)
5088 {
5089         struct cam_eb *bus;
5090
5091         mtx_lock(&xsoftc.xpt_topo_lock);
5092         for (bus = TAILQ_FIRST(&xsoftc.xpt_busses);
5093              bus != NULL;
5094              bus = TAILQ_NEXT(bus, links)) {
5095                 if (bus->path_id == path_id) {
5096                         bus->refcount++;
5097                         break;
5098                 }
5099         }
5100         mtx_unlock(&xsoftc.xpt_topo_lock);
5101         return (bus);
5102 }
5103
5104 static struct cam_et *
5105 xpt_find_target(struct cam_eb *bus, target_id_t target_id)
5106 {
5107         struct cam_et *target;
5108
5109         for (target = TAILQ_FIRST(&bus->et_entries);
5110              target != NULL;
5111              target = TAILQ_NEXT(target, links)) {
5112                 if (target->target_id == target_id) {
5113                         target->refcount++;
5114                         break;
5115                 }
5116         }
5117         return (target);
5118 }
5119
5120 static struct cam_ed *
5121 xpt_find_device(struct cam_et *target, lun_id_t lun_id)
5122 {
5123         struct cam_ed *device;
5124
5125         for (device = TAILQ_FIRST(&target->ed_entries);
5126              device != NULL;
5127              device = TAILQ_NEXT(device, links)) {
5128                 if (device->lun_id == lun_id) {
5129                         device->refcount++;
5130                         break;
5131                 }
5132         }
5133         return (device);
5134 }
5135
5136 typedef struct {
5137         union   ccb *request_ccb;
5138         struct  ccb_pathinq *cpi;
5139         int     counter;
5140 } xpt_scan_bus_info;
5141
5142 /*
5143  * To start a scan, request_ccb is an XPT_SCAN_BUS ccb.
5144  * As the scan progresses, xpt_scan_bus is used as the
5145  * callback on completion function.
5146  */
5147 static void
5148 xpt_scan_bus(struct cam_periph *periph, union ccb *request_ccb)
5149 {
5150         CAM_DEBUG(request_ccb->ccb_h.path, CAM_DEBUG_TRACE,
5151                   ("xpt_scan_bus\n"));
5152         switch (request_ccb->ccb_h.func_code) {
5153         case XPT_SCAN_BUS:
5154         {
5155                 xpt_scan_bus_info *scan_info;
5156                 union   ccb *work_ccb;
5157                 struct  cam_path *path;
5158                 u_int   i;
5159                 u_int   max_target;
5160                 u_int   initiator_id;
5161
5162                 /* Find out the characteristics of the bus */
5163                 work_ccb = xpt_alloc_ccb_nowait();
5164                 if (work_ccb == NULL) {
5165                         request_ccb->ccb_h.status = CAM_RESRC_UNAVAIL;
5166                         xpt_done(request_ccb);
5167                         return;
5168                 }
5169                 xpt_setup_ccb(&work_ccb->ccb_h, request_ccb->ccb_h.path,
5170                               request_ccb->ccb_h.pinfo.priority);
5171                 work_ccb->ccb_h.func_code = XPT_PATH_INQ;
5172                 xpt_action(work_ccb);
5173                 if (work_ccb->ccb_h.status != CAM_REQ_CMP) {
5174                         request_ccb->ccb_h.status = work_ccb->ccb_h.status;
5175                         xpt_free_ccb(work_ccb);
5176                         xpt_done(request_ccb);
5177                         return;
5178                 }
5179
5180                 if ((work_ccb->cpi.hba_misc & PIM_NOINITIATOR) != 0) {
5181                         /*
5182                          * Can't scan the bus on an adapter that
5183                          * cannot perform the initiator role.
5184                          */
5185                         request_ccb->ccb_h.status = CAM_REQ_CMP;
5186                         xpt_free_ccb(work_ccb);
5187                         xpt_done(request_ccb);
5188                         return;
5189                 }
5190
5191                 /* Save some state for use while we probe for devices */
5192                 scan_info = (xpt_scan_bus_info *)
5193                     malloc(sizeof(xpt_scan_bus_info), M_CAMXPT, M_NOWAIT);
5194                 scan_info->request_ccb = request_ccb;
5195                 scan_info->cpi = &work_ccb->cpi;
5196
5197                 /* Cache on our stack so we can work asynchronously */
5198                 max_target = scan_info->cpi->max_target;
5199                 initiator_id = scan_info->cpi->initiator_id;
5200
5201
5202                 /*
5203                  * We can scan all targets in parallel, or do it sequentially.
5204                  */
5205                 if (scan_info->cpi->hba_misc & PIM_SEQSCAN) {
5206                         max_target = 0;
5207                         scan_info->counter = 0;
5208                 } else {
5209                         scan_info->counter = scan_info->cpi->max_target + 1;
5210                         if (scan_info->cpi->initiator_id < scan_info->counter) {
5211                                 scan_info->counter--;
5212                         }
5213                 }
5214
5215                 for (i = 0; i <= max_target; i++) {
5216                         cam_status status;
5217                         if (i == initiator_id)
5218                                 continue;
5219
5220                         status = xpt_create_path(&path, xpt_periph,
5221                                                  request_ccb->ccb_h.path_id,
5222                                                  i, 0);
5223                         if (status != CAM_REQ_CMP) {
5224                                 printf("xpt_scan_bus: xpt_create_path failed"
5225                                        " with status %#x, bus scan halted\n",
5226                                        status);
5227                                 free(scan_info, M_CAMXPT);
5228                                 request_ccb->ccb_h.status = status;
5229                                 xpt_free_ccb(work_ccb);
5230                                 xpt_done(request_ccb);
5231                                 break;
5232                         }
5233                         work_ccb = xpt_alloc_ccb_nowait();
5234                         if (work_ccb == NULL) {
5235                                 free(scan_info, M_CAMXPT);
5236                                 xpt_free_path(path);
5237                                 request_ccb->ccb_h.status = CAM_RESRC_UNAVAIL;
5238                                 xpt_done(request_ccb);
5239                                 break;
5240                         }
5241                         xpt_setup_ccb(&work_ccb->ccb_h, path,
5242                                       request_ccb->ccb_h.pinfo.priority);
5243                         work_ccb->ccb_h.func_code = XPT_SCAN_LUN;
5244                         work_ccb->ccb_h.cbfcnp = xpt_scan_bus;
5245                         work_ccb->ccb_h.ppriv_ptr0 = scan_info;
5246                         work_ccb->crcn.flags = request_ccb->crcn.flags;
5247                         xpt_action(work_ccb);
5248                 }
5249                 break;
5250         }
5251         case XPT_SCAN_LUN:
5252         {
5253                 cam_status status;
5254                 struct cam_path *path;
5255                 xpt_scan_bus_info *scan_info;
5256                 path_id_t path_id;
5257                 target_id_t target_id;
5258                 lun_id_t lun_id;
5259
5260                 /* Reuse the same CCB to query if a device was really found */
5261                 scan_info = (xpt_scan_bus_info *)request_ccb->ccb_h.ppriv_ptr0;
5262                 xpt_setup_ccb(&request_ccb->ccb_h, request_ccb->ccb_h.path,
5263                               request_ccb->ccb_h.pinfo.priority);
5264                 request_ccb->ccb_h.func_code = XPT_GDEV_TYPE;
5265
5266                 path_id = request_ccb->ccb_h.path_id;
5267                 target_id = request_ccb->ccb_h.target_id;
5268                 lun_id = request_ccb->ccb_h.target_lun;
5269                 xpt_action(request_ccb);
5270
5271                 if (request_ccb->ccb_h.status != CAM_REQ_CMP) {
5272                         struct cam_ed *device;
5273                         struct cam_et *target;
5274                         int phl;
5275
5276                         /*
5277                          * If we already probed lun 0 successfully, or
5278                          * we have additional configured luns on this
5279                          * target that might have "gone away", go onto
5280                          * the next lun.
5281                          */
5282                         target = request_ccb->ccb_h.path->target;
5283                         /*
5284                          * We may touch devices that we don't
5285                          * hold references too, so ensure they
5286                          * don't disappear out from under us.
5287                          * The target above is referenced by the
5288                          * path in the request ccb.
5289                          */
5290                         phl = 0;
5291                         device = TAILQ_FIRST(&target->ed_entries);
5292                         if (device != NULL) {
5293                                 phl = CAN_SRCH_HI_SPARSE(device);
5294                                 if (device->lun_id == 0)
5295                                         device = TAILQ_NEXT(device, links);
5296                         }
5297                         if ((lun_id != 0) || (device != NULL)) {
5298                                 if (lun_id < (CAM_SCSI2_MAXLUN-1) || phl)
5299                                         lun_id++;
5300                         }
5301                 } else {
5302                         struct cam_ed *device;
5303
5304                         device = request_ccb->ccb_h.path->device;
5305
5306                         if ((device->quirk->quirks & CAM_QUIRK_NOLUNS) == 0) {
5307                                 /* Try the next lun */
5308                                 if (lun_id < (CAM_SCSI2_MAXLUN-1)
5309                                   || CAN_SRCH_HI_DENSE(device))
5310                                         lun_id++;
5311                         }
5312                 }
5313
5314                 /*
5315                  * Free the current request path- we're done with it.
5316                  */
5317                 xpt_free_path(request_ccb->ccb_h.path);
5318
5319                 /*
5320                  * Check to see if we scan any further luns.
5321                  */
5322                 if (lun_id == request_ccb->ccb_h.target_lun
5323                  || lun_id > scan_info->cpi->max_lun) {
5324                         int done;
5325
5326  hop_again:
5327                         done = 0;
5328                         if (scan_info->cpi->hba_misc & PIM_SEQSCAN) {
5329                                 scan_info->counter++;
5330                                 if (scan_info->counter ==
5331                                     scan_info->cpi->initiator_id) {
5332                                         scan_info->counter++;
5333                                 }
5334                                 if (scan_info->counter >=
5335                                     scan_info->cpi->max_target+1) {
5336                                         done = 1;
5337                                 }
5338                         } else {
5339                                 scan_info->counter--;
5340                                 if (scan_info->counter == 0) {
5341                                         done = 1;
5342                                 }
5343                         }
5344                         if (done) {
5345                                 xpt_free_ccb(request_ccb);
5346                                 xpt_free_ccb((union ccb *)scan_info->cpi);
5347                                 request_ccb = scan_info->request_ccb;
5348                                 free(scan_info, M_CAMXPT);
5349                                 request_ccb->ccb_h.status = CAM_REQ_CMP;
5350                                 xpt_done(request_ccb);
5351                                 break;
5352                         }
5353
5354                         if ((scan_info->cpi->hba_misc & PIM_SEQSCAN) == 0) {
5355                                 break;
5356                         }
5357                         status = xpt_create_path(&path, xpt_periph,
5358                             scan_info->request_ccb->ccb_h.path_id,
5359                             scan_info->counter, 0);
5360                         if (status != CAM_REQ_CMP) {
5361                                 printf("xpt_scan_bus: xpt_create_path failed"
5362                                     " with status %#x, bus scan halted\n",
5363                                     status);
5364                                 xpt_free_ccb(request_ccb);
5365                                 xpt_free_ccb((union ccb *)scan_info->cpi);
5366                                 request_ccb = scan_info->request_ccb;
5367                                 free(scan_info, M_CAMXPT);
5368                                 request_ccb->ccb_h.status = status;
5369                                 xpt_done(request_ccb);
5370                                 break;
5371                         }
5372                         xpt_setup_ccb(&request_ccb->ccb_h, path,
5373                             request_ccb->ccb_h.pinfo.priority);
5374                         request_ccb->ccb_h.func_code = XPT_SCAN_LUN;
5375                         request_ccb->ccb_h.cbfcnp = xpt_scan_bus;
5376                         request_ccb->ccb_h.ppriv_ptr0 = scan_info;
5377                         request_ccb->crcn.flags =
5378                             scan_info->request_ccb->crcn.flags;
5379                 } else {
5380                         status = xpt_create_path(&path, xpt_periph,
5381                                                  path_id, target_id, lun_id);
5382                         if (status != CAM_REQ_CMP) {
5383                                 printf("xpt_scan_bus: xpt_create_path failed "
5384                                        "with status %#x, halting LUN scan\n",
5385                                        status);
5386                                 goto hop_again;
5387                         }
5388                         xpt_setup_ccb(&request_ccb->ccb_h, path,
5389                                       request_ccb->ccb_h.pinfo.priority);
5390                         request_ccb->ccb_h.func_code = XPT_SCAN_LUN;
5391                         request_ccb->ccb_h.cbfcnp = xpt_scan_bus;
5392                         request_ccb->ccb_h.ppriv_ptr0 = scan_info;
5393                         request_ccb->crcn.flags =
5394                                 scan_info->request_ccb->crcn.flags;
5395                 }
5396                 xpt_action(request_ccb);
5397                 break;
5398         }
5399         default:
5400                 break;
5401         }
5402 }
5403
5404 typedef enum {
5405         PROBE_TUR,
5406         PROBE_INQUIRY,  /* this counts as DV0 for Basic Domain Validation */
5407         PROBE_FULL_INQUIRY,
5408         PROBE_MODE_SENSE,
5409         PROBE_SERIAL_NUM_0,
5410         PROBE_SERIAL_NUM_1,
5411         PROBE_TUR_FOR_NEGOTIATION,
5412         PROBE_INQUIRY_BASIC_DV1,
5413         PROBE_INQUIRY_BASIC_DV2,
5414         PROBE_DV_EXIT
5415 } probe_action;
5416
5417 typedef enum {
5418         PROBE_INQUIRY_CKSUM     = 0x01,
5419         PROBE_SERIAL_CKSUM      = 0x02,
5420         PROBE_NO_ANNOUNCE       = 0x04
5421 } probe_flags;
5422
5423 typedef struct {
5424         TAILQ_HEAD(, ccb_hdr) request_ccbs;
5425         probe_action    action;
5426         union ccb       saved_ccb;
5427         probe_flags     flags;
5428         MD5_CTX         context;
5429         u_int8_t        digest[16];
5430 } probe_softc;
5431
5432 static void
5433 xpt_scan_lun(struct cam_periph *periph, struct cam_path *path,
5434              cam_flags flags, union ccb *request_ccb)
5435 {
5436         struct ccb_pathinq cpi;
5437         cam_status status;
5438         struct cam_path *new_path;
5439         struct cam_periph *old_periph;
5440
5441         CAM_DEBUG(request_ccb->ccb_h.path, CAM_DEBUG_TRACE,
5442                   ("xpt_scan_lun\n"));
5443
5444         xpt_setup_ccb(&cpi.ccb_h, path, /*priority*/1);
5445         cpi.ccb_h.func_code = XPT_PATH_INQ;
5446         xpt_action((union ccb *)&cpi);
5447
5448         if (cpi.ccb_h.status != CAM_REQ_CMP) {
5449                 if (request_ccb != NULL) {
5450                         request_ccb->ccb_h.status = cpi.ccb_h.status;
5451                         xpt_done(request_ccb);
5452                 }
5453                 return;
5454         }
5455
5456         if ((cpi.hba_misc & PIM_NOINITIATOR) != 0) {
5457                 /*
5458                  * Can't scan the bus on an adapter that
5459                  * cannot perform the initiator role.
5460                  */
5461                 if (request_ccb != NULL) {
5462                         request_ccb->ccb_h.status = CAM_REQ_CMP;
5463                         xpt_done(request_ccb);
5464                 }
5465                 return;
5466         }
5467
5468         if (request_ccb == NULL) {
5469                 request_ccb = malloc(sizeof(union ccb), M_CAMXPT, M_NOWAIT);
5470                 if (request_ccb == NULL) {
5471                         xpt_print(path, "xpt_scan_lun: can't allocate CCB, "
5472                             "can't continue\n");
5473                         return;
5474                 }
5475                 new_path = malloc(sizeof(*new_path), M_CAMXPT, M_NOWAIT);
5476                 if (new_path == NULL) {
5477                         xpt_print(path, "xpt_scan_lun: can't allocate path, "
5478                             "can't continue\n");
5479                         free(request_ccb, M_CAMXPT);
5480                         return;
5481                 }
5482                 status = xpt_compile_path(new_path, xpt_periph,
5483                                           path->bus->path_id,
5484                                           path->target->target_id,
5485                                           path->device->lun_id);
5486
5487                 if (status != CAM_REQ_CMP) {
5488                         xpt_print(path, "xpt_scan_lun: can't compile path, "
5489                             "can't continue\n");
5490                         free(request_ccb, M_CAMXPT);
5491                         free(new_path, M_CAMXPT);
5492                         return;
5493                 }
5494                 xpt_setup_ccb(&request_ccb->ccb_h, new_path, /*priority*/ 1);
5495                 request_ccb->ccb_h.cbfcnp = xptscandone;
5496                 request_ccb->ccb_h.func_code = XPT_SCAN_LUN;
5497                 request_ccb->crcn.flags = flags;
5498         }
5499
5500         if ((old_periph = cam_periph_find(path, "probe")) != NULL) {
5501                 probe_softc *softc;
5502
5503                 softc = (probe_softc *)old_periph->softc;
5504                 TAILQ_INSERT_TAIL(&softc->request_ccbs, &request_ccb->ccb_h,
5505                                   periph_links.tqe);
5506         } else {
5507                 status = cam_periph_alloc(proberegister, NULL, probecleanup,
5508                                           probestart, "probe",
5509                                           CAM_PERIPH_BIO,
5510                                           request_ccb->ccb_h.path, NULL, 0,
5511                                           request_ccb);
5512
5513                 if (status != CAM_REQ_CMP) {
5514                         xpt_print(path, "xpt_scan_lun: cam_alloc_periph "
5515                             "returned an error, can't continue probe\n");
5516                         request_ccb->ccb_h.status = status;
5517                         xpt_done(request_ccb);
5518                 }
5519         }
5520 }
5521
5522 static void
5523 xptscandone(struct cam_periph *periph, union ccb *done_ccb)
5524 {
5525         xpt_release_path(done_ccb->ccb_h.path);
5526         free(done_ccb->ccb_h.path, M_CAMXPT);
5527         free(done_ccb, M_CAMXPT);
5528 }
5529
5530 static cam_status
5531 proberegister(struct cam_periph *periph, void *arg)
5532 {
5533         union ccb *request_ccb; /* CCB representing the probe request */
5534         cam_status status;
5535         probe_softc *softc;
5536
5537         request_ccb = (union ccb *)arg;
5538         if (periph == NULL) {
5539                 printf("proberegister: periph was NULL!!\n");
5540                 return(CAM_REQ_CMP_ERR);
5541         }
5542
5543         if (request_ccb == NULL) {
5544                 printf("proberegister: no probe CCB, "
5545                        "can't register device\n");
5546                 return(CAM_REQ_CMP_ERR);
5547         }
5548
5549         softc = (probe_softc *)malloc(sizeof(*softc), M_CAMXPT, M_NOWAIT);
5550
5551         if (softc == NULL) {
5552                 printf("proberegister: Unable to probe new device. "
5553                        "Unable to allocate softc\n");
5554                 return(CAM_REQ_CMP_ERR);
5555         }
5556         TAILQ_INIT(&softc->request_ccbs);
5557         TAILQ_INSERT_TAIL(&softc->request_ccbs, &request_ccb->ccb_h,
5558                           periph_links.tqe);
5559         softc->flags = 0;
5560         periph->softc = softc;
5561         status = cam_periph_acquire(periph);
5562         if (status != CAM_REQ_CMP) {
5563                 return (status);
5564         }
5565
5566
5567         /*
5568          * Ensure we've waited at least a bus settle
5569          * delay before attempting to probe the device.
5570          * For HBAs that don't do bus resets, this won't make a difference.
5571          */
5572         cam_periph_freeze_after_event(periph, &periph->path->bus->last_reset,
5573                                       scsi_delay);
5574         probeschedule(periph);
5575         return(CAM_REQ_CMP);
5576 }
5577
5578 static void
5579 probeschedule(struct cam_periph *periph)
5580 {
5581         struct ccb_pathinq cpi;
5582         union ccb *ccb;
5583         probe_softc *softc;
5584
5585         softc = (probe_softc *)periph->softc;
5586         ccb = (union ccb *)TAILQ_FIRST(&softc->request_ccbs);
5587
5588         xpt_setup_ccb(&cpi.ccb_h, periph->path, /*priority*/1);
5589         cpi.ccb_h.func_code = XPT_PATH_INQ;
5590         xpt_action((union ccb *)&cpi);
5591
5592         /*
5593          * If a device has gone away and another device, or the same one,
5594          * is back in the same place, it should have a unit attention
5595          * condition pending.  It will not report the unit attention in
5596          * response to an inquiry, which may leave invalid transfer
5597          * negotiations in effect.  The TUR will reveal the unit attention
5598          * condition.  Only send the TUR for lun 0, since some devices
5599          * will get confused by commands other than inquiry to non-existent
5600          * luns.  If you think a device has gone away start your scan from
5601          * lun 0.  This will insure that any bogus transfer settings are
5602          * invalidated.
5603          *
5604          * If we haven't seen the device before and the controller supports
5605          * some kind of transfer negotiation, negotiate with the first
5606          * sent command if no bus reset was performed at startup.  This
5607          * ensures that the device is not confused by transfer negotiation
5608          * settings left over by loader or BIOS action.
5609          */
5610         if (((ccb->ccb_h.path->device->flags & CAM_DEV_UNCONFIGURED) == 0)
5611          && (ccb->ccb_h.target_lun == 0)) {
5612                 softc->action = PROBE_TUR;
5613         } else if ((cpi.hba_inquiry & (PI_WIDE_32|PI_WIDE_16|PI_SDTR_ABLE)) != 0
5614               && (cpi.hba_misc & PIM_NOBUSRESET) != 0) {
5615                 proberequestdefaultnegotiation(periph);
5616                 softc->action = PROBE_INQUIRY;
5617         } else {
5618                 softc->action = PROBE_INQUIRY;
5619         }
5620
5621         if (ccb->crcn.flags & CAM_EXPECT_INQ_CHANGE)
5622                 softc->flags |= PROBE_NO_ANNOUNCE;
5623         else
5624                 softc->flags &= ~PROBE_NO_ANNOUNCE;
5625
5626         xpt_schedule(periph, ccb->ccb_h.pinfo.priority);
5627 }
5628
5629 static void
5630 probestart(struct cam_periph *periph, union ccb *start_ccb)
5631 {
5632         /* Probe the device that our peripheral driver points to */
5633         struct ccb_scsiio *csio;
5634         probe_softc *softc;
5635
5636         CAM_DEBUG(start_ccb->ccb_h.path, CAM_DEBUG_TRACE, ("probestart\n"));
5637
5638         softc = (probe_softc *)periph->softc;
5639         csio = &start_ccb->csio;
5640
5641         switch (softc->action) {
5642         case PROBE_TUR:
5643         case PROBE_TUR_FOR_NEGOTIATION:
5644         case PROBE_DV_EXIT:
5645         {
5646                 scsi_test_unit_ready(csio,
5647                                      /*retries*/10,
5648                                      probedone,
5649                                      MSG_SIMPLE_Q_TAG,
5650                                      SSD_FULL_SIZE,
5651                                      /*timeout*/60000);
5652                 break;
5653         }
5654         case PROBE_INQUIRY:
5655         case PROBE_FULL_INQUIRY:
5656         case PROBE_INQUIRY_BASIC_DV1:
5657         case PROBE_INQUIRY_BASIC_DV2:
5658         {
5659                 u_int inquiry_len;
5660                 struct scsi_inquiry_data *inq_buf;
5661
5662                 inq_buf = &periph->path->device->inq_data;
5663
5664                 /*
5665                  * If the device is currently configured, we calculate an
5666                  * MD5 checksum of the inquiry data, and if the serial number
5667                  * length is greater than 0, add the serial number data
5668                  * into the checksum as well.  Once the inquiry and the
5669                  * serial number check finish, we attempt to figure out
5670                  * whether we still have the same device.
5671                  */
5672                 if ((periph->path->device->flags & CAM_DEV_UNCONFIGURED) == 0) {
5673
5674                         MD5Init(&softc->context);
5675                         MD5Update(&softc->context, (unsigned char *)inq_buf,
5676                                   sizeof(struct scsi_inquiry_data));
5677                         softc->flags |= PROBE_INQUIRY_CKSUM;
5678                         if (periph->path->device->serial_num_len > 0) {
5679                                 MD5Update(&softc->context,
5680                                           periph->path->device->serial_num,
5681                                           periph->path->device->serial_num_len);
5682                                 softc->flags |= PROBE_SERIAL_CKSUM;
5683                         }
5684                         MD5Final(softc->digest, &softc->context);
5685                 }
5686
5687                 if (softc->action == PROBE_INQUIRY)
5688                         inquiry_len = SHORT_INQUIRY_LENGTH;
5689                 else
5690                         inquiry_len = SID_ADDITIONAL_LENGTH(inq_buf);
5691
5692                 /*
5693                  * Some parallel SCSI devices fail to send an
5694                  * ignore wide residue message when dealing with
5695                  * odd length inquiry requests.  Round up to be
5696                  * safe.
5697                  */
5698                 inquiry_len = roundup2(inquiry_len, 2);
5699
5700                 if (softc->action == PROBE_INQUIRY_BASIC_DV1
5701                  || softc->action == PROBE_INQUIRY_BASIC_DV2) {
5702                         inq_buf = malloc(inquiry_len, M_CAMXPT, M_NOWAIT);
5703                 }
5704                 if (inq_buf == NULL) {
5705                         xpt_print(periph->path, "malloc failure- skipping Basic"
5706                             "Domain Validation\n");
5707                         softc->action = PROBE_DV_EXIT;
5708                         scsi_test_unit_ready(csio,
5709                                              /*retries*/4,
5710                                              probedone,
5711                                              MSG_SIMPLE_Q_TAG,
5712                                              SSD_FULL_SIZE,
5713                                              /*timeout*/60000);
5714                         break;
5715                 }
5716                 scsi_inquiry(csio,
5717                              /*retries*/4,
5718                              probedone,
5719                              MSG_SIMPLE_Q_TAG,
5720                              (u_int8_t *)inq_buf,
5721                              inquiry_len,
5722                              /*evpd*/FALSE,
5723                              /*page_code*/0,
5724                              SSD_MIN_SIZE,
5725                              /*timeout*/60 * 1000);
5726                 break;
5727         }
5728         case PROBE_MODE_SENSE:
5729         {
5730                 void  *mode_buf;
5731                 int    mode_buf_len;
5732
5733                 mode_buf_len = sizeof(struct scsi_mode_header_6)
5734                              + sizeof(struct scsi_mode_blk_desc)
5735                              + sizeof(struct scsi_control_page);
5736                 mode_buf = malloc(mode_buf_len, M_CAMXPT, M_NOWAIT);
5737                 if (mode_buf != NULL) {
5738                         scsi_mode_sense(csio,
5739                                         /*retries*/4,
5740                                         probedone,
5741                                         MSG_SIMPLE_Q_TAG,
5742                                         /*dbd*/FALSE,
5743                                         SMS_PAGE_CTRL_CURRENT,
5744                                         SMS_CONTROL_MODE_PAGE,
5745                                         mode_buf,
5746                                         mode_buf_len,
5747                                         SSD_FULL_SIZE,
5748                                         /*timeout*/60000);
5749                         break;
5750                 }
5751                 xpt_print(periph->path, "Unable to mode sense control page - "
5752                     "malloc failure\n");
5753                 softc->action = PROBE_SERIAL_NUM_0;
5754         }
5755         /* FALLTHROUGH */
5756         case PROBE_SERIAL_NUM_0:
5757         {
5758                 struct scsi_vpd_supported_page_list *vpd_list = NULL;
5759                 struct cam_ed *device;
5760
5761                 device = periph->path->device;
5762                 if ((device->quirk->quirks & CAM_QUIRK_NOSERIAL) == 0) {
5763                         vpd_list = malloc(sizeof(*vpd_list), M_CAMXPT,
5764                             M_NOWAIT | M_ZERO);
5765                 }
5766
5767                 if (vpd_list != NULL) {
5768                         scsi_inquiry(csio,
5769                                      /*retries*/4,
5770                                      probedone,
5771                                      MSG_SIMPLE_Q_TAG,
5772                                      (u_int8_t *)vpd_list,
5773                                      sizeof(*vpd_list),
5774                                      /*evpd*/TRUE,
5775                                      SVPD_SUPPORTED_PAGE_LIST,
5776                                      SSD_MIN_SIZE,
5777                                      /*timeout*/60 * 1000);
5778                         break;
5779                 }
5780                 /*
5781                  * We'll have to do without, let our probedone
5782                  * routine finish up for us.
5783                  */
5784                 start_ccb->csio.data_ptr = NULL;
5785                 probedone(periph, start_ccb);
5786                 return;
5787         }
5788         case PROBE_SERIAL_NUM_1:
5789         {
5790                 struct scsi_vpd_unit_serial_number *serial_buf;
5791                 struct cam_ed* device;
5792
5793                 serial_buf = NULL;
5794                 device = periph->path->device;
5795                 device->serial_num = NULL;
5796                 device->serial_num_len = 0;
5797
5798                 serial_buf = (struct scsi_vpd_unit_serial_number *)
5799                         malloc(sizeof(*serial_buf), M_CAMXPT, M_NOWAIT|M_ZERO);
5800
5801                 if (serial_buf != NULL) {
5802                         scsi_inquiry(csio,
5803                                      /*retries*/4,
5804                                      probedone,
5805                                      MSG_SIMPLE_Q_TAG,
5806                                      (u_int8_t *)serial_buf,
5807                                      sizeof(*serial_buf),
5808                                      /*evpd*/TRUE,
5809                                      SVPD_UNIT_SERIAL_NUMBER,
5810                                      SSD_MIN_SIZE,
5811                                      /*timeout*/60 * 1000);
5812                         break;
5813                 }
5814                 /*
5815                  * We'll have to do without, let our probedone
5816                  * routine finish up for us.
5817                  */
5818                 start_ccb->csio.data_ptr = NULL;
5819                 probedone(periph, start_ccb);
5820                 return;
5821         }
5822         }
5823         xpt_action(start_ccb);
5824 }
5825
5826 static void
5827 proberequestdefaultnegotiation(struct cam_periph *periph)
5828 {
5829         struct ccb_trans_settings cts;
5830
5831         xpt_setup_ccb(&cts.ccb_h, periph->path, /*priority*/1);
5832         cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS;
5833         cts.type = CTS_TYPE_USER_SETTINGS;
5834         xpt_action((union ccb *)&cts);
5835         if ((cts.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
5836                 return;
5837         }
5838         cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS;
5839         cts.type = CTS_TYPE_CURRENT_SETTINGS;
5840         xpt_action((union ccb *)&cts);
5841 }
5842
5843 /*
5844  * Backoff Negotiation Code- only pertinent for SPI devices.
5845  */
5846 static int
5847 proberequestbackoff(struct cam_periph *periph, struct cam_ed *device)
5848 {
5849         struct ccb_trans_settings cts;
5850         struct ccb_trans_settings_spi *spi;
5851
5852         memset(&cts, 0, sizeof (cts));
5853         xpt_setup_ccb(&cts.ccb_h, periph->path, /*priority*/1);
5854         cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS;
5855         cts.type = CTS_TYPE_CURRENT_SETTINGS;
5856         xpt_action((union ccb *)&cts);
5857         if ((cts.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
5858                 if (bootverbose) {
5859                         xpt_print(periph->path,
5860                             "failed to get current device settings\n");
5861                 }
5862                 return (0);
5863         }
5864         if (cts.transport != XPORT_SPI) {
5865                 if (bootverbose) {
5866                         xpt_print(periph->path, "not SPI transport\n");
5867                 }
5868                 return (0);
5869         }
5870         spi = &cts.xport_specific.spi;
5871
5872         /*
5873          * We cannot renegotiate sync rate if we don't have one.
5874          */
5875         if ((spi->valid & CTS_SPI_VALID_SYNC_RATE) == 0) {
5876                 if (bootverbose) {
5877                         xpt_print(periph->path, "no sync rate known\n");
5878                 }
5879                 return (0);
5880         }
5881
5882         /*
5883          * We'll assert that we don't have to touch PPR options- the
5884          * SIM will see what we do with period and offset and adjust
5885          * the PPR options as appropriate.
5886          */
5887
5888         /*
5889          * A sync rate with unknown or zero offset is nonsensical.
5890          * A sync period of zero means Async.
5891          */
5892         if ((spi->valid & CTS_SPI_VALID_SYNC_OFFSET) == 0
5893          || spi->sync_offset == 0 || spi->sync_period == 0) {
5894                 if (bootverbose) {
5895                         xpt_print(periph->path, "no sync rate available\n");
5896                 }
5897                 return (0);
5898         }
5899
5900         if (device->flags & CAM_DEV_DV_HIT_BOTTOM) {
5901                 CAM_DEBUG(periph->path, CAM_DEBUG_INFO,
5902                     ("hit async: giving up on DV\n"));
5903                 return (0);
5904         }
5905
5906
5907         /*
5908          * Jump sync_period up by one, but stop at 5MHz and fall back to Async.
5909          * We don't try to remember 'last' settings to see if the SIM actually
5910          * gets into the speed we want to set. We check on the SIM telling
5911          * us that a requested speed is bad, but otherwise don't try and
5912          * check the speed due to the asynchronous and handshake nature
5913          * of speed setting.
5914          */
5915         spi->valid = CTS_SPI_VALID_SYNC_RATE | CTS_SPI_VALID_SYNC_OFFSET;
5916         for (;;) {
5917                 spi->sync_period++;
5918                 if (spi->sync_period >= 0xf) {
5919                         spi->sync_period = 0;
5920                         spi->sync_offset = 0;
5921                         CAM_DEBUG(periph->path, CAM_DEBUG_INFO,
5922                             ("setting to async for DV\n"));
5923                         /*
5924                          * Once we hit async, we don't want to try
5925                          * any more settings.
5926                          */
5927                         device->flags |= CAM_DEV_DV_HIT_BOTTOM;
5928                 } else if (bootverbose) {
5929                         CAM_DEBUG(periph->path, CAM_DEBUG_INFO,
5930                             ("DV: period 0x%x\n", spi->sync_period));
5931                         printf("setting period to 0x%x\n", spi->sync_period);
5932                 }
5933                 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS;
5934                 cts.type = CTS_TYPE_CURRENT_SETTINGS;
5935                 xpt_action((union ccb *)&cts);
5936                 if ((cts.ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
5937                         break;
5938                 }
5939                 CAM_DEBUG(periph->path, CAM_DEBUG_INFO,
5940                     ("DV: failed to set period 0x%x\n", spi->sync_period));
5941                 if (spi->sync_period == 0) {
5942                         return (0);
5943                 }
5944         }
5945         return (1);
5946 }
5947
5948 static void
5949 probedone(struct cam_periph *periph, union ccb *done_ccb)
5950 {
5951         probe_softc *softc;
5952         struct cam_path *path;
5953         u_int32_t  priority;
5954
5955         CAM_DEBUG(done_ccb->ccb_h.path, CAM_DEBUG_TRACE, ("probedone\n"));
5956
5957         softc = (probe_softc *)periph->softc;
5958         path = done_ccb->ccb_h.path;
5959         priority = done_ccb->ccb_h.pinfo.priority;
5960
5961         switch (softc->action) {
5962         case PROBE_TUR:
5963         {
5964                 if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
5965
5966                         if (cam_periph_error(done_ccb, 0,
5967                                              SF_NO_PRINT, NULL) == ERESTART)
5968                                 return;
5969                         else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0)
5970                                 /* Don't wedge the queue */
5971                                 xpt_release_devq(done_ccb->ccb_h.path,
5972                                                  /*count*/1,
5973                                                  /*run_queue*/TRUE);
5974                 }
5975                 softc->action = PROBE_INQUIRY;
5976                 xpt_release_ccb(done_ccb);
5977                 xpt_schedule(periph, priority);
5978                 return;
5979         }
5980         case PROBE_INQUIRY:
5981         case PROBE_FULL_INQUIRY:
5982         {
5983                 if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
5984                         struct scsi_inquiry_data *inq_buf;
5985                         u_int8_t periph_qual;
5986
5987                         path->device->flags |= CAM_DEV_INQUIRY_DATA_VALID;
5988                         inq_buf = &path->device->inq_data;
5989
5990                         periph_qual = SID_QUAL(inq_buf);
5991
5992                         switch(periph_qual) {
5993                         case SID_QUAL_LU_CONNECTED:
5994                         {
5995                                 u_int8_t len;
5996
5997                                 /*
5998                                  * We conservatively request only
5999                                  * SHORT_INQUIRY_LEN bytes of inquiry
6000                                  * information during our first try
6001                                  * at sending an INQUIRY. If the device
6002                                  * has more information to give,
6003                                  * perform a second request specifying
6004                                  * the amount of information the device
6005                                  * is willing to give.
6006                                  */
6007                                 len = inq_buf->additional_length
6008                                     + offsetof(struct scsi_inquiry_data,
6009                                                additional_length) + 1;
6010                                 if (softc->action == PROBE_INQUIRY
6011                                     && len > SHORT_INQUIRY_LENGTH) {
6012                                         softc->action = PROBE_FULL_INQUIRY;
6013                                         xpt_release_ccb(done_ccb);
6014                                         xpt_schedule(periph, priority);
6015                                         return;
6016                                 }
6017
6018                                 xpt_find_quirk(path->device);
6019
6020                                 xpt_devise_transport(path);
6021                                 if (INQ_DATA_TQ_ENABLED(inq_buf))
6022                                         softc->action = PROBE_MODE_SENSE;
6023                                 else
6024                                         softc->action = PROBE_SERIAL_NUM_0;
6025
6026                                 path->device->flags &= ~CAM_DEV_UNCONFIGURED;
6027
6028                                 xpt_release_ccb(done_ccb);
6029                                 xpt_schedule(periph, priority);
6030                                 return;
6031                         }
6032                         default:
6033                                 break;
6034                         }
6035                 } else if (cam_periph_error(done_ccb, 0,
6036                                             done_ccb->ccb_h.target_lun > 0
6037                                             ? SF_RETRY_UA|SF_QUIET_IR
6038                                             : SF_RETRY_UA,
6039                                             &softc->saved_ccb) == ERESTART) {
6040                         return;
6041                 } else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
6042                         /* Don't wedge the queue */
6043                         xpt_release_devq(done_ccb->ccb_h.path, /*count*/1,
6044                                          /*run_queue*/TRUE);
6045                 }
6046                 /*
6047                  * If we get to this point, we got an error status back
6048                  * from the inquiry and the error status doesn't require
6049                  * automatically retrying the command.  Therefore, the
6050                  * inquiry failed.  If we had inquiry information before
6051                  * for this device, but this latest inquiry command failed,
6052                  * the device has probably gone away.  If this device isn't
6053                  * already marked unconfigured, notify the peripheral
6054                  * drivers that this device is no more.
6055                  */
6056                 if ((path->device->flags & CAM_DEV_UNCONFIGURED) == 0)
6057                         /* Send the async notification. */
6058                         xpt_async(AC_LOST_DEVICE, path, NULL);
6059
6060                 xpt_release_ccb(done_ccb);
6061                 break;
6062         }
6063         case PROBE_MODE_SENSE:
6064         {
6065                 struct ccb_scsiio *csio;
6066                 struct scsi_mode_header_6 *mode_hdr;
6067
6068                 csio = &done_ccb->csio;
6069                 mode_hdr = (struct scsi_mode_header_6 *)csio->data_ptr;
6070                 if ((csio->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
6071                         struct scsi_control_page *page;
6072                         u_int8_t *offset;
6073
6074                         offset = ((u_int8_t *)&mode_hdr[1])
6075                             + mode_hdr->blk_desc_len;
6076                         page = (struct scsi_control_page *)offset;
6077                         path->device->queue_flags = page->queue_flags;
6078                 } else if (cam_periph_error(done_ccb, 0,
6079                                             SF_RETRY_UA|SF_NO_PRINT,
6080                                             &softc->saved_ccb) == ERESTART) {
6081                         return;
6082                 } else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
6083                         /* Don't wedge the queue */
6084                         xpt_release_devq(done_ccb->ccb_h.path,
6085                                          /*count*/1, /*run_queue*/TRUE);
6086                 }
6087                 xpt_release_ccb(done_ccb);
6088                 free(mode_hdr, M_CAMXPT);
6089                 softc->action = PROBE_SERIAL_NUM_0;
6090                 xpt_schedule(periph, priority);
6091                 return;
6092         }
6093         case PROBE_SERIAL_NUM_0:
6094         {
6095                 struct ccb_scsiio *csio;
6096                 struct scsi_vpd_supported_page_list *page_list;
6097                 int length, serialnum_supported, i;
6098
6099                 serialnum_supported = 0;
6100                 csio = &done_ccb->csio;
6101                 page_list =
6102                     (struct scsi_vpd_supported_page_list *)csio->data_ptr;
6103
6104                 if (page_list == NULL) {
6105                         /*
6106                          * Don't process the command as it was never sent
6107                          */
6108                 } else if ((csio->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP
6109                     && (page_list->length > 0)) {
6110                         length = min(page_list->length,
6111                             SVPD_SUPPORTED_PAGES_SIZE);
6112                         for (i = 0; i < length; i++) {
6113                                 if (page_list->list[i] ==
6114                                     SVPD_UNIT_SERIAL_NUMBER) {
6115                                         serialnum_supported = 1;
6116                                         break;
6117                                 }
6118                         }
6119                 } else if (cam_periph_error(done_ccb, 0,
6120                                             SF_RETRY_UA|SF_NO_PRINT,
6121                                             &softc->saved_ccb) == ERESTART) {
6122                         return;
6123                 } else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
6124                         /* Don't wedge the queue */
6125                         xpt_release_devq(done_ccb->ccb_h.path, /*count*/1,
6126                                          /*run_queue*/TRUE);
6127                 }
6128
6129                 if (page_list != NULL)
6130                         free(page_list, M_DEVBUF);
6131
6132                 if (serialnum_supported) {
6133                         xpt_release_ccb(done_ccb);
6134                         softc->action = PROBE_SERIAL_NUM_1;
6135                         xpt_schedule(periph, priority);
6136                         return;
6137                 }
6138                 xpt_release_ccb(done_ccb);
6139                 softc->action = PROBE_TUR_FOR_NEGOTIATION;
6140                 xpt_schedule(periph, done_ccb->ccb_h.pinfo.priority);
6141                 return;
6142         }
6143
6144         case PROBE_SERIAL_NUM_1:
6145         {
6146                 struct ccb_scsiio *csio;
6147                 struct scsi_vpd_unit_serial_number *serial_buf;
6148                 u_int32_t  priority;
6149                 int changed;
6150                 int have_serialnum;
6151
6152                 changed = 1;
6153                 have_serialnum = 0;
6154                 csio = &done_ccb->csio;
6155                 priority = done_ccb->ccb_h.pinfo.priority;
6156                 serial_buf =
6157                     (struct scsi_vpd_unit_serial_number *)csio->data_ptr;
6158
6159                 /* Clean up from previous instance of this device */
6160                 if (path->device->serial_num != NULL) {
6161                         free(path->device->serial_num, M_CAMXPT);
6162                         path->device->serial_num = NULL;
6163                         path->device->serial_num_len = 0;
6164                 }
6165
6166                 if (serial_buf == NULL) {
6167                         /*
6168                          * Don't process the command as it was never sent
6169                          */
6170                 } else if ((csio->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP
6171                         && (serial_buf->length > 0)) {
6172
6173                         have_serialnum = 1;
6174                         path->device->serial_num =
6175                                 (u_int8_t *)malloc((serial_buf->length + 1),
6176                                                    M_CAMXPT, M_NOWAIT);
6177                         if (path->device->serial_num != NULL) {
6178                                 bcopy(serial_buf->serial_num,
6179                                       path->device->serial_num,
6180                                       serial_buf->length);
6181                                 path->device->serial_num_len =
6182                                     serial_buf->length;
6183                                 path->device->serial_num[serial_buf->length]
6184                                     = '\0';
6185                         }
6186                 } else if (cam_periph_error(done_ccb, 0,
6187                                             SF_RETRY_UA|SF_NO_PRINT,
6188                                             &softc->saved_ccb) == ERESTART) {
6189                         return;
6190                 } else if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
6191                         /* Don't wedge the queue */
6192                         xpt_release_devq(done_ccb->ccb_h.path, /*count*/1,
6193                                          /*run_queue*/TRUE);
6194                 }
6195
6196                 /*
6197                  * Let's see if we have seen this device before.
6198                  */
6199                 if ((softc->flags & PROBE_INQUIRY_CKSUM) != 0) {
6200                         MD5_CTX context;
6201                         u_int8_t digest[16];
6202
6203                         MD5Init(&context);
6204
6205                         MD5Update(&context,
6206                                   (unsigned char *)&path->device->inq_data,
6207                                   sizeof(struct scsi_inquiry_data));
6208
6209                         if (have_serialnum)
6210                                 MD5Update(&context, serial_buf->serial_num,
6211                                           serial_buf->length);
6212
6213                         MD5Final(digest, &context);
6214                         if (bcmp(softc->digest, digest, 16) == 0)
6215                                 changed = 0;
6216
6217                         /*
6218                          * XXX Do we need to do a TUR in order to ensure
6219                          *     that the device really hasn't changed???
6220                          */
6221                         if ((changed != 0)
6222                          && ((softc->flags & PROBE_NO_ANNOUNCE) == 0))
6223                                 xpt_async(AC_LOST_DEVICE, path, NULL);
6224                 }
6225                 if (serial_buf != NULL)
6226                         free(serial_buf, M_CAMXPT);
6227
6228                 if (changed != 0) {
6229                         /*
6230                          * Now that we have all the necessary
6231                          * information to safely perform transfer
6232                          * negotiations... Controllers don't perform
6233                          * any negotiation or tagged queuing until
6234                          * after the first XPT_SET_TRAN_SETTINGS ccb is
6235                          * received.  So, on a new device, just retrieve
6236                          * the user settings, and set them as the current
6237                          * settings to set the device up.
6238                          */
6239                         proberequestdefaultnegotiation(periph);
6240                         xpt_release_ccb(done_ccb);
6241
6242                         /*
6243                          * Perform a TUR to allow the controller to
6244                          * perform any necessary transfer negotiation.
6245                          */
6246                         softc->action = PROBE_TUR_FOR_NEGOTIATION;
6247                         xpt_schedule(periph, priority);
6248                         return;
6249                 }
6250                 xpt_release_ccb(done_ccb);
6251                 break;
6252         }
6253         case PROBE_TUR_FOR_NEGOTIATION:
6254                 if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
6255                         DELAY(500000);
6256                         if (cam_periph_error(done_ccb, 0, SF_RETRY_UA,
6257                             NULL) == ERESTART)
6258                                 return;
6259                 }
6260         /* FALLTHROUGH */
6261         case PROBE_DV_EXIT:
6262                 if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
6263                         /* Don't wedge the queue */
6264                         xpt_release_devq(done_ccb->ccb_h.path, /*count*/1,
6265                                          /*run_queue*/TRUE);
6266                 }
6267                 /*
6268                  * Do Domain Validation for lun 0 on devices that claim
6269                  * to support Synchronous Transfer modes.
6270                  */
6271                 if (softc->action == PROBE_TUR_FOR_NEGOTIATION
6272                  && done_ccb->ccb_h.target_lun == 0
6273                  && (path->device->inq_data.flags & SID_Sync) != 0
6274                  && (path->device->flags & CAM_DEV_IN_DV) == 0) {
6275                         CAM_DEBUG(periph->path, CAM_DEBUG_INFO,
6276                             ("Begin Domain Validation\n"));
6277                         path->device->flags |= CAM_DEV_IN_DV;
6278                         xpt_release_ccb(done_ccb);
6279                         softc->action = PROBE_INQUIRY_BASIC_DV1;
6280                         xpt_schedule(periph, priority);
6281                         return;
6282                 }
6283                 if (softc->action == PROBE_DV_EXIT) {
6284                         CAM_DEBUG(periph->path, CAM_DEBUG_INFO,
6285                             ("Leave Domain Validation\n"));
6286                 }
6287                 path->device->flags &=
6288                     ~(CAM_DEV_UNCONFIGURED|CAM_DEV_IN_DV|CAM_DEV_DV_HIT_BOTTOM);
6289                 if ((softc->flags & PROBE_NO_ANNOUNCE) == 0) {
6290                         /* Inform the XPT that a new device has been found */
6291                         done_ccb->ccb_h.func_code = XPT_GDEV_TYPE;
6292                         xpt_action(done_ccb);
6293                         xpt_async(AC_FOUND_DEVICE, done_ccb->ccb_h.path,
6294                                   done_ccb);
6295                 }
6296                 xpt_release_ccb(done_ccb);
6297                 break;
6298         case PROBE_INQUIRY_BASIC_DV1:
6299         case PROBE_INQUIRY_BASIC_DV2:
6300         {
6301                 struct scsi_inquiry_data *nbuf;
6302                 struct ccb_scsiio *csio;
6303
6304                 if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) {
6305                         /* Don't wedge the queue */
6306                         xpt_release_devq(done_ccb->ccb_h.path, /*count*/1,
6307                                          /*run_queue*/TRUE);
6308                 }
6309                 csio = &done_ccb->csio;
6310                 nbuf = (struct scsi_inquiry_data *)csio->data_ptr;
6311                 if (bcmp(nbuf, &path->device->inq_data, SHORT_INQUIRY_LENGTH)) {
6312                         xpt_print(path,
6313                             "inquiry data fails comparison at DV%d step\n",
6314                             softc->action == PROBE_INQUIRY_BASIC_DV1 ? 1 : 2);
6315                         if (proberequestbackoff(periph, path->device)) {
6316                                 path->device->flags &= ~CAM_DEV_IN_DV;
6317                                 softc->action = PROBE_TUR_FOR_NEGOTIATION;
6318                         } else {
6319                                 /* give up */
6320                                 softc->action = PROBE_DV_EXIT;
6321                         }
6322                         free(nbuf, M_CAMXPT);
6323                         xpt_release_ccb(done_ccb);
6324                         xpt_schedule(periph, priority);
6325                         return;
6326                 }
6327                 free(nbuf, M_CAMXPT);
6328                 if (softc->action == PROBE_INQUIRY_BASIC_DV1) {
6329                         softc->action = PROBE_INQUIRY_BASIC_DV2;
6330                         xpt_release_ccb(done_ccb);
6331                         xpt_schedule(periph, priority);
6332                         return;
6333                 }
6334                 if (softc->action == PROBE_DV_EXIT) {
6335                         CAM_DEBUG(periph->path, CAM_DEBUG_INFO,
6336                             ("Leave Domain Validation Successfully\n"));
6337                 }
6338                 path->device->flags &=
6339                     ~(CAM_DEV_UNCONFIGURED|CAM_DEV_IN_DV|CAM_DEV_DV_HIT_BOTTOM);
6340                 if ((softc->flags & PROBE_NO_ANNOUNCE) == 0) {
6341                         /* Inform the XPT that a new device has been found */
6342                         done_ccb->ccb_h.func_code = XPT_GDEV_TYPE;
6343                         xpt_action(done_ccb);
6344                         xpt_async(AC_FOUND_DEVICE, done_ccb->ccb_h.path,
6345                                   done_ccb);
6346                 }
6347                 xpt_release_ccb(done_ccb);
6348                 break;
6349         }
6350         }
6351         done_ccb = (union ccb *)TAILQ_FIRST(&softc->request_ccbs);
6352         TAILQ_REMOVE(&softc->request_ccbs, &done_ccb->ccb_h, periph_links.tqe);
6353         done_ccb->ccb_h.status = CAM_REQ_CMP;
6354         xpt_done(done_ccb);
6355         if (TAILQ_FIRST(&softc->request_ccbs) == NULL) {
6356                 cam_periph_invalidate(periph);
6357                 cam_periph_release_locked(periph);
6358         } else {
6359                 probeschedule(periph);
6360         }
6361 }
6362
6363 static void
6364 probecleanup(struct cam_periph *periph)
6365 {
6366         free(periph->softc, M_CAMXPT);
6367 }
6368
6369 static void
6370 xpt_find_quirk(struct cam_ed *device)
6371 {
6372         caddr_t match;
6373
6374         match = cam_quirkmatch((caddr_t)&device->inq_data,
6375                                (caddr_t)xpt_quirk_table,
6376                                sizeof(xpt_quirk_table)/sizeof(*xpt_quirk_table),
6377                                sizeof(*xpt_quirk_table), scsi_inquiry_match);
6378
6379         if (match == NULL)
6380                 panic("xpt_find_quirk: device didn't match wildcard entry!!");
6381
6382         device->quirk = (struct xpt_quirk_entry *)match;
6383 }
6384
6385 static int
6386 sysctl_cam_search_luns(SYSCTL_HANDLER_ARGS)
6387 {
6388         int error, bool;
6389
6390         bool = cam_srch_hi;
6391         error = sysctl_handle_int(oidp, &bool, 0, req);
6392         if (error != 0 || req->newptr == NULL)
6393                 return (error);
6394         if (bool == 0 || bool == 1) {
6395                 cam_srch_hi = bool;
6396                 return (0);
6397         } else {
6398                 return (EINVAL);
6399         }
6400 }
6401
6402
6403 static void
6404 xpt_devise_transport(struct cam_path *path)
6405 {
6406         struct ccb_pathinq cpi;
6407         struct ccb_trans_settings cts;
6408         struct scsi_inquiry_data *inq_buf;
6409
6410         /* Get transport information from the SIM */
6411         xpt_setup_ccb(&cpi.ccb_h, path, /*priority*/1);
6412         cpi.ccb_h.func_code = XPT_PATH_INQ;
6413         xpt_action((union ccb *)&cpi);
6414
6415         inq_buf = NULL;
6416         if ((path->device->flags & CAM_DEV_INQUIRY_DATA_VALID) != 0)
6417                 inq_buf = &path->device->inq_data;
6418         path->device->protocol = PROTO_SCSI;
6419         path->device->protocol_version =
6420             inq_buf != NULL ? SID_ANSI_REV(inq_buf) : cpi.protocol_version;
6421         path->device->transport = cpi.transport;
6422         path->device->transport_version = cpi.transport_version;
6423
6424         /*
6425          * Any device not using SPI3 features should
6426          * be considered SPI2 or lower.
6427          */
6428         if (inq_buf != NULL) {
6429                 if (path->device->transport == XPORT_SPI
6430                  && (inq_buf->spi3data & SID_SPI_MASK) == 0
6431                  && path->device->transport_version > 2)
6432                         path->device->transport_version = 2;
6433         } else {
6434                 struct cam_ed* otherdev;
6435
6436                 for (otherdev = TAILQ_FIRST(&path->target->ed_entries);
6437                      otherdev != NULL;
6438                      otherdev = TAILQ_NEXT(otherdev, links)) {
6439                         if (otherdev != path->device)
6440                                 break;
6441                 }
6442
6443                 if (otherdev != NULL) {
6444                         /*
6445                          * Initially assume the same versioning as
6446                          * prior luns for this target.
6447                          */
6448                         path->device->protocol_version =
6449                             otherdev->protocol_version;
6450                         path->device->transport_version =
6451                             otherdev->transport_version;
6452                 } else {
6453                         /* Until we know better, opt for safty */
6454                         path->device->protocol_version = 2;
6455                         if (path->device->transport == XPORT_SPI)
6456                                 path->device->transport_version = 2;
6457                         else
6458                                 path->device->transport_version = 0;
6459                 }
6460         }
6461
6462         /*
6463          * XXX
6464          * For a device compliant with SPC-2 we should be able
6465          * to determine the transport version supported by
6466          * scrutinizing the version descriptors in the
6467          * inquiry buffer.
6468          */
6469
6470         /* Tell the controller what we think */
6471         xpt_setup_ccb(&cts.ccb_h, path, /*priority*/1);
6472         cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS;
6473         cts.type = CTS_TYPE_CURRENT_SETTINGS;
6474         cts.transport = path->device->transport;
6475         cts.transport_version = path->device->transport_version;
6476         cts.protocol = path->device->protocol;
6477         cts.protocol_version = path->device->protocol_version;
6478         cts.proto_specific.valid = 0;
6479         cts.xport_specific.valid = 0;
6480         xpt_action((union ccb *)&cts);
6481 }
6482
6483 static void
6484 xpt_set_transfer_settings(struct ccb_trans_settings *cts, struct cam_ed *device,
6485                           int async_update)
6486 {
6487         struct  ccb_pathinq cpi;
6488         struct  ccb_trans_settings cur_cts;
6489         struct  ccb_trans_settings_scsi *scsi;
6490         struct  ccb_trans_settings_scsi *cur_scsi;
6491         struct  cam_sim *sim;
6492         struct  scsi_inquiry_data *inq_data;
6493
6494         if (device == NULL) {
6495                 cts->ccb_h.status = CAM_PATH_INVALID;
6496                 xpt_done((union ccb *)cts);
6497                 return;
6498         }
6499
6500         if (cts->protocol == PROTO_UNKNOWN
6501          || cts->protocol == PROTO_UNSPECIFIED) {
6502                 cts->protocol = device->protocol;
6503                 cts->protocol_version = device->protocol_version;
6504         }
6505
6506         if (cts->protocol_version == PROTO_VERSION_UNKNOWN
6507          || cts->protocol_version == PROTO_VERSION_UNSPECIFIED)
6508                 cts->protocol_version = device->protocol_version;
6509
6510         if (cts->protocol != device->protocol) {
6511                 xpt_print(cts->ccb_h.path, "Uninitialized Protocol %x:%x?\n",
6512                        cts->protocol, device->protocol);
6513                 cts->protocol = device->protocol;
6514         }
6515
6516         if (cts->protocol_version > device->protocol_version) {
6517                 if (bootverbose) {
6518                         xpt_print(cts->ccb_h.path, "Down reving Protocol "
6519                             "Version from %d to %d?\n", cts->protocol_version,
6520                             device->protocol_version);
6521                 }
6522                 cts->protocol_version = device->protocol_version;
6523         }
6524
6525         if (cts->transport == XPORT_UNKNOWN
6526          || cts->transport == XPORT_UNSPECIFIED) {
6527                 cts->transport = device->transport;
6528                 cts->transport_version = device->transport_version;
6529         }
6530
6531         if (cts->transport_version == XPORT_VERSION_UNKNOWN
6532          || cts->transport_version == XPORT_VERSION_UNSPECIFIED)
6533                 cts->transport_version = device->transport_version;
6534
6535         if (cts->transport != device->transport) {
6536                 xpt_print(cts->ccb_h.path, "Uninitialized Transport %x:%x?\n",
6537                     cts->transport, device->transport);
6538                 cts->transport = device->transport;
6539         }
6540
6541         if (cts->transport_version > device->transport_version) {
6542                 if (bootverbose) {
6543                         xpt_print(cts->ccb_h.path, "Down reving Transport "
6544                             "Version from %d to %d?\n", cts->transport_version,
6545                             device->transport_version);
6546                 }
6547                 cts->transport_version = device->transport_version;
6548         }
6549
6550         sim = cts->ccb_h.path->bus->sim;
6551
6552         /*
6553          * Nothing more of interest to do unless
6554          * this is a device connected via the
6555          * SCSI protocol.
6556          */
6557         if (cts->protocol != PROTO_SCSI) {
6558                 if (async_update == FALSE)
6559                         (*(sim->sim_action))(sim, (union ccb *)cts);
6560                 return;
6561         }
6562
6563         inq_data = &device->inq_data;
6564         scsi = &cts->proto_specific.scsi;
6565         xpt_setup_ccb(&cpi.ccb_h, cts->ccb_h.path, /*priority*/1);
6566         cpi.ccb_h.func_code = XPT_PATH_INQ;
6567         xpt_action((union ccb *)&cpi);
6568
6569         /* SCSI specific sanity checking */
6570         if ((cpi.hba_inquiry & PI_TAG_ABLE) == 0
6571          || (INQ_DATA_TQ_ENABLED(inq_data)) == 0
6572          || (device->queue_flags & SCP_QUEUE_DQUE) != 0
6573          || (device->quirk->mintags == 0)) {
6574                 /*
6575                  * Can't tag on hardware that doesn't support tags,
6576                  * doesn't have it enabled, or has broken tag support.
6577                  */
6578                 scsi->flags &= ~CTS_SCSI_FLAGS_TAG_ENB;
6579         }
6580
6581         if (async_update == FALSE) {
6582                 /*
6583                  * Perform sanity checking against what the
6584                  * controller and device can do.
6585                  */
6586                 xpt_setup_ccb(&cur_cts.ccb_h, cts->ccb_h.path, /*priority*/1);
6587                 cur_cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS;
6588                 cur_cts.type = cts->type;
6589                 xpt_action((union ccb *)&cur_cts);
6590                 if ((cur_cts.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
6591                         return;
6592                 }
6593                 cur_scsi = &cur_cts.proto_specific.scsi;
6594                 if ((scsi->valid & CTS_SCSI_VALID_TQ) == 0) {
6595                         scsi->flags &= ~CTS_SCSI_FLAGS_TAG_ENB;
6596                         scsi->flags |= cur_scsi->flags & CTS_SCSI_FLAGS_TAG_ENB;
6597                 }
6598                 if ((cur_scsi->valid & CTS_SCSI_VALID_TQ) == 0)
6599                         scsi->flags &= ~CTS_SCSI_FLAGS_TAG_ENB;
6600         }
6601
6602         /* SPI specific sanity checking */
6603         if (cts->transport == XPORT_SPI && async_update == FALSE) {
6604                 u_int spi3caps;
6605                 struct ccb_trans_settings_spi *spi;
6606                 struct ccb_trans_settings_spi *cur_spi;
6607
6608                 spi = &cts->xport_specific.spi;
6609
6610                 cur_spi = &cur_cts.xport_specific.spi;
6611
6612                 /* Fill in any gaps in what the user gave us */
6613                 if ((spi->valid & CTS_SPI_VALID_SYNC_RATE) == 0)
6614                         spi->sync_period = cur_spi->sync_period;
6615                 if ((cur_spi->valid & CTS_SPI_VALID_SYNC_RATE) == 0)
6616                         spi->sync_period = 0;
6617                 if ((spi->valid & CTS_SPI_VALID_SYNC_OFFSET) == 0)
6618                         spi->sync_offset = cur_spi->sync_offset;
6619                 if ((cur_spi->valid & CTS_SPI_VALID_SYNC_OFFSET) == 0)
6620                         spi->sync_offset = 0;
6621                 if ((spi->valid & CTS_SPI_VALID_PPR_OPTIONS) == 0)
6622                         spi->ppr_options = cur_spi->ppr_options;
6623                 if ((cur_spi->valid & CTS_SPI_VALID_PPR_OPTIONS) == 0)
6624                         spi->ppr_options = 0;
6625                 if ((spi->valid & CTS_SPI_VALID_BUS_WIDTH) == 0)
6626                         spi->bus_width = cur_spi->bus_width;
6627                 if ((cur_spi->valid & CTS_SPI_VALID_BUS_WIDTH) == 0)
6628                         spi->bus_width = 0;
6629                 if ((spi->valid & CTS_SPI_VALID_DISC) == 0) {
6630                         spi->flags &= ~CTS_SPI_FLAGS_DISC_ENB;
6631                         spi->flags |= cur_spi->flags & CTS_SPI_FLAGS_DISC_ENB;
6632                 }
6633                 if ((cur_spi->valid & CTS_SPI_VALID_DISC) == 0)
6634                         spi->flags &= ~CTS_SPI_FLAGS_DISC_ENB;
6635                 if (((device->flags & CAM_DEV_INQUIRY_DATA_VALID) != 0
6636                   && (inq_data->flags & SID_Sync) == 0
6637                   && cts->type == CTS_TYPE_CURRENT_SETTINGS)
6638                  || ((cpi.hba_inquiry & PI_SDTR_ABLE) == 0)
6639                  || (spi->sync_offset == 0)
6640                  || (spi->sync_period == 0)) {
6641                         /* Force async */
6642                         spi->sync_period = 0;
6643                         spi->sync_offset = 0;
6644                 }
6645
6646                 switch (spi->bus_width) {
6647                 case MSG_EXT_WDTR_BUS_32_BIT:
6648                         if (((device->flags & CAM_DEV_INQUIRY_DATA_VALID) == 0
6649                           || (inq_data->flags & SID_WBus32) != 0
6650                           || cts->type == CTS_TYPE_USER_SETTINGS)
6651                          && (cpi.hba_inquiry & PI_WIDE_32) != 0)
6652                                 break;
6653                         /* Fall Through to 16-bit */
6654                 case MSG_EXT_WDTR_BUS_16_BIT:
6655                         if (((device->flags & CAM_DEV_INQUIRY_DATA_VALID) == 0
6656                           || (inq_data->flags & SID_WBus16) != 0
6657                           || cts->type == CTS_TYPE_USER_SETTINGS)
6658                          && (cpi.hba_inquiry & PI_WIDE_16) != 0) {
6659                                 spi->bus_width = MSG_EXT_WDTR_BUS_16_BIT;
6660                                 break;
6661                         }
6662                         /* Fall Through to 8-bit */
6663                 default: /* New bus width?? */
6664                 case MSG_EXT_WDTR_BUS_8_BIT:
6665                         /* All targets can do this */
6666                         spi->bus_width = MSG_EXT_WDTR_BUS_8_BIT;
6667                         break;
6668                 }
6669
6670                 spi3caps = cpi.xport_specific.spi.ppr_options;
6671                 if ((device->flags & CAM_DEV_INQUIRY_DATA_VALID) != 0
6672                  && cts->type == CTS_TYPE_CURRENT_SETTINGS)
6673                         spi3caps &= inq_data->spi3data;
6674
6675                 if ((spi3caps & SID_SPI_CLOCK_DT) == 0)
6676                         spi->ppr_options &= ~MSG_EXT_PPR_DT_REQ;
6677
6678                 if ((spi3caps & SID_SPI_IUS) == 0)
6679                         spi->ppr_options &= ~MSG_EXT_PPR_IU_REQ;
6680
6681                 if ((spi3caps & SID_SPI_QAS) == 0)
6682                         spi->ppr_options &= ~MSG_EXT_PPR_QAS_REQ;
6683
6684                 /* No SPI Transfer settings are allowed unless we are wide */
6685                 if (spi->bus_width == 0)
6686                         spi->ppr_options = 0;
6687
6688                 if ((spi->flags & CTS_SPI_FLAGS_DISC_ENB) == 0) {
6689                         /*
6690                          * Can't tag queue without disconnection.
6691                          */
6692                         scsi->flags &= ~CTS_SCSI_FLAGS_TAG_ENB;
6693                         scsi->valid |= CTS_SCSI_VALID_TQ;
6694                 }
6695
6696                 /*
6697                  * If we are currently performing tagged transactions to
6698                  * this device and want to change its negotiation parameters,
6699                  * go non-tagged for a bit to give the controller a chance to
6700                  * negotiate unhampered by tag messages.
6701                  */
6702                 if (cts->type == CTS_TYPE_CURRENT_SETTINGS
6703                  && (device->inq_flags & SID_CmdQue) != 0
6704                  && (scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) != 0
6705                  && (spi->flags & (CTS_SPI_VALID_SYNC_RATE|
6706                                    CTS_SPI_VALID_SYNC_OFFSET|
6707                                    CTS_SPI_VALID_BUS_WIDTH)) != 0)
6708                         xpt_toggle_tags(cts->ccb_h.path);
6709         }
6710
6711         if (cts->type == CTS_TYPE_CURRENT_SETTINGS
6712          && (scsi->valid & CTS_SCSI_VALID_TQ) != 0) {
6713                 int device_tagenb;
6714
6715                 /*
6716                  * If we are transitioning from tags to no-tags or
6717                  * vice-versa, we need to carefully freeze and restart
6718                  * the queue so that we don't overlap tagged and non-tagged
6719                  * commands.  We also temporarily stop tags if there is
6720                  * a change in transfer negotiation settings to allow
6721                  * "tag-less" negotiation.
6722                  */
6723                 if ((device->flags & CAM_DEV_TAG_AFTER_COUNT) != 0
6724                  || (device->inq_flags & SID_CmdQue) != 0)
6725                         device_tagenb = TRUE;
6726                 else
6727                         device_tagenb = FALSE;
6728
6729                 if (((scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) != 0
6730                   && device_tagenb == FALSE)
6731                  || ((scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) == 0
6732                   && device_tagenb == TRUE)) {
6733
6734                         if ((scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) != 0) {
6735                                 /*
6736                                  * Delay change to use tags until after a
6737                                  * few commands have gone to this device so
6738                                  * the controller has time to perform transfer
6739                                  * negotiations without tagged messages getting
6740                                  * in the way.
6741                                  */
6742                                 device->tag_delay_count = CAM_TAG_DELAY_COUNT;
6743                                 device->flags |= CAM_DEV_TAG_AFTER_COUNT;
6744                         } else {
6745                                 struct ccb_relsim crs;
6746
6747                                 xpt_freeze_devq(cts->ccb_h.path, /*count*/1);
6748                                 device->inq_flags &= ~SID_CmdQue;
6749                                 xpt_dev_ccbq_resize(cts->ccb_h.path,
6750                                                     sim->max_dev_openings);
6751                                 device->flags &= ~CAM_DEV_TAG_AFTER_COUNT;
6752                                 device->tag_delay_count = 0;
6753
6754                                 xpt_setup_ccb(&crs.ccb_h, cts->ccb_h.path,
6755                                               /*priority*/1);
6756                                 crs.ccb_h.func_code = XPT_REL_SIMQ;
6757                                 crs.release_flags = RELSIM_RELEASE_AFTER_QEMPTY;
6758                                 crs.openings
6759                                     = crs.release_timeout
6760                                     = crs.qfrozen_cnt
6761                                     = 0;
6762                                 xpt_action((union ccb *)&crs);
6763                         }
6764                 }
6765         }
6766         if (async_update == FALSE)
6767                 (*(sim->sim_action))(sim, (union ccb *)cts);
6768 }
6769
6770
6771 static void
6772 xpt_toggle_tags(struct cam_path *path)
6773 {
6774         struct cam_ed *dev;
6775
6776         /*
6777          * Give controllers a chance to renegotiate
6778          * before starting tag operations.  We
6779          * "toggle" tagged queuing off then on
6780          * which causes the tag enable command delay
6781          * counter to come into effect.
6782          */
6783         dev = path->device;
6784         if ((dev->flags & CAM_DEV_TAG_AFTER_COUNT) != 0
6785          || ((dev->inq_flags & SID_CmdQue) != 0
6786           && (dev->inq_flags & (SID_Sync|SID_WBus16|SID_WBus32)) != 0)) {
6787                 struct ccb_trans_settings cts;
6788
6789                 xpt_setup_ccb(&cts.ccb_h, path, 1);
6790                 cts.protocol = PROTO_SCSI;
6791                 cts.protocol_version = PROTO_VERSION_UNSPECIFIED;
6792                 cts.transport = XPORT_UNSPECIFIED;
6793                 cts.transport_version = XPORT_VERSION_UNSPECIFIED;
6794                 cts.proto_specific.scsi.flags = 0;
6795                 cts.proto_specific.scsi.valid = CTS_SCSI_VALID_TQ;
6796                 xpt_set_transfer_settings(&cts, path->device,
6797                                           /*async_update*/TRUE);
6798                 cts.proto_specific.scsi.flags = CTS_SCSI_FLAGS_TAG_ENB;
6799                 xpt_set_transfer_settings(&cts, path->device,
6800                                           /*async_update*/TRUE);
6801         }
6802 }
6803
6804 static void
6805 xpt_start_tags(struct cam_path *path)
6806 {
6807         struct ccb_relsim crs;
6808         struct cam_ed *device;
6809         struct cam_sim *sim;
6810         int    newopenings;
6811
6812         device = path->device;
6813         sim = path->bus->sim;
6814         device->flags &= ~CAM_DEV_TAG_AFTER_COUNT;
6815         xpt_freeze_devq(path, /*count*/1);
6816         device->inq_flags |= SID_CmdQue;
6817         if (device->tag_saved_openings != 0)
6818                 newopenings = device->tag_saved_openings;
6819         else
6820                 newopenings = min(device->quirk->maxtags,
6821                                   sim->max_tagged_dev_openings);
6822         xpt_dev_ccbq_resize(path, newopenings);
6823         xpt_setup_ccb(&crs.ccb_h, path, /*priority*/1);
6824         crs.ccb_h.func_code = XPT_REL_SIMQ;
6825         crs.release_flags = RELSIM_RELEASE_AFTER_QEMPTY;
6826         crs.openings
6827             = crs.release_timeout
6828             = crs.qfrozen_cnt
6829             = 0;
6830         xpt_action((union ccb *)&crs);
6831 }
6832
6833 static int busses_to_config;
6834 static int busses_to_reset;
6835
6836 static int
6837 xptconfigbuscountfunc(struct cam_eb *bus, void *arg)
6838 {
6839
6840         mtx_assert(bus->sim->mtx, MA_OWNED);
6841
6842         if (bus->path_id != CAM_XPT_PATH_ID) {
6843                 struct cam_path path;
6844                 struct ccb_pathinq cpi;
6845                 int can_negotiate;
6846
6847                 busses_to_config++;
6848                 xpt_compile_path(&path, NULL, bus->path_id,
6849                                  CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD);
6850                 xpt_setup_ccb(&cpi.ccb_h, &path, /*priority*/1);
6851                 cpi.ccb_h.func_code = XPT_PATH_INQ;
6852                 xpt_action((union ccb *)&cpi);
6853                 can_negotiate = cpi.hba_inquiry;
6854                 can_negotiate &= (PI_WIDE_32|PI_WIDE_16|PI_SDTR_ABLE);
6855                 if ((cpi.hba_misc & PIM_NOBUSRESET) == 0
6856                  && can_negotiate)
6857                         busses_to_reset++;
6858                 xpt_release_path(&path);
6859         }
6860
6861         return(1);
6862 }
6863
6864 static int
6865 xptconfigfunc(struct cam_eb *bus, void *arg)
6866 {
6867         struct  cam_path *path;
6868         union   ccb *work_ccb;
6869
6870         mtx_assert(bus->sim->mtx, MA_OWNED);
6871
6872         if (bus->path_id != CAM_XPT_PATH_ID) {
6873                 cam_status status;
6874                 int can_negotiate;
6875
6876                 work_ccb = xpt_alloc_ccb_nowait();
6877                 if (work_ccb == NULL) {
6878                         busses_to_config--;
6879                         xpt_finishconfig(xpt_periph, NULL);
6880                         return(0);
6881                 }
6882                 if ((status = xpt_create_path(&path, xpt_periph, bus->path_id,
6883                                               CAM_TARGET_WILDCARD,
6884                                               CAM_LUN_WILDCARD)) !=CAM_REQ_CMP){
6885                         printf("xptconfigfunc: xpt_create_path failed with "
6886                                "status %#x for bus %d\n", status, bus->path_id);
6887                         printf("xptconfigfunc: halting bus configuration\n");
6888                         xpt_free_ccb(work_ccb);
6889                         busses_to_config--;
6890                         xpt_finishconfig(xpt_periph, NULL);
6891                         return(0);
6892                 }
6893                 xpt_setup_ccb(&work_ccb->ccb_h, path, /*priority*/1);
6894                 work_ccb->ccb_h.func_code = XPT_PATH_INQ;
6895                 xpt_action(work_ccb);
6896                 if (work_ccb->ccb_h.status != CAM_REQ_CMP) {
6897                         printf("xptconfigfunc: CPI failed on bus %d "
6898                                "with status %d\n", bus->path_id,
6899                                work_ccb->ccb_h.status);
6900                         xpt_finishconfig(xpt_periph, work_ccb);
6901                         return(1);
6902                 }
6903
6904                 can_negotiate = work_ccb->cpi.hba_inquiry;
6905                 can_negotiate &= (PI_WIDE_32|PI_WIDE_16|PI_SDTR_ABLE);
6906                 if ((work_ccb->cpi.hba_misc & PIM_NOBUSRESET) == 0
6907                  && (can_negotiate != 0)) {
6908                         xpt_setup_ccb(&work_ccb->ccb_h, path, /*priority*/1);
6909                         work_ccb->ccb_h.func_code = XPT_RESET_BUS;
6910                         work_ccb->ccb_h.cbfcnp = NULL;
6911                         CAM_DEBUG(path, CAM_DEBUG_SUBTRACE,
6912                                   ("Resetting Bus\n"));
6913                         xpt_action(work_ccb);
6914                         xpt_finishconfig(xpt_periph, work_ccb);
6915                 } else {
6916                         /* Act as though we performed a successful BUS RESET */
6917                         work_ccb->ccb_h.func_code = XPT_RESET_BUS;
6918                         xpt_finishconfig(xpt_periph, work_ccb);
6919                 }
6920         }
6921
6922         return(1);
6923 }
6924
6925 static void
6926 xpt_config(void *arg)
6927 {
6928         /*
6929          * Now that interrupts are enabled, go find our devices
6930          */
6931
6932 #ifdef CAMDEBUG
6933         /* Setup debugging flags and path */
6934 #ifdef CAM_DEBUG_FLAGS
6935         cam_dflags = CAM_DEBUG_FLAGS;
6936 #else /* !CAM_DEBUG_FLAGS */
6937         cam_dflags = CAM_DEBUG_NONE;
6938 #endif /* CAM_DEBUG_FLAGS */
6939 #ifdef CAM_DEBUG_BUS
6940         if (cam_dflags != CAM_DEBUG_NONE) {
6941                 /*
6942                  * Locking is specifically omitted here.  No SIMs have
6943                  * registered yet, so xpt_create_path will only be searching
6944                  * empty lists of targets and devices.
6945                  */
6946                 if (xpt_create_path(&cam_dpath, xpt_periph,
6947                                     CAM_DEBUG_BUS, CAM_DEBUG_TARGET,
6948                                     CAM_DEBUG_LUN) != CAM_REQ_CMP) {
6949                         printf("xpt_config: xpt_create_path() failed for debug"
6950                                " target %d:%d:%d, debugging disabled\n",
6951                                CAM_DEBUG_BUS, CAM_DEBUG_TARGET, CAM_DEBUG_LUN);
6952                         cam_dflags = CAM_DEBUG_NONE;
6953                 }
6954         } else
6955                 cam_dpath = NULL;
6956 #else /* !CAM_DEBUG_BUS */
6957         cam_dpath = NULL;
6958 #endif /* CAM_DEBUG_BUS */
6959 #endif /* CAMDEBUG */
6960
6961         /*
6962          * Scan all installed busses.
6963          */
6964         xpt_for_all_busses(xptconfigbuscountfunc, NULL);
6965
6966         if (busses_to_config == 0) {
6967                 /* Call manually because we don't have any busses */
6968                 xpt_finishconfig(xpt_periph, NULL);
6969         } else  {
6970                 if (busses_to_reset > 0 && scsi_delay >= 2000) {
6971                         printf("Waiting %d seconds for SCSI "
6972                                "devices to settle\n", scsi_delay/1000);
6973                 }
6974                 xpt_for_all_busses(xptconfigfunc, NULL);
6975         }
6976 }
6977
6978 /*
6979  * If the given device only has one peripheral attached to it, and if that
6980  * peripheral is the passthrough driver, announce it.  This insures that the
6981  * user sees some sort of announcement for every peripheral in their system.
6982  */
6983 static int
6984 xptpassannouncefunc(struct cam_ed *device, void *arg)
6985 {
6986         struct cam_periph *periph;
6987         int i;
6988
6989         for (periph = SLIST_FIRST(&device->periphs), i = 0; periph != NULL;
6990              periph = SLIST_NEXT(periph, periph_links), i++);
6991
6992         periph = SLIST_FIRST(&device->periphs);
6993         if ((i == 1)
6994          && (strncmp(periph->periph_name, "pass", 4) == 0))
6995                 xpt_announce_periph(periph, NULL);
6996
6997         return(1);
6998 }
6999
7000 static void
7001 xpt_finishconfig_task(void *context, int pending)
7002 {
7003         struct  periph_driver **p_drv;
7004         int     i;
7005
7006         if (busses_to_config == 0) {
7007                 /* Register all the peripheral drivers */
7008                 /* XXX This will have to change when we have loadable modules */
7009                 p_drv = periph_drivers;
7010                 for (i = 0; p_drv[i] != NULL; i++) {
7011                         (*p_drv[i]->init)();
7012                 }
7013
7014                 /*
7015                  * Check for devices with no "standard" peripheral driver
7016                  * attached.  For any devices like that, announce the
7017                  * passthrough driver so the user will see something.
7018                  */
7019                 xpt_for_all_devices(xptpassannouncefunc, NULL);
7020
7021                 /* Release our hook so that the boot can continue. */
7022                 config_intrhook_disestablish(xsoftc.xpt_config_hook);
7023                 free(xsoftc.xpt_config_hook, M_CAMXPT);
7024                 xsoftc.xpt_config_hook = NULL;
7025         }
7026
7027         free(context, M_CAMXPT);
7028 }
7029
7030 static void
7031 xpt_finishconfig(struct cam_periph *periph, union ccb *done_ccb)
7032 {
7033         struct  xpt_task *task;
7034
7035         if (done_ccb != NULL) {
7036                 CAM_DEBUG(done_ccb->ccb_h.path, CAM_DEBUG_TRACE,
7037                           ("xpt_finishconfig\n"));
7038                 switch(done_ccb->ccb_h.func_code) {
7039                 case XPT_RESET_BUS:
7040                         if (done_ccb->ccb_h.status == CAM_REQ_CMP) {
7041                                 done_ccb->ccb_h.func_code = XPT_SCAN_BUS;
7042                                 done_ccb->ccb_h.cbfcnp = xpt_finishconfig;
7043                                 done_ccb->crcn.flags = 0;
7044                                 xpt_action(done_ccb);
7045                                 return;
7046                         }
7047                         /* FALLTHROUGH */
7048                 case XPT_SCAN_BUS:
7049                 default:
7050                         xpt_free_path(done_ccb->ccb_h.path);
7051                         busses_to_config--;
7052                         break;
7053                 }
7054         }
7055
7056         if (busses_to_config == 0) {
7057                 task = malloc(sizeof(struct xpt_task), M_CAMXPT, M_NOWAIT);
7058                 if (task != NULL) {
7059                         TASK_INIT(&task->task, 0, xpt_finishconfig_task, task);
7060                         taskqueue_enqueue(taskqueue_thread, &task->task);
7061                 }
7062         }
7063
7064         if (done_ccb != NULL)
7065                 xpt_free_ccb(done_ccb);
7066 }
7067
7068 cam_status
7069 xpt_register_async(int event, ac_callback_t *cbfunc, void *cbarg,
7070                    struct cam_path *path)
7071 {
7072         struct ccb_setasync csa;
7073         cam_status status;
7074         int xptpath = 0;
7075
7076         if (path == NULL) {
7077                 mtx_lock(&xsoftc.xpt_lock);
7078                 status = xpt_create_path(&path, /*periph*/NULL, CAM_XPT_PATH_ID,
7079                                          CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD);
7080                 if (status != CAM_REQ_CMP) {
7081                         mtx_unlock(&xsoftc.xpt_lock);
7082                         return (status);
7083                 }
7084                 xptpath = 1;
7085         }
7086
7087         xpt_setup_ccb(&csa.ccb_h, path, /*priority*/5);
7088         csa.ccb_h.func_code = XPT_SASYNC_CB;
7089         csa.event_enable = event;
7090         csa.callback = cbfunc;
7091         csa.callback_arg = cbarg;
7092         xpt_action((union ccb *)&csa);
7093         status = csa.ccb_h.status;
7094         if (xptpath) {
7095                 xpt_free_path(path);
7096                 mtx_unlock(&xsoftc.xpt_lock);
7097         }
7098         return (status);
7099 }
7100
7101 static void
7102 xptaction(struct cam_sim *sim, union ccb *work_ccb)
7103 {
7104         CAM_DEBUG(work_ccb->ccb_h.path, CAM_DEBUG_TRACE, ("xptaction\n"));
7105
7106         switch (work_ccb->ccb_h.func_code) {
7107         /* Common cases first */
7108         case XPT_PATH_INQ:              /* Path routing inquiry */
7109         {
7110                 struct ccb_pathinq *cpi;
7111
7112                 cpi = &work_ccb->cpi;
7113                 cpi->version_num = 1; /* XXX??? */
7114                 cpi->hba_inquiry = 0;
7115                 cpi->target_sprt = 0;
7116                 cpi->hba_misc = 0;
7117                 cpi->hba_eng_cnt = 0;
7118                 cpi->max_target = 0;
7119                 cpi->max_lun = 0;
7120                 cpi->initiator_id = 0;
7121                 strncpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN);
7122                 strncpy(cpi->hba_vid, "", HBA_IDLEN);
7123                 strncpy(cpi->dev_name, sim->sim_name, DEV_IDLEN);
7124                 cpi->unit_number = sim->unit_number;
7125                 cpi->bus_id = sim->bus_id;
7126                 cpi->base_transfer_speed = 0;
7127                 cpi->protocol = PROTO_UNSPECIFIED;
7128                 cpi->protocol_version = PROTO_VERSION_UNSPECIFIED;
7129                 cpi->transport = XPORT_UNSPECIFIED;
7130                 cpi->transport_version = XPORT_VERSION_UNSPECIFIED;
7131                 cpi->ccb_h.status = CAM_REQ_CMP;
7132                 xpt_done(work_ccb);
7133                 break;
7134         }
7135         default:
7136                 work_ccb->ccb_h.status = CAM_REQ_INVALID;
7137                 xpt_done(work_ccb);
7138                 break;
7139         }
7140 }
7141
7142 /*
7143  * The xpt as a "controller" has no interrupt sources, so polling
7144  * is a no-op.
7145  */
7146 static void
7147 xptpoll(struct cam_sim *sim)
7148 {
7149 }
7150
7151 void
7152 xpt_lock_buses(void)
7153 {
7154         mtx_lock(&xsoftc.xpt_topo_lock);
7155 }
7156
7157 void
7158 xpt_unlock_buses(void)
7159 {
7160         mtx_unlock(&xsoftc.xpt_topo_lock);
7161 }
7162
7163 static void
7164 camisr(void *dummy)
7165 {
7166         cam_simq_t queue;
7167         struct cam_sim *sim;
7168
7169         mtx_lock(&cam_simq_lock);
7170         TAILQ_INIT(&queue);
7171         TAILQ_CONCAT(&queue, &cam_simq, links);
7172         mtx_unlock(&cam_simq_lock);
7173
7174         while ((sim = TAILQ_FIRST(&queue)) != NULL) {
7175                 TAILQ_REMOVE(&queue, sim, links);
7176                 CAM_SIM_LOCK(sim);
7177                 sim->flags &= ~CAM_SIM_ON_DONEQ;
7178                 camisr_runqueue(&sim->sim_doneq);
7179                 CAM_SIM_UNLOCK(sim);
7180         }
7181 }
7182
7183 static void
7184 camisr_runqueue(void *V_queue)
7185 {
7186         cam_isrq_t *queue = V_queue;
7187         struct  ccb_hdr *ccb_h;
7188
7189         while ((ccb_h = TAILQ_FIRST(queue)) != NULL) {
7190                 int     runq;
7191
7192                 TAILQ_REMOVE(queue, ccb_h, sim_links.tqe);
7193                 ccb_h->pinfo.index = CAM_UNQUEUED_INDEX;
7194
7195                 CAM_DEBUG(ccb_h->path, CAM_DEBUG_TRACE,
7196                           ("camisr\n"));
7197
7198                 runq = FALSE;
7199
7200                 if (ccb_h->flags & CAM_HIGH_POWER) {
7201                         struct highpowerlist    *hphead;
7202                         union ccb               *send_ccb;
7203
7204                         mtx_lock(&xsoftc.xpt_lock);
7205                         hphead = &xsoftc.highpowerq;
7206
7207                         send_ccb = (union ccb *)STAILQ_FIRST(hphead);
7208
7209                         /*
7210                          * Increment the count since this command is done.
7211                          */
7212                         xsoftc.num_highpower++;
7213
7214                         /*
7215                          * Any high powered commands queued up?
7216                          */
7217                         if (send_ccb != NULL) {
7218
7219                                 STAILQ_REMOVE_HEAD(hphead, xpt_links.stqe);
7220                                 mtx_unlock(&xsoftc.xpt_lock);
7221
7222                                 xpt_release_devq(send_ccb->ccb_h.path,
7223                                                  /*count*/1, /*runqueue*/TRUE);
7224                         } else
7225                                 mtx_unlock(&xsoftc.xpt_lock);
7226                 }
7227
7228                 if ((ccb_h->func_code & XPT_FC_USER_CCB) == 0) {
7229                         struct cam_ed *dev;
7230
7231                         dev = ccb_h->path->device;
7232
7233                         cam_ccbq_ccb_done(&dev->ccbq, (union ccb *)ccb_h);
7234                         ccb_h->path->bus->sim->devq->send_active--;
7235                         ccb_h->path->bus->sim->devq->send_openings++;
7236
7237                         if (((dev->flags & CAM_DEV_REL_ON_COMPLETE) != 0
7238                           && (ccb_h->status&CAM_STATUS_MASK) != CAM_REQUEUE_REQ)
7239                          || ((dev->flags & CAM_DEV_REL_ON_QUEUE_EMPTY) != 0
7240                           && (dev->ccbq.dev_active == 0))) {
7241
7242                                 xpt_release_devq(ccb_h->path, /*count*/1,
7243                                                  /*run_queue*/TRUE);
7244                         }
7245
7246                         if ((dev->flags & CAM_DEV_TAG_AFTER_COUNT) != 0
7247                          && (--dev->tag_delay_count == 0))
7248                                 xpt_start_tags(ccb_h->path);
7249
7250                         if ((dev->ccbq.queue.entries > 0)
7251                          && (dev->qfrozen_cnt == 0)
7252                          && (device_is_send_queued(dev) == 0)) {
7253                                 runq = xpt_schedule_dev_sendq(ccb_h->path->bus,
7254                                                               dev);
7255                         }
7256                 }
7257
7258                 if (ccb_h->status & CAM_RELEASE_SIMQ) {
7259                         xpt_release_simq(ccb_h->path->bus->sim,
7260                                          /*run_queue*/TRUE);
7261                         ccb_h->status &= ~CAM_RELEASE_SIMQ;
7262                         runq = FALSE;
7263                 }
7264
7265                 if ((ccb_h->flags & CAM_DEV_QFRZDIS)
7266                  && (ccb_h->status & CAM_DEV_QFRZN)) {
7267                         xpt_release_devq(ccb_h->path, /*count*/1,
7268                                          /*run_queue*/TRUE);
7269                         ccb_h->status &= ~CAM_DEV_QFRZN;
7270                 } else if (runq) {
7271                         xpt_run_dev_sendq(ccb_h->path->bus);
7272                 }
7273
7274                 /* Call the peripheral driver's callback */
7275                 (*ccb_h->cbfcnp)(ccb_h->path->periph, (union ccb *)ccb_h);
7276         }
7277 }
7278