sys/bus/cam/scsi/scsi_da.c

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