0c83d3c5895dc5ab4da4378ceacb6a5fba848a0c
[dragonfly.git] / sys / bus / cam / scsi / scsi_da.c
1 /*
2  * Implementation of SCSI Direct Access Peripheral driver for CAM.
3  *
4  * Copyright (c) 1997 Justin T. Gibbs.
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions, and the following disclaimer,
12  *    without modification, immediately at the beginning of the file.
13  * 2. The name of the author may not be used to endorse or promote products
14  *    derived from this software without specific prior written permission.
15  *
16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
20  * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26  * SUCH DAMAGE.
27  *
28  * $FreeBSD: src/sys/cam/scsi/scsi_da.c,v 1.42.2.46 2003/10/21 22:18:19 thomas Exp $
29  */
30
31 #include <sys/param.h>
32
33 #ifdef _KERNEL
34
35 #include <sys/systm.h>
36 #include <sys/kernel.h>
37 #include <sys/buf.h>
38 #include <sys/sysctl.h>
39 #include <sys/taskqueue.h>
40 #include <sys/lock.h>
41 #include <sys/conf.h>
42 #include <sys/devicestat.h>
43 #include <sys/disk.h>
44 #include <sys/dtype.h>
45 #include <sys/eventhandler.h>
46 #include <sys/malloc.h>
47 #include <sys/cons.h>
48 #include <sys/proc.h>
49 #include <sys/ioctl_compat.h>
50
51 #include <sys/buf2.h>
52 #include <sys/thread2.h>
53 #include <sys/mplock2.h>
54
55 #endif /* _KERNEL */
56
57 #ifdef _KERNEL
58 #include <vm/pmap.h>
59 #endif
60
61 #ifndef _KERNEL
62 #include <stdio.h>
63 #include <string.h>
64 #endif /* _KERNEL */
65
66 #include <sys/camlib.h>
67 #include "../cam.h"
68 #include "../cam_ccb.h"
69 #include "../cam_extend.h"
70 #include "../cam_periph.h"
71 #include "../cam_xpt_periph.h"
72 #include "../cam_sim.h"
73
74 #include "scsi_message.h"
75
76 #ifndef _KERNEL 
77 #include "scsi_da.h"
78 #endif /* !_KERNEL */
79
80 #ifdef _KERNEL
81 typedef enum {
82         DA_STATE_PROBE,
83         DA_STATE_PROBE2,
84         DA_STATE_NORMAL
85 } da_state;
86
87 typedef enum {
88         DA_FLAG_PACK_INVALID    = 0x001,
89         DA_FLAG_NEW_PACK        = 0x002,
90         DA_FLAG_PACK_LOCKED     = 0x004,
91         DA_FLAG_PACK_REMOVABLE  = 0x008,
92         DA_FLAG_TAGGED_QUEUING  = 0x010,
93         DA_FLAG_NEED_OTAG       = 0x020,
94         DA_FLAG_WENT_IDLE       = 0x040,
95         DA_FLAG_RETRY_UA        = 0x080,
96         DA_FLAG_OPEN            = 0x100,
97         DA_FLAG_SCTX_INIT       = 0x200,
98         DA_FLAG_RD_LIMIT        = 0x400,
99         DA_FLAG_WR_LIMIT        = 0x800,
100         DA_FLAG_CAN_TRIM        = 0x1000
101 } da_flags;
102
103 typedef enum {
104         DA_Q_NONE               = 0x00,
105         DA_Q_NO_SYNC_CACHE      = 0x01,
106         DA_Q_NO_6_BYTE          = 0x02,
107         DA_Q_NO_PREVENT         = 0x04
108 } da_quirks;
109
110 typedef enum {
111         DA_CCB_PROBE            = 0x01,
112         DA_CCB_PROBE2           = 0x02,
113         DA_CCB_BUFFER_IO        = 0x03,
114         DA_CCB_WAITING          = 0x04,
115         DA_CCB_DUMP             = 0x05,
116         DA_CCB_TRIM             = 0x06,
117         DA_CCB_TYPE_MASK        = 0x0F,
118         DA_CCB_RETRY_UA         = 0x10
119 } da_ccb_state;
120
121 /* Offsets into our private area for storing information */
122 #define ccb_state       ppriv_field0
123 #define ccb_bio         ppriv_ptr1
124
125 struct disk_params {
126         u_int8_t  heads;
127         u_int32_t cylinders;
128         u_int8_t  secs_per_track;
129         u_int32_t secsize;      /* Number of bytes/sector */
130         u_int64_t sectors;      /* total number sectors */
131 };
132
133 #define TRIM_MAX_BLOCKS 8
134 #define TRIM_MAX_RANGES TRIM_MAX_BLOCKS * 64
135 struct trim_request {
136         uint8_t         data[TRIM_MAX_RANGES * 8];
137         struct bio      *bios[TRIM_MAX_RANGES];
138 };
139
140 struct da_softc {
141         struct   bio_queue_head bio_queue_rd;
142         struct   bio_queue_head bio_queue_wr;
143         struct   bio_queue_head bio_queue_trim;
144         struct   devstat device_stats;
145         SLIST_ENTRY(da_softc) links;
146         LIST_HEAD(, ccb_hdr) pending_ccbs;
147         da_state state;
148         da_flags flags; 
149         da_quirks quirks;
150         int      minimum_cmd_size;
151         int      ordered_tag_count;
152         int      outstanding_cmds_rd;
153         int      outstanding_cmds_wr;
154         int      trim_max_ranges;
155         int      trim_running;
156         int      trim_enabled;
157         struct   disk_params params;
158         struct   disk disk;
159         union    ccb saved_ccb;
160         struct task             sysctl_task;
161         struct sysctl_ctx_list  sysctl_ctx;
162         struct sysctl_oid       *sysctl_tree;
163         struct callout          sendordered_c;
164         struct trim_request     trim_req;
165 };
166
167 struct da_quirk_entry {
168         struct scsi_inquiry_pattern inq_pat;
169         da_quirks quirks;
170 };
171
172 static const char quantum[] = "QUANTUM";
173 static const char microp[] = "MICROP";
174
175 static struct da_quirk_entry da_quirk_table[] =
176 {
177         /* SPI, FC devices */
178         {
179                 /*
180                  * Fujitsu M2513A MO drives.
181                  * Tested devices: M2513A2 firmware versions 1200 & 1300.
182                  * (dip switch selects whether T_DIRECT or T_OPTICAL device)
183                  * Reported by: W.Scholten <whs@xs4all.nl>
184                  */
185                 {T_DIRECT, SIP_MEDIA_REMOVABLE, "FUJITSU", "M2513A", "*"},
186                 /*quirks*/ DA_Q_NO_SYNC_CACHE
187         },
188         {
189                 /* See above. */
190                 {T_OPTICAL, SIP_MEDIA_REMOVABLE, "FUJITSU", "M2513A", "*"},
191                 /*quirks*/ DA_Q_NO_SYNC_CACHE
192         },
193         {
194                 /*
195                  * This particular Fujitsu drive doesn't like the
196                  * synchronize cache command.
197                  * Reported by: Tom Jackson <toj@gorilla.net>
198                  */
199                 {T_DIRECT, SIP_MEDIA_FIXED, "FUJITSU", "M2954*", "*"},
200                 /*quirks*/ DA_Q_NO_SYNC_CACHE
201         },
202         {
203                 /*
204                  * This drive doesn't like the synchronize cache command
205                  * either.  Reported by: Matthew Jacob <mjacob@feral.com>
206                  * in NetBSD PR kern/6027, August 24, 1998.
207                  */
208                 {T_DIRECT, SIP_MEDIA_FIXED, microp, "2217*", "*"},
209                 /*quirks*/ DA_Q_NO_SYNC_CACHE
210         },
211         {
212                 /*
213                  * This drive doesn't like the synchronize cache command
214                  * either.  Reported by: Hellmuth Michaelis (hm@kts.org)
215                  * (PR 8882).
216                  */
217                 {T_DIRECT, SIP_MEDIA_FIXED, microp, "2112*", "*"},
218                 /*quirks*/ DA_Q_NO_SYNC_CACHE
219         },
220         {
221                 /*
222                  * Doesn't like the synchronize cache command.
223                  * Reported by: Blaz Zupan <blaz@gold.amis.net>
224                  */
225                 {T_DIRECT, SIP_MEDIA_FIXED, "NEC", "D3847*", "*"},
226                 /*quirks*/ DA_Q_NO_SYNC_CACHE
227         },
228         {
229                 /*
230                  * Doesn't like the synchronize cache command.
231                  * Reported by: Blaz Zupan <blaz@gold.amis.net>
232                  */
233                 {T_DIRECT, SIP_MEDIA_FIXED, quantum, "MAVERICK 540S", "*"},
234                 /*quirks*/ DA_Q_NO_SYNC_CACHE
235         },
236         {
237                 /*
238                  * Doesn't like the synchronize cache command.
239                  */
240                 {T_DIRECT, SIP_MEDIA_FIXED, quantum, "LPS525S", "*"},
241                 /*quirks*/ DA_Q_NO_SYNC_CACHE
242         },
243         {
244                 /*
245                  * Doesn't like the synchronize cache command.
246                  * Reported by: walter@pelissero.de
247                  */
248                 {T_DIRECT, SIP_MEDIA_FIXED, quantum, "LPS540S", "*"},
249                 /*quirks*/ DA_Q_NO_SYNC_CACHE
250         },
251         {
252                 /*
253                  * Doesn't work correctly with 6 byte reads/writes.
254                  * Returns illegal request, and points to byte 9 of the
255                  * 6-byte CDB.
256                  * Reported by:  Adam McDougall <bsdx@spawnet.com>
257                  */
258                 {T_DIRECT, SIP_MEDIA_FIXED, quantum, "VIKING 4*", "*"},
259                 /*quirks*/ DA_Q_NO_6_BYTE
260         },
261         {
262                 /* See above. */
263                 {T_DIRECT, SIP_MEDIA_FIXED, quantum, "VIKING 2*", "*"},
264                 /*quirks*/ DA_Q_NO_6_BYTE
265         },
266         {
267                 /*
268                  * Doesn't like the synchronize cache command.
269                  * Reported by: walter@pelissero.de
270                  */
271                 {T_DIRECT, SIP_MEDIA_FIXED, "CONNER", "CP3500*", "*"},
272                 /*quirks*/ DA_Q_NO_SYNC_CACHE
273         },
274         {
275                 /*
276                  * The CISS RAID controllers do not support SYNC_CACHE
277                  */
278                 {T_DIRECT, SIP_MEDIA_FIXED, "COMPAQ", "RAID*", "*"},
279                 /*quirks*/ DA_Q_NO_SYNC_CACHE
280         },
281         {
282                 /*
283                  * The same goes for the mly(4) controllers
284                  */
285                 {T_DIRECT, SIP_MEDIA_FIXED, "MLY*", "*", "MYLX"},
286                 /*quirks*/ DA_Q_NO_SYNC_CACHE
287         },
288         /*
289          * USB mass storage devices supported by umass(4)
290          *
291          * NOTE: USB attachments automatically set DA_Q_NO_SYNC_CACHE so
292          *       it does not have to be specified here.
293          */
294         {
295                 /*
296                  * Creative Nomad MUVO mp3 player (USB)
297                  * PR: kern/53094
298                  */
299                 {T_DIRECT, SIP_MEDIA_REMOVABLE, "CREATIVE", "NOMAD_MUVO", "*"},
300                 /*quirks*/ DA_Q_NO_PREVENT
301         },
302         {
303                 /*
304                  * Sigmatel USB Flash MP3 Player
305                  * PR: kern/57046
306                  */
307                 {T_DIRECT, SIP_MEDIA_REMOVABLE, "SigmaTel", "MSCN", "*"},
308                 /*quirks*/ DA_Q_NO_PREVENT
309         },
310         {
311                 /*
312                  * SEAGRAND NP-900 MP3 Player
313                  * PR: kern/64563
314                  */
315                 {T_DIRECT, SIP_MEDIA_REMOVABLE, "SEAGRAND", "NP-900*", "*"},
316                 /*quirks*/ DA_Q_NO_PREVENT
317         },
318         {
319                 /*
320                  * Creative MUVO Slim mp3 player (USB)
321                  * PR: usb/86131
322                  */
323                 {T_DIRECT, SIP_MEDIA_REMOVABLE, "CREATIVE", "MuVo Slim",
324                 "*"}, /*quirks*/ DA_Q_NO_PREVENT
325         },
326         {
327                 /*
328                  * Philips USB Key Audio KEY013
329                  * PR: usb/68412
330                  */
331                 {T_DIRECT, SIP_MEDIA_REMOVABLE, "PHILIPS", "Key*", "*"},
332                 /*quirks*/ DA_Q_NO_PREVENT
333         },
334 };
335
336 static  d_open_t        daopen;
337 static  d_close_t       daclose;
338 static  d_strategy_t    dastrategy;
339 static  d_dump_t        dadump;
340 static  d_ioctl_t       daioctl;
341 static  periph_init_t   dainit;
342 static  void            daasync(void *callback_arg, u_int32_t code,
343                                 struct cam_path *path, void *arg);
344 static  int             dacmdsizesysctl(SYSCTL_HANDLER_ARGS);
345 static  periph_ctor_t   daregister;
346 static  periph_dtor_t   dacleanup;
347 static  periph_start_t  dastart;
348 static  periph_oninv_t  daoninvalidate;
349 static  void            dadone(struct cam_periph *periph,
350                                union ccb *done_ccb);
351 static  int             daerror(union ccb *ccb, u_int32_t cam_flags,
352                                 u_int32_t sense_flags);
353 static void             daprevent(struct cam_periph *periph, int action);
354 static int              dagetcapacity(struct cam_periph *periph);
355 static int              dacheckmedia(struct cam_periph *periph);
356 static void             dasetgeom(struct cam_periph *periph, uint32_t block_len,
357                                   uint64_t maxsector);
358 static void             daflushbioq(struct bio_queue_head *bioq, int error);
359 static timeout_t        dasendorderedtag;
360 static void             dashutdown(void *arg, int howto);
361
362 #ifndef DA_DEFAULT_TIMEOUT
363 #define DA_DEFAULT_TIMEOUT 60   /* Timeout in seconds */
364 #endif
365
366 #ifndef DA_DEFAULT_RETRY
367 #define DA_DEFAULT_RETRY        4
368 #endif
369
370 #ifndef DA_DEFAULT_SEND_ORDERED
371 #define DA_DEFAULT_SEND_ORDERED 1
372 #endif
373
374 static int da_retry_count = DA_DEFAULT_RETRY;
375 static int da_default_timeout = DA_DEFAULT_TIMEOUT;
376 static int da_send_ordered = DA_DEFAULT_SEND_ORDERED;
377 static struct callout dasendorderedtag_ch;
378
379 SYSCTL_NODE(_kern_cam, OID_AUTO, da, CTLFLAG_RD, 0,
380             "CAM Direct Access Disk driver");
381 SYSCTL_INT(_kern_cam_da, OID_AUTO, retry_count, CTLFLAG_RW,
382            &da_retry_count, 0, "Normal I/O retry count");
383 TUNABLE_INT("kern.cam.da.retry_count", &da_retry_count);
384 SYSCTL_INT(_kern_cam_da, OID_AUTO, default_timeout, CTLFLAG_RW,
385            &da_default_timeout, 0, "Normal I/O timeout (in seconds)");
386 TUNABLE_INT("kern.cam.da.default_timeout", &da_default_timeout);
387 SYSCTL_INT(_kern_cam_da, OID_AUTO, da_send_ordered, CTLFLAG_RW,
388            &da_send_ordered, 0, "Send Ordered Tags");
389 TUNABLE_INT("kern.cam.da.da_send_ordered", &da_send_ordered);
390
391 /*
392  * DA_ORDEREDTAG_INTERVAL determines how often, relative
393  * to the default timeout, we check to see whether an ordered
394  * tagged transaction is appropriate to prevent simple tag
395  * starvation.  Since we'd like to ensure that there is at least
396  * 1/2 of the timeout length left for a starved transaction to
397  * complete after we've sent an ordered tag, we must poll at least
398  * four times in every timeout period.  This takes care of the worst
399  * case where a starved transaction starts during an interval that
400  * meets the requirement "don't send an ordered tag" test so it takes
401  * us two intervals to determine that a tag must be sent.
402  */
403 #ifndef DA_ORDEREDTAG_INTERVAL
404 #define DA_ORDEREDTAG_INTERVAL 4
405 #endif
406
407 static struct periph_driver dadriver =
408 {
409         dainit, "da",
410         TAILQ_HEAD_INITIALIZER(dadriver.units), /* generation */ 0
411 };
412
413 PERIPHDRIVER_DECLARE(da, dadriver);
414
415 static struct dev_ops da_ops = {
416         { "da", 0, D_DISK | D_MPSAFE },
417         .d_open =       daopen,
418         .d_close =      daclose,
419         .d_read =       physread,
420         .d_write =      physwrite,
421         .d_strategy =   dastrategy,
422         .d_dump =       dadump,
423         .d_ioctl =      daioctl
424 };
425
426 static struct extend_array *daperiphs;
427
428 MALLOC_DEFINE(M_SCSIDA, "scsi_da", "scsi_da buffers");
429
430 static int
431 daioctl(struct dev_ioctl_args *ap)
432 {       
433         int unit;
434         int error = 0;  
435         struct buf *bp;         
436         struct cam_periph *periph;
437         int byte_count;
438         struct da_softc * softc;
439
440         off_t *del_num = (off_t*)ap->a_data;
441         off_t bytes_left;
442         off_t bytes_start;              
443
444         cdev_t dev = ap->a_head.a_dev;
445
446
447         unit = dkunit(dev);
448         periph = cam_extend_get(daperiphs, unit);
449         if (periph == NULL)
450                 return(ENXIO);
451         softc = (struct da_softc *)periph->softc;
452         
453         switch (ap->a_cmd) {
454         case IOCTLTRIM:
455         {
456
457                 bytes_left = del_num[1];
458                 bytes_start = del_num[0];
459
460                 /* TRIM occurs on 512-byte sectors. */
461                 KKASSERT((bytes_left % 512) == 0);
462                 KKASSERT((bytes_start% 512) == 0);
463
464                 
465                 /* Break TRIM up into int-sized commands because of b_bcount */
466                 while(bytes_left) {
467
468                         /* 
469                          * Rather than than squezing out more blocks in b_bcount 
470                          * and having to break up the TRIM request in da_start(),
471                          * we ensure we can always TRIM this many bytes with one 
472                          * TRIM command (this happens if the device only 
473                          * supports one TRIM block). 
474                          *  
475                          * With min TRIM blksize of 1, TRIM command free
476                          * 4194240 blks(64*65535): each LBA range can address 
477                          * 65535 blks and there 64 such ranges in a 512-byte 
478                          * block. And, 4194240 * 512 = 0x7FFF8000
479                          * 
480                          */
481                         byte_count = MIN(bytes_left,0x7FFF8000);
482                         bp = getnewbuf(0,0,0,1);
483                 
484                         bp->b_cmd = BUF_CMD_FREEBLKS;
485                         bp->b_bio1.bio_offset = bytes_start;
486                         bp->b_bcount = byte_count;
487                         bp->b_bio1.bio_flags |= BIO_SYNC;
488                         bp->b_bio1.bio_done = biodone_sync;
489                 
490                         dev_dstrategy(ap->a_head.a_dev, &bp->b_bio1);
491                 
492                         if (biowait(&bp->b_bio1, "TRIM")) {
493                                 kprintf("Error:%d\n", bp->b_error);
494                                 return(bp->b_error ? bp->b_error : EIO);
495                         }
496                         brelse(bp);
497                         bytes_left -= byte_count;
498                         bytes_start += byte_count;      
499                 }
500                 break;
501         }
502         default:
503                 return(EINVAL);
504         }       
505         
506         return(error);
507 }
508
509 static int
510 daopen(struct dev_open_args *ap)
511 {
512         cdev_t dev = ap->a_head.a_dev;
513         struct cam_periph *periph;
514         struct da_softc *softc;
515         struct disk_info info;
516         int unit;
517         int error;
518
519         unit = dkunit(dev);
520         periph = cam_extend_get(daperiphs, unit);
521         if (periph == NULL) {
522                 return (ENXIO); 
523         }
524
525         if (cam_periph_acquire(periph) != CAM_REQ_CMP) {
526                 return(ENXIO);
527         }
528
529         cam_periph_lock(periph);
530         if ((error = cam_periph_hold(periph, PCATCH)) != 0) {
531                 cam_periph_unlock(periph);
532                 cam_periph_release(periph);
533                 return (error);
534         }
535
536         unit = periph->unit_number;
537         softc = (struct da_softc *)periph->softc;
538
539         CAM_DEBUG(periph->path, CAM_DEBUG_TRACE,
540             ("daopen: dev=%s (unit %d)\n", devtoname(dev),
541              unit));
542
543         if ((softc->flags & DA_FLAG_PACK_INVALID) != 0) {
544                 /* Invalidate our pack information. */
545                 disk_invalidate(&softc->disk);
546                 softc->flags &= ~DA_FLAG_PACK_INVALID;
547         }
548
549         error = dacheckmedia(periph);
550         softc->flags |= DA_FLAG_OPEN;
551
552         if (error == 0) {
553                 struct ccb_getdev cgd;
554
555                 /* Build disk information structure */
556                 bzero(&info, sizeof(info));
557                 info.d_type = DTYPE_SCSI;
558
559                 /*
560                  * Grab the inquiry data to get the vendor and product names.
561                  * Put them in the typename and packname for the label.
562                  */
563                 xpt_setup_ccb(&cgd.ccb_h, periph->path, /*priority*/ 1);
564                 cgd.ccb_h.func_code = XPT_GDEV_TYPE;
565                 xpt_action((union ccb *)&cgd);
566
567                 /*
568                  * Check to see whether or not the blocksize is set yet.
569                  * If it isn't, set it and then clear the blocksize
570                  * unavailable flag for the device statistics.
571                  */
572                 if ((softc->device_stats.flags & DEVSTAT_BS_UNAVAILABLE) != 0){
573                         softc->device_stats.block_size = softc->params.secsize;
574                         softc->device_stats.flags &= ~DEVSTAT_BS_UNAVAILABLE;
575                 }
576         }
577         
578         if (error == 0) {
579                 if ((softc->flags & DA_FLAG_PACK_REMOVABLE) != 0 &&
580                     (softc->quirks & DA_Q_NO_PREVENT) == 0)
581                         daprevent(periph, PR_PREVENT);
582         } else {
583                 softc->flags &= ~DA_FLAG_OPEN;
584                 cam_periph_release(periph);
585         }
586         cam_periph_unhold(periph, 1);
587         return (error);
588 }
589
590 static int
591 daclose(struct dev_close_args *ap)
592 {
593         cdev_t dev = ap->a_head.a_dev;
594         struct  cam_periph *periph;
595         struct  da_softc *softc;
596         int     unit;
597         int     error;
598
599         unit = dkunit(dev);
600         periph = cam_extend_get(daperiphs, unit);
601         if (periph == NULL)
602                 return (ENXIO); 
603
604         cam_periph_lock(periph);
605         if ((error = cam_periph_hold(periph, 0)) != 0) {
606                 cam_periph_unlock(periph);
607                 cam_periph_release(periph);
608                 return (error);
609         }
610
611         softc = (struct da_softc *)periph->softc;
612
613         if ((softc->quirks & DA_Q_NO_SYNC_CACHE) == 0) {
614                 union   ccb *ccb;
615
616                 ccb = cam_periph_getccb(periph, /*priority*/1);
617
618                 scsi_synchronize_cache(&ccb->csio,
619                                        /*retries*/1,
620                                        /*cbfcnp*/dadone,
621                                        MSG_SIMPLE_Q_TAG,
622                                        /*begin_lba*/0,/* Cover the whole disk */
623                                        /*lb_count*/0,
624                                        SSD_FULL_SIZE,
625                                        5 * 60 * 1000);
626
627                 cam_periph_runccb(ccb, /*error_routine*/NULL, /*cam_flags*/0,
628                                   /*sense_flags*/SF_RETRY_UA,
629                                   &softc->device_stats);
630
631                 if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
632                         if ((ccb->ccb_h.status & CAM_STATUS_MASK) ==
633                              CAM_SCSI_STATUS_ERROR) {
634                                 int asc, ascq;
635                                 int sense_key, error_code;
636
637                                 scsi_extract_sense(&ccb->csio.sense_data,
638                                                    &error_code,
639                                                    &sense_key, 
640                                                    &asc, &ascq);
641                                 if (sense_key != SSD_KEY_ILLEGAL_REQUEST)
642                                         scsi_sense_print(&ccb->csio);
643                         } else {
644                                 xpt_print(periph->path, "Synchronize cache "
645                                     "failed, status == 0x%x, scsi status == "
646                                     "0x%x\n", ccb->csio.ccb_h.status,
647                                     ccb->csio.scsi_status);
648                         }
649                 }
650
651                 if ((ccb->ccb_h.status & CAM_DEV_QFRZN) != 0)
652                         cam_release_devq(ccb->ccb_h.path,
653                                          /*relsim_flags*/0,
654                                          /*reduction*/0,
655                                          /*timeout*/0,
656                                          /*getcount_only*/0);
657
658                 xpt_release_ccb(ccb);
659
660         }
661
662         if ((softc->flags & DA_FLAG_PACK_REMOVABLE) != 0) {
663                 if ((softc->quirks & DA_Q_NO_PREVENT) == 0)
664                         daprevent(periph, PR_ALLOW);
665                 /*
666                  * If we've got removeable media, mark the blocksize as
667                  * unavailable, since it could change when new media is
668                  * inserted.
669                  */
670                 softc->device_stats.flags |= DEVSTAT_BS_UNAVAILABLE;
671         }
672
673         /*
674          * Don't compound any ref counting software bugs with more.
675          */
676         if (softc->flags & DA_FLAG_OPEN) {
677                 softc->flags &= ~DA_FLAG_OPEN;
678                 cam_periph_release(periph);
679         } else {
680                 xpt_print(periph->path,
681                           "daclose() called on an already closed device!\n");
682         }
683         cam_periph_unhold(periph, 1);
684         return (0);     
685 }
686
687 /*
688  * Actually translate the requested transfer into one the physical driver
689  * can understand.  The transfer is described by a buf and will include
690  * only one physical transfer.
691  */
692 static int
693 dastrategy(struct dev_strategy_args *ap)
694 {
695         cdev_t dev = ap->a_head.a_dev;
696         struct bio *bio = ap->a_bio;
697         struct buf *bp = bio->bio_buf;
698         struct cam_periph *periph;
699         struct da_softc *softc;
700         u_int  unit;
701         u_int  part;
702         
703         unit = dkunit(dev);
704         part = dkpart(dev);
705         periph = cam_extend_get(daperiphs, unit);
706         if (periph == NULL) {
707                 bp->b_error = ENXIO;
708                 goto bad;               
709         }
710         softc = (struct da_softc *)periph->softc;
711
712         cam_periph_lock(periph);
713
714 #if 0
715         /*
716          * check it's not too big a transfer for our adapter
717          */
718         scsi_minphys(bp, &sd_switch);
719 #endif
720
721         /*
722          * Mask interrupts so that the pack cannot be invalidated until
723          * after we are in the queue.  Otherwise, we might not properly
724          * clean up one of the buffers.
725          */
726         
727         /*
728          * If the device has been made invalid, error out
729          */
730         if ((softc->flags & DA_FLAG_PACK_INVALID)) {
731                 cam_periph_unlock(periph);
732                 bp->b_error = ENXIO;
733                 goto bad;
734         }
735         
736         /*
737          * Place it in the queue of disk activities for this disk
738          */
739         if (bp->b_cmd == BUF_CMD_WRITE || bp->b_cmd == BUF_CMD_FLUSH)
740                 bioqdisksort(&softc->bio_queue_wr, bio);
741         else if (bp->b_cmd == BUF_CMD_FREEBLKS) 
742                 bioqdisksort(&softc->bio_queue_trim, bio);
743         else
744                 bioqdisksort(&softc->bio_queue_rd, bio);
745         
746         /*
747          * Schedule ourselves for performing the work.
748          */
749         xpt_schedule(periph, /* XXX priority */1);
750         cam_periph_unlock(periph);
751
752         return(0);
753 bad:
754         bp->b_flags |= B_ERROR;
755
756         /*
757          * Correctly set the buf to indicate a completed xfer
758          */
759         bp->b_resid = bp->b_bcount;
760         biodone(bio);
761         return(0);
762 }
763
764 static int
765 dadump(struct dev_dump_args *ap)
766 {
767         cdev_t dev = ap->a_head.a_dev;
768         struct      cam_periph *periph;
769         struct      da_softc *softc;
770         u_int       unit;
771         u_int32_t   secsize;
772         struct      ccb_scsiio csio;
773
774         unit = dkunit(dev);
775         periph = cam_extend_get(daperiphs, unit);
776         if (periph == NULL)
777                 return (ENXIO);
778
779         softc = (struct da_softc *)periph->softc;
780         cam_periph_lock(periph);
781         secsize = softc->params.secsize; /* XXX: or ap->a_secsize? */
782
783         if ((softc->flags & DA_FLAG_PACK_INVALID) != 0) {
784                 cam_periph_unlock(periph);
785                 return (ENXIO);
786         }
787
788         /*
789          * because length == 0 means we are supposed to flush cache, we only
790          * try to write something if length > 0.
791          */
792         if (ap->a_length > 0) {
793                 xpt_setup_ccb(&csio.ccb_h, periph->path, /*priority*/1);
794                 csio.ccb_h.flags |= CAM_POLLED;
795                 csio.ccb_h.ccb_state = DA_CCB_DUMP;
796                 scsi_read_write(&csio,
797                                 /*retries*/1,
798                                 dadone,
799                                 MSG_ORDERED_Q_TAG,
800                                 /*read*/FALSE,
801                                 /*byte2*/0,
802                                 /*minimum_cmd_size*/ softc->minimum_cmd_size,
803                                 ap->a_offset / secsize,
804                                 ap->a_length / secsize,
805                                 /*data_ptr*/(u_int8_t *) ap->a_virtual,
806                                 /*dxfer_len*/ap->a_length,
807                                 /*sense_len*/SSD_FULL_SIZE,
808                                 DA_DEFAULT_TIMEOUT * 1000);             
809                 xpt_polled_action((union ccb *)&csio);
810
811                 if ((csio.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
812                         kprintf("Aborting dump due to I/O error.\n");
813                         if ((csio.ccb_h.status & CAM_STATUS_MASK) ==
814                              CAM_SCSI_STATUS_ERROR)
815                                 scsi_sense_print(&csio);
816                         else
817                                 kprintf("status == 0x%x, scsi status == 0x%x\n",
818                                        csio.ccb_h.status, csio.scsi_status);
819                         return(EIO);
820                 }
821                 cam_periph_unlock(periph);
822                 return 0;
823         }
824
825         /*
826          * Sync the disk cache contents to the physical media.
827          */
828         if ((softc->quirks & DA_Q_NO_SYNC_CACHE) == 0) {
829
830                 xpt_setup_ccb(&csio.ccb_h, periph->path, /*priority*/1);
831                 csio.ccb_h.ccb_state = DA_CCB_DUMP;
832                 scsi_synchronize_cache(&csio,
833                                        /*retries*/1,
834                                        /*cbfcnp*/dadone,
835                                        MSG_SIMPLE_Q_TAG,
836                                        /*begin_lba*/0,/* Cover the whole disk */
837                                        /*lb_count*/0,
838                                        SSD_FULL_SIZE,
839                                        5 * 60 * 1000);
840                 xpt_polled_action((union ccb *)&csio);
841
842                 if ((csio.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
843                         if ((csio.ccb_h.status & CAM_STATUS_MASK) ==
844                              CAM_SCSI_STATUS_ERROR) {
845                                 int asc, ascq;
846                                 int sense_key, error_code;
847
848                                 scsi_extract_sense(&csio.sense_data,
849                                                    &error_code,
850                                                    &sense_key, 
851                                                    &asc, &ascq);
852                                 if (sense_key != SSD_KEY_ILLEGAL_REQUEST)
853                                         scsi_sense_print(&csio);
854                         } else {
855                                 xpt_print(periph->path, "Synchronize cache "
856                                     "failed, status == 0x%x, scsi status == "
857                                     "0x%x\n", csio.ccb_h.status,
858                                     csio.scsi_status);
859                         }
860                 }
861         }
862         cam_periph_unlock(periph);
863         return (0);
864 }
865
866 static void
867 dainit(void)
868 {
869         cam_status status;
870
871         /*
872          * Create our extend array for storing the devices we attach to.
873          */
874         daperiphs = cam_extend_new();
875         if (daperiphs == NULL) {
876                 kprintf("da: Failed to alloc extend array!\n");
877                 return;
878         }
879
880         callout_init(&dasendorderedtag_ch);
881
882         /*
883          * Install a global async callback.  This callback will
884          * receive async callbacks like "new device found".
885          */
886         status = xpt_register_async(AC_FOUND_DEVICE, daasync, NULL, NULL);
887
888         if (status != CAM_REQ_CMP) {
889                 kprintf("da: Failed to attach master async callback "
890                        "due to status 0x%x!\n", status);
891         } else if (da_send_ordered) {
892
893                 /* Register our shutdown event handler */
894                 if ((EVENTHANDLER_REGISTER(shutdown_post_sync, dashutdown, 
895                                            NULL, SHUTDOWN_PRI_DEFAULT)) == NULL)
896                     kprintf("dainit: shutdown event registration failed!\n");
897         }
898 }
899
900 static void
901 daoninvalidate(struct cam_periph *periph)
902 {
903         struct da_softc *softc;
904
905         softc = (struct da_softc *)periph->softc;
906
907         /*
908          * De-register any async callbacks.
909          */
910         xpt_register_async(0, daasync, periph, periph->path);
911
912         softc->flags |= DA_FLAG_PACK_INVALID;
913
914         /*
915          * Return all queued I/O with ENXIO.
916          * XXX Handle any transactions queued to the card
917          *     with XPT_ABORT_CCB.
918          */
919         daflushbioq(&softc->bio_queue_trim, ENXIO);
920         daflushbioq(&softc->bio_queue_wr, ENXIO);
921         daflushbioq(&softc->bio_queue_rd, ENXIO);
922         xpt_print(periph->path, "lost device\n");
923 }
924
925 static void
926 daflushbioq(struct bio_queue_head *bioq, int error)
927 {
928         struct bio *q_bio;
929         struct buf *q_bp;
930
931         while ((q_bio = bioq_first(bioq)) != NULL){
932                 bioq_remove(bioq, q_bio);
933                 q_bp = q_bio->bio_buf;
934                 q_bp->b_resid = q_bp->b_bcount;
935                 q_bp->b_error = error;
936                 q_bp->b_flags |= B_ERROR;
937                 biodone(q_bio);
938         }
939 }
940
941 static void
942 dacleanup(struct cam_periph *periph)
943 {
944         struct da_softc *softc;
945
946         softc = (struct da_softc *)periph->softc;
947
948         devstat_remove_entry(&softc->device_stats);
949         cam_extend_release(daperiphs, periph->unit_number);
950         xpt_print(periph->path, "removing device entry\n");
951         /*
952          * If we can't free the sysctl tree, oh well...
953          */
954         if ((softc->flags & DA_FLAG_SCTX_INIT) != 0
955             && sysctl_ctx_free(&softc->sysctl_ctx) != 0) {
956                 xpt_print(periph->path, "can't remove sysctl context\n");
957         }
958         periph->softc = NULL;
959         if (softc->disk.d_rawdev) {
960                 cam_periph_unlock(periph);
961                 disk_destroy(&softc->disk);
962                 cam_periph_lock(periph);
963         }
964
965         callout_stop(&softc->sendordered_c);
966         kfree(softc, M_DEVBUF);
967 }
968
969 static void
970 daasync(void *callback_arg, u_int32_t code,
971         struct cam_path *path, void *arg)
972 {
973         struct cam_periph *periph;
974
975         periph = (struct cam_periph *)callback_arg;
976
977         switch (code) {
978         case AC_FOUND_DEVICE:
979         {
980                 struct ccb_getdev *cgd;
981                 struct cam_sim *sim;
982                 cam_status status;
983  
984                 cgd = (struct ccb_getdev *)arg;
985                 if (cgd == NULL)
986                         break;
987
988                 if (SID_TYPE(&cgd->inq_data) != T_DIRECT
989                     && SID_TYPE(&cgd->inq_data) != T_RBC
990                     && SID_TYPE(&cgd->inq_data) != T_OPTICAL)
991                         break;
992
993                 /*
994                  * Don't complain if a valid peripheral is already attached.
995                  */
996                 periph = cam_periph_find(cgd->ccb_h.path, "da");
997                 if (periph && (periph->flags & CAM_PERIPH_INVALID) == 0)
998                         break;
999
1000                 /*
1001                  * Allocate a peripheral instance for
1002                  * this device and start the probe
1003                  * process.
1004                  */
1005                 sim = xpt_path_sim(cgd->ccb_h.path);
1006                 status = cam_periph_alloc(daregister, daoninvalidate,
1007                                           dacleanup, dastart,
1008                                           "da", CAM_PERIPH_BIO,
1009                                           cgd->ccb_h.path, daasync,
1010                                           AC_FOUND_DEVICE, cgd);
1011
1012                 if (status != CAM_REQ_CMP && status != CAM_REQ_INPROG) {
1013                         kprintf("daasync: Unable to attach to new device "
1014                                 "due to status 0x%x\n", status);
1015                 }
1016                 break;
1017         }
1018         case AC_SENT_BDR:
1019         case AC_BUS_RESET:
1020         {
1021                 struct da_softc *softc;
1022                 struct ccb_hdr *ccbh;
1023
1024                 softc = (struct da_softc *)periph->softc;
1025                 /*
1026                  * Don't fail on the expected unit attention
1027                  * that will occur.
1028                  */
1029                 softc->flags |= DA_FLAG_RETRY_UA;
1030                 LIST_FOREACH(ccbh, &softc->pending_ccbs, periph_links.le)
1031                         ccbh->ccb_state |= DA_CCB_RETRY_UA;
1032                 /* FALLTHROUGH*/
1033         }
1034         default:
1035                 cam_periph_async(periph, code, path, arg);
1036                 break;
1037         }
1038 }
1039
1040 static void
1041 dasysctlinit(void *context, int pending)
1042 {
1043         struct cam_periph *periph;
1044         struct da_softc *softc;
1045         char tmpstr[80], tmpstr2[80];
1046
1047         get_mplock();
1048         periph = (struct cam_periph *)context;
1049         if (cam_periph_acquire(periph) != CAM_REQ_CMP) {
1050                 rel_mplock();
1051                 return;
1052         }
1053
1054         softc = (struct da_softc *)periph->softc;
1055         ksnprintf(tmpstr, sizeof(tmpstr), "CAM DA unit %d", periph->unit_number);
1056         ksnprintf(tmpstr2, sizeof(tmpstr2), "%d", periph->unit_number);
1057
1058         sysctl_ctx_init(&softc->sysctl_ctx);
1059         softc->flags |= DA_FLAG_SCTX_INIT;
1060         softc->sysctl_tree = SYSCTL_ADD_NODE(&softc->sysctl_ctx,
1061                 SYSCTL_STATIC_CHILDREN(_kern_cam_da), OID_AUTO, tmpstr2,
1062                 CTLFLAG_RD, 0, tmpstr);
1063         if (softc->sysctl_tree == NULL) {
1064                 kprintf("dasysctlinit: unable to allocate sysctl tree\n");
1065                 cam_periph_release(periph);
1066                 rel_mplock();
1067                 return;
1068         }
1069
1070         /*
1071          * Now register the sysctl handler, so the user can the value on
1072          * the fly.
1073          */
1074         SYSCTL_ADD_PROC(&softc->sysctl_ctx,SYSCTL_CHILDREN(softc->sysctl_tree),
1075                 OID_AUTO, "minimum_cmd_size", CTLTYPE_INT | CTLFLAG_RW,
1076                 &softc->minimum_cmd_size, 0, dacmdsizesysctl, "I",
1077                 "Minimum CDB size");
1078
1079         /* Only create the option if the device supports TRIM */
1080         if (softc->disk.d_info.d_trimflag) {
1081                 SYSCTL_ADD_INT(&softc->sysctl_ctx, 
1082                     SYSCTL_CHILDREN(softc->sysctl_tree),
1083                     OID_AUTO,
1084                     "trim_enabled",
1085                     CTLFLAG_RW,
1086                     &softc->trim_enabled,
1087                     0,
1088                     "Enable TRIM for this device (SSD))");
1089         }
1090
1091         cam_periph_release(periph);
1092         rel_mplock();
1093 }
1094
1095 static int
1096 dacmdsizesysctl(SYSCTL_HANDLER_ARGS)
1097 {
1098         int error, value;
1099
1100         value = *(int *)arg1;
1101
1102         error = sysctl_handle_int(oidp, &value, 0, req);
1103
1104         if ((error != 0)
1105          || (req->newptr == NULL))
1106                 return (error);
1107
1108         /*
1109          * Acceptable values here are 6, 10 or 12, or 16.
1110          */
1111         if (value < 6)
1112                 value = 6;
1113         else if ((value > 6)
1114               && (value <= 10))
1115                 value = 10;
1116         else if ((value > 10)
1117               && (value <= 12))
1118                 value = 12;
1119         else if (value > 12)
1120                 value = 16;
1121
1122         *(int *)arg1 = value;
1123
1124         return (0);
1125 }
1126
1127 static cam_status
1128 daregister(struct cam_periph *periph, void *arg)
1129 {
1130         struct da_softc *softc;
1131         struct ccb_pathinq cpi;
1132         struct ccb_getdev *cgd;
1133         char tmpstr[80];
1134         caddr_t match;
1135
1136         cgd = (struct ccb_getdev *)arg;
1137         if (periph == NULL) {
1138                 kprintf("daregister: periph was NULL!!\n");
1139                 return(CAM_REQ_CMP_ERR);
1140         }
1141
1142         if (cgd == NULL) {
1143                 kprintf("daregister: no getdev CCB, can't register device\n");
1144                 return(CAM_REQ_CMP_ERR);
1145         }
1146
1147         softc = kmalloc(sizeof(*softc), M_DEVBUF, M_INTWAIT | M_ZERO);
1148         LIST_INIT(&softc->pending_ccbs);
1149         softc->state = DA_STATE_PROBE;
1150         bioq_init(&softc->bio_queue_trim);
1151         bioq_init(&softc->bio_queue_rd);
1152         bioq_init(&softc->bio_queue_wr);
1153         if (SID_IS_REMOVABLE(&cgd->inq_data))
1154                 softc->flags |= DA_FLAG_PACK_REMOVABLE;
1155         if ((cgd->inq_data.flags & SID_CmdQue) != 0)
1156                 softc->flags |= DA_FLAG_TAGGED_QUEUING;
1157
1158         /* Used to get TRIM status from AHCI driver */
1159         if (cgd->inq_data.vendor_specific1[0] == 1) {
1160                 /*
1161                  * max number of lba ranges an SSD can handle in a single
1162                  * TRIM command. vendor_specific1[1] is the num of 512-byte 
1163                  * blocks the SSD reports that can be passed in a TRIM cmd. 
1164                  */
1165                 softc->trim_max_ranges =
1166                    min(cgd->inq_data.vendor_specific1[1] * 64, TRIM_MAX_RANGES);
1167         }
1168
1169         periph->softc = softc;
1170         
1171         cam_extend_set(daperiphs, periph->unit_number, periph);
1172
1173         /*
1174          * See if this device has any quirks.
1175          */
1176         match = cam_quirkmatch((caddr_t)&cgd->inq_data,
1177                                (caddr_t)da_quirk_table,
1178                                NELEM(da_quirk_table),
1179                                sizeof(*da_quirk_table), scsi_inquiry_match);
1180
1181         if (match != NULL)
1182                 softc->quirks = ((struct da_quirk_entry *)match)->quirks;
1183         else
1184                 softc->quirks = DA_Q_NONE;
1185
1186         /*
1187          * Unconditionally disable the synchronize cache command for
1188          * usb attachments.  It's just impossible to determine if the
1189          * device supports it or not and if it doesn't the port can
1190          * brick.
1191          */
1192         if (strncmp(periph->sim->sim_name, "umass", 4) == 0) {
1193                 softc->quirks |= DA_Q_NO_SYNC_CACHE;
1194         }
1195
1196         TASK_INIT(&softc->sysctl_task, 0, dasysctlinit, periph);
1197
1198         /* Check if the SIM does not want 6 byte commands */
1199         xpt_setup_ccb(&cpi.ccb_h, periph->path, /*priority*/1);
1200         cpi.ccb_h.func_code = XPT_PATH_INQ;
1201         xpt_action((union ccb *)&cpi);
1202         if (cpi.ccb_h.status == CAM_REQ_CMP && (cpi.hba_misc & PIM_NO_6_BYTE))
1203                 softc->quirks |= DA_Q_NO_6_BYTE;
1204
1205         /*
1206          * RBC devices don't have to support READ(6), only READ(10).
1207          */
1208         if (softc->quirks & DA_Q_NO_6_BYTE || SID_TYPE(&cgd->inq_data) == T_RBC)
1209                 softc->minimum_cmd_size = 10;
1210         else
1211                 softc->minimum_cmd_size = 6;
1212
1213         /*
1214          * Load the user's default, if any.
1215          */
1216         ksnprintf(tmpstr, sizeof(tmpstr), "kern.cam.da.%d.minimum_cmd_size",
1217                  periph->unit_number);
1218         TUNABLE_INT_FETCH(tmpstr, &softc->minimum_cmd_size);
1219
1220         /*
1221          * 6, 10, 12, and 16 are the currently permissible values.
1222          */
1223         if (softc->minimum_cmd_size < 6)
1224                 softc->minimum_cmd_size = 6;
1225         else if ((softc->minimum_cmd_size > 6)
1226               && (softc->minimum_cmd_size <= 10))
1227                 softc->minimum_cmd_size = 10;
1228         else if ((softc->minimum_cmd_size > 10)
1229               && (softc->minimum_cmd_size <= 12))
1230                 softc->minimum_cmd_size = 12;
1231         else if (softc->minimum_cmd_size > 12)
1232                 softc->minimum_cmd_size = 16;
1233
1234         /*
1235          * The DA driver supports a blocksize, but
1236          * we don't know the blocksize until we do 
1237          * a read capacity.  So, set a flag to
1238          * indicate that the blocksize is 
1239          * unavailable right now.  We'll clear the
1240          * flag as soon as we've done a read capacity.
1241          */
1242         devstat_add_entry(&softc->device_stats, "da", 
1243                           periph->unit_number, 0,
1244                           DEVSTAT_BS_UNAVAILABLE,
1245                           SID_TYPE(&cgd->inq_data) | DEVSTAT_TYPE_IF_SCSI,
1246                           DEVSTAT_PRIORITY_DISK);
1247
1248         /*
1249          * Register this media as a disk
1250          */
1251         CAM_SIM_UNLOCK(periph->sim);
1252         disk_create(periph->unit_number, &softc->disk, &da_ops);
1253         softc->disk.d_rawdev->si_iosize_max = MAXPHYS;
1254         CAM_SIM_LOCK(periph->sim);
1255
1256         /*
1257          * Add async callbacks for bus reset and
1258          * bus device reset calls.  I don't bother
1259          * checking if this fails as, in most cases,
1260          * the system will function just fine without
1261          * them and the only alternative would be to
1262          * not attach the device on failure.
1263          */
1264         xpt_register_async(AC_SENT_BDR | AC_BUS_RESET | AC_LOST_DEVICE,
1265                            daasync, periph, periph->path);
1266
1267         /*
1268          * Take an exclusive refcount on the periph while dastart is called
1269          * to finish the probe.  The reference will be dropped in dadone at
1270          * the end of probe.
1271          */
1272         cam_periph_hold(periph, 0);
1273         xpt_schedule(periph, /*priority*/5);
1274
1275         /*
1276          * Schedule a periodic event to occasionally send an
1277          * ordered tag to a device.
1278          */
1279         callout_init(&softc->sendordered_c);
1280         callout_reset(&softc->sendordered_c,
1281             (DA_DEFAULT_TIMEOUT * hz) / DA_ORDEREDTAG_INTERVAL,
1282             dasendorderedtag, softc);
1283
1284         
1285
1286         return(CAM_REQ_CMP);
1287 }
1288
1289 static void
1290 dastart(struct cam_periph *periph, union ccb *start_ccb)
1291 {
1292         struct da_softc *softc;
1293
1294         softc = (struct da_softc *)periph->softc;
1295
1296         switch (softc->state) {
1297         case DA_STATE_NORMAL:
1298         {
1299                 /* Pull a buffer from the queue and get going on it */          
1300                 struct bio *bio;
1301                 struct bio *bio_rd;
1302                 struct bio *bio_wr;
1303                 struct buf *bp;
1304                 u_int8_t tag_code;
1305                 int limit;
1306
1307                 /*
1308                  * See if there is a buf with work for us to do..
1309                  */
1310                 bio_rd = bioq_first(&softc->bio_queue_rd);
1311                 bio_wr = bioq_first(&softc->bio_queue_wr);
1312
1313                 if (periph->immediate_priority <= periph->pinfo.priority) {
1314                         CAM_DEBUG_PRINT(CAM_DEBUG_SUBTRACE,
1315                                         ("queuing for immediate ccb\n"));
1316                         start_ccb->ccb_h.ccb_state = DA_CCB_WAITING;
1317                         SLIST_INSERT_HEAD(&periph->ccb_list, &start_ccb->ccb_h,
1318                                           periph_links.sle);
1319                         periph->immediate_priority = CAM_PRIORITY_NONE;
1320                         wakeup(&periph->ccb_list);
1321                         if (bio_rd || bio_wr) {
1322                                 /*
1323                                  * Have more work to do, so ensure we stay
1324                                  * scheduled
1325                                  */
1326                                 xpt_schedule(periph, /* XXX priority */1);
1327                         }
1328                         break;
1329                 }
1330
1331                 /* Run the trim command if not already running */
1332                 if (!softc->trim_running &&
1333                    (bio = bioq_first(&softc->bio_queue_trim)) != NULL) {
1334                         struct trim_request *req = &softc->trim_req;
1335                         struct bio *bio1;
1336                         int bps = 0, ranges = 0;
1337
1338                         softc->trim_running = 1;
1339                         bzero(req, sizeof(*req));
1340                         bio1 = bio;
1341                         while (1) {
1342                                 uint64_t lba;
1343                                 int count;
1344
1345                                 bp = bio1->bio_buf;
1346                                 count = bp->b_bcount / softc->params.secsize;
1347                                 lba = bio1->bio_offset/softc->params.secsize;
1348
1349                                 kprintf("trim lba:%llu boff:%llu count:%d\n",
1350                                     (unsigned long long) lba,
1351                                     (unsigned long long) bio1->bio_offset,
1352                                     count);
1353
1354                                 bioq_remove(&softc->bio_queue_trim, bio1);
1355                                 while (count > 0) {
1356                                         int c = min(count, 0xffff);
1357                                         int off = ranges * 8;
1358
1359                                         req->data[off + 0] = lba & 0xff;
1360                                         req->data[off + 1] = (lba >> 8) & 0xff;
1361                                         req->data[off + 2] = (lba >> 16) & 0xff;
1362                                         req->data[off + 3] = (lba >> 24) & 0xff;
1363                                         req->data[off + 4] = (lba >> 32) & 0xff;
1364                                         req->data[off + 5] = (lba >> 40) & 0xff;
1365                                         req->data[off + 6] = c & 0xff;
1366                                         req->data[off + 7] = (c >> 8) & 0xff;
1367                                         lba += c;
1368                                         count -= c;
1369                                         ranges++;
1370                                 }
1371
1372                                 /* Try to merge multiple TRIM requests */
1373                                 req->bios[bps++] = bio1;
1374                                 bio1 = bioq_first(&softc->bio_queue_trim);
1375                                 if (bio1 == NULL ||
1376                                     bio1->bio_buf->b_bcount / softc->params.secsize >
1377                                     (softc->trim_max_ranges - ranges) * 0xffff)
1378                                         break;
1379                         }
1380
1381
1382                         cam_fill_csio(&start_ccb->csio,
1383                             1/*retries*/,
1384                             dadone,
1385                             CAM_DIR_OUT,
1386                             MSG_SIMPLE_Q_TAG,
1387                             req->data,
1388                             ((ranges +63)/64)*512,
1389                             SSD_FULL_SIZE,
1390                             sizeof(struct scsi_rw_6),
1391                             da_default_timeout*2);
1392
1393                         start_ccb->ccb_h.ccb_state = DA_CCB_TRIM;
1394                         LIST_INSERT_HEAD(&softc->pending_ccbs,
1395                             &start_ccb->ccb_h, periph_links.le);
1396                         start_ccb->csio.ccb_h.func_code = XPT_TRIM;
1397                         start_ccb->ccb_h.ccb_bio = bio;
1398                         devstat_start_transaction(&softc->device_stats);
1399                         xpt_action(start_ccb);
1400                         xpt_schedule(periph, 1);
1401                         break;
1402                 }
1403
1404                 /*
1405                  * Select a read or write buffer to queue.  Limit the number
1406                  * of tags dedicated to reading or writing, giving reads
1407                  * precedence.
1408                  *
1409                  * Writes to modern hard drives go into the HDs cache and
1410                  * return completion nearly instantly.  That is until the
1411                  * cache becomes full.  When the HDs cache becomes full
1412                  * write commands will begin to stall.  If all available
1413                  * tags are taken up by writes which saturate the drive
1414                  * reads will become tag-starved.
1415                  *
1416                  * A similar situation can occur with reads.  With many
1417                  * parallel readers all tags can be taken up by reads
1418                  * and prevent any writes from draining, even if the HD's
1419                  * cache is not full.
1420                  */
1421                 limit = periph->sim->max_tagged_dev_openings * 2 / 3 + 1;
1422 #if 0
1423                 /* DEBUGGING */
1424                 static int savets;
1425                 static long savets2;
1426                 if (1 || time_second != savets2 || (ticks != savets && (softc->outstanding_cmds_rd || softc->outstanding_cmds_wr))) {
1427                         kprintf("%d %d (%d)\n",
1428                                 softc->outstanding_cmds_rd,
1429                                 softc->outstanding_cmds_wr,
1430                                 limit);
1431                         savets = ticks;
1432                         savets2 = time_second;
1433                 }
1434 #endif
1435                 if (bio_rd && softc->outstanding_cmds_rd < limit) {
1436                         bio = bio_rd;
1437                         bioq_remove(&softc->bio_queue_rd, bio);
1438                 } else if (bio_wr && softc->outstanding_cmds_wr < limit) {
1439                         bio = bio_wr;
1440                         bioq_remove(&softc->bio_queue_wr, bio);
1441                 } else {
1442                         if (bio_rd)
1443                                 softc->flags |= DA_FLAG_RD_LIMIT;
1444                         if (bio_wr)
1445                                 softc->flags |= DA_FLAG_WR_LIMIT;
1446                         xpt_release_ccb(start_ccb);
1447                         break;
1448                 }
1449
1450                 /*
1451                  * We can queue new work.
1452                  */
1453                 bp = bio->bio_buf;
1454
1455                 devstat_start_transaction(&softc->device_stats);
1456
1457                 if ((bp->b_flags & B_ORDERED) != 0 ||
1458                     (softc->flags & DA_FLAG_NEED_OTAG) != 0) {
1459                         softc->flags &= ~DA_FLAG_NEED_OTAG;
1460                         softc->ordered_tag_count++;
1461                         tag_code = MSG_ORDERED_Q_TAG;
1462                 } else {
1463                         tag_code = MSG_SIMPLE_Q_TAG;
1464                 }
1465
1466                 switch(bp->b_cmd) {
1467                 case BUF_CMD_READ:
1468                 case BUF_CMD_WRITE:
1469                         /*
1470                          * Block read/write op
1471                          */
1472                         KKASSERT(bio->bio_offset % softc->params.secsize == 0);
1473
1474                         scsi_read_write(
1475                                 &start_ccb->csio,
1476                                 da_retry_count,         /* retries */
1477                                 dadone,
1478                                 tag_code,
1479                                 (bp->b_cmd == BUF_CMD_READ),
1480                                 0,                      /* byte2 */
1481                                 softc->minimum_cmd_size,
1482                                 bio->bio_offset / softc->params.secsize,
1483                                 bp->b_bcount / softc->params.secsize,
1484                                 bp->b_data,
1485                                 bp->b_bcount,
1486                                 SSD_FULL_SIZE,          /* sense_len */
1487                                 da_default_timeout * 1000
1488                         );
1489                         break;
1490                 case BUF_CMD_FLUSH:
1491                         /*
1492                          * Silently complete a flush request if the device
1493                          * cannot handle it.
1494                          */
1495                         if (softc->quirks & DA_Q_NO_SYNC_CACHE) {
1496                                 xpt_release_ccb(start_ccb);
1497                                 start_ccb = NULL;
1498                                 devstat_end_transaction_buf(
1499                                         &softc->device_stats, bp);
1500                                 biodone(bio);
1501                         } else {
1502                                 scsi_synchronize_cache(
1503                                         &start_ccb->csio,
1504                                         1,              /* retries */
1505                                         dadone,         /* cbfcnp */
1506                                         MSG_SIMPLE_Q_TAG,
1507                                         0,              /* lba */
1508                                         0,              /* count (whole disk) */
1509                                         SSD_FULL_SIZE,
1510                                         da_default_timeout*1000 /* timeout */
1511                                 );
1512                         }
1513                         break;
1514                 case BUF_CMD_FREEBLKS:
1515                         if (softc->disk.d_info.d_trimflag & DA_FLAG_CAN_TRIM){
1516                                 start_ccb->csio.ccb_h.func_code = XPT_TRIM;
1517                                 break;
1518                         }
1519                 default:
1520                         xpt_release_ccb(start_ccb);
1521                         start_ccb = NULL;
1522                         panic("dastart: unrecognized bio cmd %d", bp->b_cmd);
1523                         break; /* NOT REACHED */
1524                 }
1525
1526                 /*
1527                  * Block out any asyncronous callbacks
1528                  * while we touch the pending ccb list.
1529                  */
1530                 if (start_ccb) {
1531                         start_ccb->ccb_h.ccb_state = DA_CCB_BUFFER_IO;
1532                         LIST_INSERT_HEAD(&softc->pending_ccbs,
1533                                          &start_ccb->ccb_h, periph_links.le);
1534                         if (bp->b_cmd == BUF_CMD_WRITE ||
1535                             bp->b_cmd == BUF_CMD_FLUSH) {
1536                                 ++softc->outstanding_cmds_wr;
1537                         } else {
1538                                 ++softc->outstanding_cmds_rd;
1539                         }
1540
1541                         /* We expect a unit attention from this device */
1542                         if ((softc->flags & DA_FLAG_RETRY_UA) != 0) {
1543                                 start_ccb->ccb_h.ccb_state |= DA_CCB_RETRY_UA;
1544                                 softc->flags &= ~DA_FLAG_RETRY_UA;
1545                         }
1546
1547                         start_ccb->ccb_h.ccb_bio = bio;
1548                         xpt_action(start_ccb);
1549                 }
1550                 
1551                 /*
1552                  * Be sure we stay scheduled if we have more work to do.
1553                  */
1554                 if (bioq_first(&softc->bio_queue_rd) ||
1555                     bioq_first(&softc->bio_queue_wr)) {
1556                         xpt_schedule(periph, 1);
1557                 }
1558                 break;
1559         }
1560         case DA_STATE_PROBE:
1561         {
1562                 struct ccb_scsiio *csio;
1563                 struct scsi_read_capacity_data *rcap;
1564
1565                 rcap = kmalloc(sizeof(*rcap), M_SCSIDA, M_INTWAIT | M_ZERO);
1566                 csio = &start_ccb->csio;
1567                 scsi_read_capacity(csio,
1568                                    /*retries*/4,
1569                                    dadone,
1570                                    MSG_SIMPLE_Q_TAG,
1571                                    rcap,
1572                                    SSD_FULL_SIZE,
1573                                    /*timeout*/5000);
1574                 start_ccb->ccb_h.ccb_bio = NULL;
1575                 start_ccb->ccb_h.ccb_state = DA_CCB_PROBE;
1576                 xpt_action(start_ccb);
1577                 break;
1578         }
1579         case DA_STATE_PROBE2:
1580         {
1581                 struct ccb_scsiio *csio;
1582                 struct scsi_read_capacity_data_16 *rcaplong;
1583
1584                 rcaplong = kmalloc(sizeof(*rcaplong), M_SCSIDA,
1585                                    M_INTWAIT | M_ZERO);
1586                 if (rcaplong == NULL) {
1587                         kprintf("dastart: Couldn't allocate read_capacity\n");
1588                         /* da_free_periph??? */
1589                         break;
1590                 }
1591                 csio = &start_ccb->csio;
1592                 scsi_read_capacity_16(csio,
1593                                     /*retries*/ 4,
1594                                     /*cbfcnp*/ dadone,
1595                                     /*tag_action*/ MSG_SIMPLE_Q_TAG,
1596                                     /*lba*/ 0,
1597                                     /*reladr*/ 0,
1598                                     /*pmi*/ 0,
1599                                     rcaplong,
1600                                     /*sense_len*/ SSD_FULL_SIZE,
1601                                     /*timeout*/ 60000);
1602                 start_ccb->ccb_h.ccb_bio = NULL;
1603                 start_ccb->ccb_h.ccb_state = DA_CCB_PROBE2;
1604                 xpt_action(start_ccb);  
1605                 break;
1606         }
1607         }
1608 }
1609
1610 static int
1611 cmd6workaround(union ccb *ccb)
1612 {
1613         struct scsi_rw_6 cmd6;
1614         struct scsi_rw_10 *cmd10;
1615         struct da_softc *softc;
1616         u_int8_t *cdb;
1617         int frozen;
1618
1619         cdb = ccb->csio.cdb_io.cdb_bytes;
1620
1621         /* Translation only possible if CDB is an array and cmd is R/W6 */
1622         if ((ccb->ccb_h.flags & CAM_CDB_POINTER) != 0 ||
1623             (*cdb != READ_6 && *cdb != WRITE_6))
1624                 return 0;
1625
1626         xpt_print(ccb->ccb_h.path, "READ(6)/WRITE(6) not supported, "
1627             "increasing minimum_cmd_size to 10.\n");
1628         softc = (struct da_softc *)xpt_path_periph(ccb->ccb_h.path)->softc;
1629         softc->minimum_cmd_size = 10;
1630
1631         bcopy(cdb, &cmd6, sizeof(struct scsi_rw_6));
1632         cmd10 = (struct scsi_rw_10 *)cdb;
1633         cmd10->opcode = (cmd6.opcode == READ_6) ? READ_10 : WRITE_10;
1634         cmd10->byte2 = 0;
1635         scsi_ulto4b(scsi_3btoul(cmd6.addr), cmd10->addr);
1636         cmd10->reserved = 0;
1637         scsi_ulto2b(cmd6.length, cmd10->length);
1638         cmd10->control = cmd6.control;
1639         ccb->csio.cdb_len = sizeof(*cmd10);
1640
1641         /* Requeue request, unfreezing queue if necessary */
1642         frozen = (ccb->ccb_h.status & CAM_DEV_QFRZN) != 0;
1643         ccb->ccb_h.status = CAM_REQUEUE_REQ;
1644         xpt_action(ccb);
1645         if (frozen) {
1646                 cam_release_devq(ccb->ccb_h.path,
1647                                  /*relsim_flags*/0,
1648                                  /*reduction*/0,
1649                                  /*timeout*/0,
1650                                  /*getcount_only*/0);
1651         }
1652         return (ERESTART);
1653 }
1654
1655 static void
1656 dadone(struct cam_periph *periph, union ccb *done_ccb)
1657 {
1658         struct da_softc *softc;
1659         struct ccb_scsiio *csio;
1660         struct disk_info info;
1661
1662         softc = (struct da_softc *)periph->softc;
1663         csio = &done_ccb->csio;
1664         switch (csio->ccb_h.ccb_state & DA_CCB_TYPE_MASK) {
1665         case DA_CCB_BUFFER_IO:
1666         case DA_CCB_TRIM:
1667         {
1668                 struct buf *bp;
1669                 struct bio *bio;
1670                 int mustsched = 0;
1671
1672                 bio = (struct bio *)done_ccb->ccb_h.ccb_bio;
1673                 bp = bio->bio_buf;
1674                 if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
1675                         int error;
1676                         int sf;
1677                         
1678                         if ((csio->ccb_h.ccb_state & DA_CCB_RETRY_UA) != 0)
1679                                 sf = SF_RETRY_UA;
1680                         else
1681                                 sf = 0;
1682
1683                         error = daerror(done_ccb, CAM_RETRY_SELTO, sf);
1684                         if (error == ERESTART) {
1685                                 /*
1686                                  * A retry was scheuled, so
1687                                  * just return.
1688                                  */
1689                                 return;
1690                         }
1691                         if (error != 0) {
1692                                 if (error == ENXIO) {
1693                                         /*
1694                                          * Catastrophic error.  Mark our pack as
1695                                          * invalid.
1696                                          */
1697                                         /*
1698                                          * XXX See if this is really a media
1699                                          * XXX change first?
1700                                          */
1701                                         xpt_print(periph->path,
1702                                             "Invalidating pack\n");
1703                                         softc->flags |= DA_FLAG_PACK_INVALID;
1704                                 }
1705
1706                                 /*
1707                                  * Return all queued write I/O's with EIO
1708                                  * so the client can retry these I/Os in the
1709                                  * proper order should it attempt to recover.
1710                                  *
1711                                  * Leave read I/O's alone.
1712                                  */
1713                                 daflushbioq(&softc->bio_queue_wr, EIO);
1714                                 bp->b_error = error;
1715                                 bp->b_resid = bp->b_bcount;
1716                                 bp->b_flags |= B_ERROR;
1717                         } else {
1718                                 bp->b_resid = csio->resid;
1719                                 bp->b_error = 0;
1720                                 if (bp->b_resid != 0)
1721                                         bp->b_flags |= B_ERROR;
1722                         }
1723                         if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0)
1724                                 cam_release_devq(done_ccb->ccb_h.path,
1725                                                  /*relsim_flags*/0,
1726                                                  /*reduction*/0,
1727                                                  /*timeout*/0,
1728                                                  /*getcount_only*/0);
1729                 } else {
1730                         if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0)
1731                                 panic("REQ_CMP with QFRZN");
1732                         bp->b_resid = csio->resid;
1733                         if (csio->resid > 0)
1734                                 bp->b_flags |= B_ERROR;
1735                 }
1736
1737                 /*
1738                  * Block out any asyncronous callbacks
1739                  * while we touch the pending ccb list.
1740                  */
1741                 LIST_REMOVE(&done_ccb->ccb_h, periph_links.le);
1742                 if (bp->b_cmd == BUF_CMD_WRITE || bp->b_cmd == BUF_CMD_FLUSH) {
1743                         --softc->outstanding_cmds_wr;
1744                         if (softc->flags & DA_FLAG_WR_LIMIT) {
1745                                 softc->flags &= ~DA_FLAG_WR_LIMIT;
1746                                 mustsched = 1;
1747                         }
1748                 } else {
1749                         --softc->outstanding_cmds_rd;
1750                         if (softc->flags & DA_FLAG_RD_LIMIT) {
1751                                 softc->flags &= ~DA_FLAG_RD_LIMIT;
1752                                 mustsched = 1;
1753                         }
1754                 }
1755                 if (softc->outstanding_cmds_rd +
1756                     softc->outstanding_cmds_wr == 0) {
1757                         softc->flags |= DA_FLAG_WENT_IDLE;
1758                 }
1759
1760                 devstat_end_transaction_buf(&softc->device_stats, bp);
1761                 if ((csio->ccb_h.ccb_state & DA_CCB_TYPE_MASK) ==
1762                     DA_CCB_TRIM) {
1763                         struct trim_request *req =
1764                             (struct trim_request *) csio->data_ptr;
1765                         int i;
1766
1767                         for (i = 1; i < softc->trim_max_ranges &&
1768                             req->bios[i]; i++) {
1769                                 struct bio *bp1 = req->bios[i];
1770
1771                                 bp1->bio_buf->b_resid = bp->b_resid;
1772                                 bp1->bio_buf->b_error = bp->b_error;
1773                                 if (bp->b_flags & B_ERROR)
1774                                         bp1->bio_buf->b_flags |= B_ERROR;
1775                                 biodone(bp1);
1776                         }
1777                         softc->trim_running = 0;
1778                         biodone(bio);
1779                         xpt_schedule(periph,1);
1780                 } else
1781                         biodone(bio);
1782
1783
1784                 if (mustsched)
1785                         xpt_schedule(periph, /*priority*/1);
1786
1787                 break;
1788         }
1789         case DA_CCB_PROBE:
1790         case DA_CCB_PROBE2:
1791         {
1792                 struct     scsi_read_capacity_data *rdcap;
1793                 struct     scsi_read_capacity_data_16 *rcaplong;
1794                 char       announce_buf[80];
1795
1796                 rdcap = NULL;
1797                 rcaplong = NULL;
1798                 if (softc->state == DA_STATE_PROBE)
1799                         rdcap =(struct scsi_read_capacity_data *)csio->data_ptr;
1800                 else
1801                         rcaplong = (struct scsi_read_capacity_data_16 *)
1802                                     csio->data_ptr;
1803
1804                 bzero(&info, sizeof(info));
1805                 info.d_type = DTYPE_SCSI;
1806                 info.d_serialno = xpt_path_serialno(periph->path);
1807                 
1808                 if ((csio->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) {
1809                         struct disk_params *dp;
1810                         uint32_t block_size;
1811                         uint64_t maxsector;
1812
1813                         if (softc->state == DA_STATE_PROBE) {
1814                                 block_size = scsi_4btoul(rdcap->length);
1815                                 maxsector = scsi_4btoul(rdcap->addr);
1816
1817                                 /*
1818                                  * According to SBC-2, if the standard 10
1819                                  * byte READ CAPACITY command returns 2^32,
1820                                  * we should issue the 16 byte version of
1821                                  * the command, since the device in question
1822                                  * has more sectors than can be represented
1823                                  * with the short version of the command.
1824                                  */
1825                                 if (maxsector == 0xffffffff) {
1826                                         softc->state = DA_STATE_PROBE2;
1827                                         kfree(rdcap, M_SCSIDA);
1828                                         xpt_release_ccb(done_ccb);
1829                                         xpt_schedule(periph, /*priority*/5);
1830                                         return;
1831                                 }
1832                         } else {
1833                                 block_size = scsi_4btoul(rcaplong->length);
1834                                 maxsector = scsi_8btou64(rcaplong->addr);
1835                         }
1836                         dasetgeom(periph, block_size, maxsector);
1837                         dp = &softc->params;
1838                         ksnprintf(announce_buf, sizeof(announce_buf),
1839                                 "%juMB (%ju %u byte sectors: %dH %dS/T %dC)",
1840                                 (uintmax_t) (((uintmax_t)dp->secsize *
1841                                 dp->sectors) / (1024*1024)),
1842                                 (uintmax_t)dp->sectors,
1843                                 dp->secsize, dp->heads, dp->secs_per_track,
1844                                 dp->cylinders);
1845                         
1846                         CAM_SIM_UNLOCK(periph->sim);
1847                         info.d_media_blksize = softc->params.secsize;
1848                         info.d_media_blocks = softc->params.sectors;
1849                         info.d_media_size = 0;
1850                         info.d_secpertrack = softc->params.secs_per_track;
1851                         info.d_nheads = softc->params.heads;
1852                         info.d_ncylinders = softc->params.cylinders;
1853                         info.d_secpercyl = softc->params.heads *
1854                                                 softc->params.secs_per_track;
1855                         info.d_serialno = xpt_path_serialno(periph->path);
1856                         disk_setdiskinfo(&softc->disk, &info);
1857                         CAM_SIM_LOCK(periph->sim);
1858                 } else {
1859                         int     error;
1860
1861                         announce_buf[0] = '\0';
1862
1863                         /*
1864                          * Retry any UNIT ATTENTION type errors.  They
1865                          * are expected at boot.
1866                          */
1867                         error = daerror(done_ccb, CAM_RETRY_SELTO,
1868                                         SF_RETRY_UA|SF_NO_PRINT);
1869                         if (error == ERESTART) {
1870                                 /*
1871                                  * A retry was scheuled, so
1872                                  * just return.
1873                                  */
1874                                 return;
1875                         } else if (error != 0) {
1876                                 struct scsi_sense_data *sense;
1877                                 int asc, ascq;
1878                                 int sense_key, error_code;
1879                                 int have_sense;
1880                                 cam_status status;
1881                                 struct ccb_getdev cgd;
1882
1883                                 /* Don't wedge this device's queue */
1884                                 status = done_ccb->ccb_h.status;
1885                                 if ((status & CAM_DEV_QFRZN) != 0)
1886                                         cam_release_devq(done_ccb->ccb_h.path,
1887                                                          /*relsim_flags*/0,
1888                                                          /*reduction*/0,
1889                                                          /*timeout*/0,
1890                                                          /*getcount_only*/0);
1891
1892
1893                                 xpt_setup_ccb(&cgd.ccb_h, 
1894                                               done_ccb->ccb_h.path,
1895                                               /* priority */ 1);
1896                                 cgd.ccb_h.func_code = XPT_GDEV_TYPE;
1897                                 xpt_action((union ccb *)&cgd);
1898
1899                                 if (((csio->ccb_h.flags & CAM_SENSE_PHYS) != 0)
1900                                  || ((csio->ccb_h.flags & CAM_SENSE_PTR) != 0)
1901                                  || ((status & CAM_AUTOSNS_VALID) == 0))
1902                                         have_sense = FALSE;
1903                                 else
1904                                         have_sense = TRUE;
1905
1906                                 if (have_sense) {
1907                                         sense = &csio->sense_data;
1908                                         scsi_extract_sense(sense, &error_code,
1909                                                            &sense_key, 
1910                                                            &asc, &ascq);
1911                                 }
1912                                 /*
1913                                  * Attach to anything that claims to be a
1914                                  * direct access or optical disk device,
1915                                  * as long as it doesn't return a "Logical
1916                                  * unit not supported" (0x25) error.
1917                                  */
1918                                 if ((have_sense) && (asc != 0x25)
1919                                  && (error_code == SSD_CURRENT_ERROR)) {
1920                                         const char *sense_key_desc;
1921                                         const char *asc_desc;
1922
1923                                         scsi_sense_desc(sense_key, asc, ascq,
1924                                                         &cgd.inq_data,
1925                                                         &sense_key_desc,
1926                                                         &asc_desc);
1927                                         ksnprintf(announce_buf,
1928                                             sizeof(announce_buf),
1929                                                 "Attempt to query device "
1930                                                 "size failed: %s, %s",
1931                                                 sense_key_desc,
1932                                                 asc_desc);
1933                                         info.d_media_blksize = 512;
1934                                         disk_setdiskinfo(&softc->disk, &info);
1935                                 } else {
1936                                         if (have_sense)
1937                                                 scsi_sense_print(
1938                                                         &done_ccb->csio);
1939                                         else {
1940                                                 xpt_print(periph->path,
1941                                                     "got CAM status %#x\n",
1942                                                     done_ccb->ccb_h.status);
1943                                         }
1944
1945                                         xpt_print(periph->path, "fatal error, "
1946                                             "failed to attach to device\n");
1947
1948                                         /*
1949                                          * Free up resources.
1950                                          */
1951                                         cam_periph_invalidate(periph);
1952                                 } 
1953                         }
1954                 }
1955                 kfree(csio->data_ptr, M_SCSIDA);
1956                 if (announce_buf[0] != '\0') {
1957                         xpt_announce_periph(periph, announce_buf);
1958                         /*
1959                          * Create our sysctl variables, now that we know
1960                          * we have successfully attached.
1961                          */
1962                         taskqueue_enqueue(taskqueue_thread[mycpuid],
1963                             &softc->sysctl_task);
1964                 }
1965
1966                 if (softc->trim_max_ranges) {
1967                         softc->disk.d_info.d_trimflag |= DA_FLAG_CAN_TRIM;
1968                         kprintf("%s%d: supports TRIM\n",
1969                             periph->periph_name,
1970                             periph->unit_number);
1971                 }
1972                 softc->state = DA_STATE_NORMAL;
1973                 /*
1974                  * Since our peripheral may be invalidated by an error
1975                  * above or an external event, we must release our CCB
1976                  * before releasing the probe lock on the peripheral.
1977                  * The peripheral will only go away once the last lock
1978                  * is removed, and we need it around for the CCB release
1979                  * operation.
1980                  */
1981                 xpt_release_ccb(done_ccb);
1982                 cam_periph_unhold(periph, 0);
1983                 return;
1984         }
1985         case DA_CCB_WAITING:
1986         {
1987                 /* Caller will release the CCB */
1988                 wakeup(&done_ccb->ccb_h.cbfcnp);
1989                 return;
1990         }
1991         case DA_CCB_DUMP:
1992                 /* No-op.  We're polling */
1993                 return;
1994         default:
1995                 break;
1996         }
1997         xpt_release_ccb(done_ccb);
1998 }
1999
2000 static int
2001 daerror(union ccb *ccb, u_int32_t cam_flags, u_int32_t sense_flags)
2002 {
2003         struct da_softc   *softc;
2004         struct cam_periph *periph;
2005         int error;
2006
2007         periph = xpt_path_periph(ccb->ccb_h.path);
2008         softc = (struct da_softc *)periph->softc;
2009
2010         /*
2011          * Automatically detect devices that do not support
2012          * READ(6)/WRITE(6) and upgrade to using 10 byte cdbs.
2013          */
2014         error = 0;
2015         if ((ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_INVALID) {
2016                 error = cmd6workaround(ccb);
2017         } else if (((ccb->ccb_h.status & CAM_STATUS_MASK) ==
2018                    CAM_SCSI_STATUS_ERROR)
2019          && (ccb->ccb_h.status & CAM_AUTOSNS_VALID)
2020          && (ccb->csio.scsi_status == SCSI_STATUS_CHECK_COND)
2021          && ((ccb->ccb_h.flags & CAM_SENSE_PHYS) == 0)
2022          && ((ccb->ccb_h.flags & CAM_SENSE_PTR) == 0)) {
2023                 int sense_key, error_code, asc, ascq;
2024
2025                 scsi_extract_sense(&ccb->csio.sense_data,
2026                                    &error_code, &sense_key, &asc, &ascq);
2027                 if (sense_key == SSD_KEY_ILLEGAL_REQUEST)
2028                         error = cmd6workaround(ccb);
2029         }
2030         if (error == ERESTART)
2031                 return (ERESTART);
2032
2033         /*
2034          * XXX
2035          * Until we have a better way of doing pack validation,
2036          * don't treat UAs as errors.
2037          */
2038         sense_flags |= SF_RETRY_UA;
2039         return(cam_periph_error(ccb, cam_flags, sense_flags,
2040                                 &softc->saved_ccb));
2041 }
2042
2043 static void
2044 daprevent(struct cam_periph *periph, int action)
2045 {
2046         struct  da_softc *softc;
2047         union   ccb *ccb;               
2048         int     error;
2049                 
2050         softc = (struct da_softc *)periph->softc;
2051
2052         if (((action == PR_ALLOW)
2053           && (softc->flags & DA_FLAG_PACK_LOCKED) == 0)
2054          || ((action == PR_PREVENT)
2055           && (softc->flags & DA_FLAG_PACK_LOCKED) != 0)) {
2056                 return;
2057         }
2058
2059         ccb = cam_periph_getccb(periph, /*priority*/1);
2060
2061         scsi_prevent(&ccb->csio,
2062                      /*retries*/1,
2063                      /*cbcfp*/dadone,
2064                      MSG_SIMPLE_Q_TAG,
2065                      action,
2066                      SSD_FULL_SIZE,
2067                      5000);
2068
2069         error = cam_periph_runccb(ccb, /*error_routine*/NULL, CAM_RETRY_SELTO,
2070                                   SF_RETRY_UA, &softc->device_stats);
2071
2072         if (error == 0) {
2073                 if (action == PR_ALLOW)
2074                         softc->flags &= ~DA_FLAG_PACK_LOCKED;
2075                 else
2076                         softc->flags |= DA_FLAG_PACK_LOCKED;
2077         }
2078
2079         xpt_release_ccb(ccb);
2080 }
2081
2082 /*
2083  * Check media on open, e.g. card reader devices which had no initial media.
2084  */
2085 static int
2086 dacheckmedia(struct cam_periph *periph)
2087 {
2088         struct disk_params *dp;
2089         struct da_softc *softc;
2090         struct disk_info info;
2091         int error;
2092
2093         softc = (struct da_softc *)periph->softc;
2094         dp = &softc->params;
2095
2096         error = dagetcapacity(periph);
2097
2098         /*
2099          * Only reprobe on initial open and if the media is removable.
2100          *
2101          * NOTE: If we setdiskinfo() it will take the device probe
2102          *       a bit of time to probe the slices and partitions,
2103          *       and mess up booting.  So avoid if nothing has changed.
2104          *       XXX
2105          */
2106         if (softc->flags & DA_FLAG_OPEN)
2107                 return (error);
2108         if ((softc->flags & DA_FLAG_PACK_REMOVABLE) == 0)
2109                 return (error);
2110
2111         bzero(&info, sizeof(info));
2112         info.d_type = DTYPE_SCSI;
2113         info.d_serialno = xpt_path_serialno(periph->path);
2114
2115         if (error == 0) {
2116                 CAM_SIM_UNLOCK(periph->sim);
2117                 info.d_media_blksize = softc->params.secsize;
2118                 info.d_media_blocks = softc->params.sectors;
2119                 info.d_media_size = 0;
2120                 info.d_secpertrack = softc->params.secs_per_track;
2121                 info.d_nheads = softc->params.heads;
2122                 info.d_ncylinders = softc->params.cylinders;
2123                 info.d_secpercyl = softc->params.heads *
2124                                         softc->params.secs_per_track;
2125                 info.d_serialno = xpt_path_serialno(periph->path);
2126                 if (info.d_media_blocks != softc->disk.d_info.d_media_blocks) {
2127                         kprintf("%s%d: open removable media: "
2128                                 "%juMB (%ju %u byte sectors: %dH %dS/T %dC)\n",
2129                                 periph->periph_name, periph->unit_number,
2130                                 (uintmax_t)(((uintmax_t)dp->secsize *
2131                                              dp->sectors) / (1024*1024)),
2132                                 (uintmax_t)dp->sectors, dp->secsize,
2133                                 dp->heads, dp->secs_per_track, dp->cylinders);
2134                         disk_setdiskinfo(&softc->disk, &info);
2135                 }
2136                 CAM_SIM_LOCK(periph->sim);
2137         } else {
2138                 kprintf("%s%d: open removable media: no media present\n",
2139                         periph->periph_name, periph->unit_number);
2140                 info.d_media_blksize = 512;
2141                 disk_setdiskinfo(&softc->disk, &info);
2142         }
2143         return (error);
2144 }
2145
2146 static int
2147 dagetcapacity(struct cam_periph *periph)
2148 {
2149         struct da_softc *softc;
2150         union ccb *ccb;
2151         struct scsi_read_capacity_data *rcap;
2152         struct scsi_read_capacity_data_16 *rcaplong;
2153         uint32_t block_len;
2154         uint64_t maxsector;
2155         int error;
2156  
2157         softc = (struct da_softc *)periph->softc;
2158         block_len = 0;
2159         maxsector = 0;
2160         error = 0;
2161  
2162         /* Do a read capacity */
2163         rcap = (struct scsi_read_capacity_data *)kmalloc(sizeof(*rcaplong),
2164                                                          M_SCSIDA, M_INTWAIT);
2165                 
2166         ccb = cam_periph_getccb(periph, /*priority*/1);
2167         scsi_read_capacity(&ccb->csio,
2168                            /*retries*/4,
2169                            /*cbfncp*/dadone,
2170                            MSG_SIMPLE_Q_TAG,
2171                            rcap,
2172                            SSD_FULL_SIZE,
2173                            /*timeout*/60000);
2174         ccb->ccb_h.ccb_bio = NULL;
2175  
2176         error = cam_periph_runccb(ccb, daerror,
2177                                   /*cam_flags*/CAM_RETRY_SELTO,
2178                                   /*sense_flags*/SF_RETRY_UA,
2179                                   &softc->device_stats);
2180  
2181         if ((ccb->ccb_h.status & CAM_DEV_QFRZN) != 0)
2182                 cam_release_devq(ccb->ccb_h.path,
2183                                  /*relsim_flags*/0,
2184                                  /*reduction*/0,
2185                                  /*timeout*/0,
2186                                  /*getcount_only*/0);
2187  
2188         if (error == 0) {
2189                 block_len = scsi_4btoul(rcap->length);
2190                 maxsector = scsi_4btoul(rcap->addr);
2191
2192                 if (maxsector != 0xffffffff)
2193                         goto done;
2194         } else
2195                 goto done;
2196  
2197         rcaplong = (struct scsi_read_capacity_data_16 *)rcap;
2198  
2199         scsi_read_capacity_16(&ccb->csio,
2200                               /*retries*/ 4,
2201                               /*cbfcnp*/ dadone,
2202                               /*tag_action*/ MSG_SIMPLE_Q_TAG,
2203                               /*lba*/ 0,
2204                               /*reladr*/ 0,
2205                               /*pmi*/ 0,
2206                               rcaplong,
2207                               /*sense_len*/ SSD_FULL_SIZE,
2208                               /*timeout*/ 60000);
2209         ccb->ccb_h.ccb_bio = NULL;
2210  
2211         error = cam_periph_runccb(ccb, daerror,
2212                                   /*cam_flags*/CAM_RETRY_SELTO,
2213                                   /*sense_flags*/SF_RETRY_UA,
2214                                   &softc->device_stats);
2215  
2216         if ((ccb->ccb_h.status & CAM_DEV_QFRZN) != 0)
2217                 cam_release_devq(ccb->ccb_h.path,
2218                                  /*relsim_flags*/0,
2219                                  /*reduction*/0,
2220                                  /*timeout*/0,
2221                                  /*getcount_only*/0);
2222  
2223         if (error == 0) {
2224                 block_len = scsi_4btoul(rcaplong->length);
2225                 maxsector = scsi_8btou64(rcaplong->addr);
2226         }
2227
2228 done:
2229
2230         if (error == 0)
2231                 dasetgeom(periph, block_len, maxsector);
2232  
2233         xpt_release_ccb(ccb);
2234  
2235         kfree(rcap, M_SCSIDA);
2236  
2237         return (error);
2238 }
2239
2240 static void
2241 dasetgeom(struct cam_periph *periph, uint32_t block_len, uint64_t maxsector)
2242 {
2243         struct ccb_calc_geometry ccg;
2244         struct da_softc *softc;
2245         struct disk_params *dp;
2246
2247         softc = (struct da_softc *)periph->softc;
2248
2249         dp = &softc->params;
2250         dp->secsize = block_len;
2251         dp->sectors = maxsector + 1;
2252         /*
2253          * Have the controller provide us with a geometry
2254          * for this disk.  The only time the geometry
2255          * matters is when we boot and the controller
2256          * is the only one knowledgeable enough to come
2257          * up with something that will make this a bootable
2258          * device.
2259          */
2260         xpt_setup_ccb(&ccg.ccb_h, periph->path, /*priority*/1);
2261         ccg.ccb_h.func_code = XPT_CALC_GEOMETRY;
2262         ccg.block_size = dp->secsize;
2263         ccg.volume_size = dp->sectors;
2264         ccg.heads = 0;
2265         ccg.secs_per_track = 0;
2266         ccg.cylinders = 0;
2267         xpt_action((union ccb*)&ccg);
2268         if ((ccg.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
2269                 /*
2270                  * We don't know what went wrong here- but just pick
2271                  * a geometry so we don't have nasty things like divide
2272                  * by zero.
2273                  */
2274                 dp->heads = 255;
2275                 dp->secs_per_track = 255;
2276                 dp->cylinders = dp->sectors / (255 * 255);
2277                 if (dp->cylinders == 0) {
2278                         dp->cylinders = 1;
2279                 }
2280         } else {
2281                 dp->heads = ccg.heads;
2282                 dp->secs_per_track = ccg.secs_per_track;
2283                 dp->cylinders = ccg.cylinders;
2284         }
2285 }
2286
2287 static void
2288 dasendorderedtag(void *arg)
2289 {
2290         struct da_softc *softc = arg;
2291
2292         if (da_send_ordered) {
2293                 if ((softc->ordered_tag_count == 0)
2294                  && ((softc->flags & DA_FLAG_WENT_IDLE) == 0)) {
2295                         softc->flags |= DA_FLAG_NEED_OTAG;
2296                 }
2297                 if (softc->outstanding_cmds_rd || softc->outstanding_cmds_wr)
2298                         softc->flags &= ~DA_FLAG_WENT_IDLE;
2299
2300                 softc->ordered_tag_count = 0;
2301         }
2302         /* Queue us up again */
2303         callout_reset(&softc->sendordered_c,
2304             (DA_DEFAULT_TIMEOUT * hz) / DA_ORDEREDTAG_INTERVAL,
2305             dasendorderedtag, softc);
2306 }
2307
2308 /*
2309  * Step through all DA peripheral drivers, and if the device is still open,
2310  * sync the disk cache to physical media.
2311  */
2312 static void
2313 dashutdown(void * arg, int howto)
2314 {
2315         struct cam_periph *periph;
2316         struct da_softc *softc;
2317
2318         TAILQ_FOREACH(periph, &dadriver.units, unit_links) {
2319                 union ccb ccb;
2320
2321                 cam_periph_lock(periph);
2322                 softc = (struct da_softc *)periph->softc;
2323
2324                 /*
2325                  * We only sync the cache if the drive is still open, and
2326                  * if the drive is capable of it..
2327                  */
2328                 if (((softc->flags & DA_FLAG_OPEN) == 0)
2329                  || (softc->quirks & DA_Q_NO_SYNC_CACHE)) {
2330                         cam_periph_unlock(periph);
2331                         continue;
2332                 }
2333
2334                 xpt_setup_ccb(&ccb.ccb_h, periph->path, /*priority*/1);
2335
2336                 ccb.ccb_h.ccb_state = DA_CCB_DUMP;
2337                 scsi_synchronize_cache(&ccb.csio,
2338                                        /*retries*/1,
2339                                        /*cbfcnp*/dadone,
2340                                        MSG_SIMPLE_Q_TAG,
2341                                        /*begin_lba*/0, /* whole disk */
2342                                        /*lb_count*/0,
2343                                        SSD_FULL_SIZE,
2344                                        60 * 60 * 1000);
2345
2346                 xpt_polled_action(&ccb);
2347
2348                 if ((ccb.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
2349                         if (((ccb.ccb_h.status & CAM_STATUS_MASK) ==
2350                              CAM_SCSI_STATUS_ERROR)
2351                          && (ccb.csio.scsi_status == SCSI_STATUS_CHECK_COND)){
2352                                 int error_code, sense_key, asc, ascq;
2353
2354                                 scsi_extract_sense(&ccb.csio.sense_data,
2355                                                    &error_code, &sense_key,
2356                                                    &asc, &ascq);
2357
2358                                 if (sense_key != SSD_KEY_ILLEGAL_REQUEST)
2359                                         scsi_sense_print(&ccb.csio);
2360                         } else {
2361                                 xpt_print(periph->path, "Synchronize "
2362                                     "cache failed, status == 0x%x, scsi status "
2363                                     "== 0x%x\n", ccb.ccb_h.status,
2364                                     ccb.csio.scsi_status);
2365                         }
2366                 }
2367
2368                 if ((ccb.ccb_h.status & CAM_DEV_QFRZN) != 0)
2369                         cam_release_devq(ccb.ccb_h.path,
2370                                          /*relsim_flags*/0,
2371                                          /*reduction*/0,
2372                                          /*timeout*/0,
2373                                          /*getcount_only*/0);
2374
2375                 cam_periph_unlock(periph);
2376         }
2377 }
2378
2379 #else /* !_KERNEL */
2380
2381 /*
2382  * XXX This is only left out of the kernel build to silence warnings.  If,
2383  * for some reason this function is used in the kernel, the ifdefs should
2384  * be moved so it is included both in the kernel and userland.
2385  */
2386 void
2387 scsi_format_unit(struct ccb_scsiio *csio, u_int32_t retries,
2388                  void (*cbfcnp)(struct cam_periph *, union ccb *),
2389                  u_int8_t tag_action, u_int8_t byte2, u_int16_t ileave,
2390                  u_int8_t *data_ptr, u_int32_t dxfer_len, u_int8_t sense_len,
2391                  u_int32_t timeout)
2392 {
2393         struct scsi_format_unit *scsi_cmd;
2394
2395         scsi_cmd = (struct scsi_format_unit *)&csio->cdb_io.cdb_bytes;
2396         scsi_cmd->opcode = FORMAT_UNIT;
2397         scsi_cmd->byte2 = byte2;
2398         scsi_ulto2b(ileave, scsi_cmd->interleave);
2399
2400         cam_fill_csio(csio,
2401                       retries,
2402                       cbfcnp,
2403                       /*flags*/ (dxfer_len > 0) ? CAM_DIR_OUT : CAM_DIR_NONE,
2404                       tag_action,
2405                       data_ptr,
2406                       dxfer_len,
2407                       sense_len,
2408                       sizeof(*scsi_cmd),
2409                       timeout);
2410 }
2411
2412 #endif /* _KERNEL */