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