sbin/camcontrol/fwdownload.c

   1 /*-
   2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
   3  *
   4  * Copyright (c) 2011 Sandvine Incorporated. All rights reserved.
   5  * Copyright (c) 2002-2011 Andre Albsmeier <andre@albsmeier.net>
   6  * All rights reserved.
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that the following conditions
  10  * are met:
  11  * 1. Redistributions of source code must retain the above copyright
  12  *    notice, this list of conditions and the following disclaimer,
  13  *    without modification, immediately at the beginning of the file.
  14  * 2. Redistributions in binary form must reproduce the above copyright
  15  *    notice, this list of conditions and the following disclaimer in the
  16  *    documentation and/or other materials provided with the distribution.
  17  *
  18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  19  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  20  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  21  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  22  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  23  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  24  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  25  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  26  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  27  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  28  */
  29
  30 /*
  31  * This software is derived from Andre Albsmeier's fwprog.c which contained
  32  * the following note:
  33  *
  34  * Many thanks goes to Marc Frajola <marc@terasolutions.com> from
  35  * TeraSolutions for the initial idea and his programme for upgrading
  36  * the firmware of I*M DDYS drives.
  37  */
  38
  39 /*
  40  * BEWARE:
  41  *
  42  * The fact that you see your favorite vendor listed below does not
  43  * imply that your equipment won't break when you use this software
  44  * with it. It only means that the firmware of at least one device type
  45  * of each vendor listed has been programmed successfully using this code.
  46  *
  47  * The -s option simulates a download but does nothing apart from that.
  48  * It can be used to check what chunk sizes would have been used with the
  49  * specified device.
  50  */
  51
  52 #include <sys/cdefs.h>
  53 __FBSDID("$FreeBSD$");
  54
  55 #include <sys/types.h>
  56 #include <sys/stat.h>
  57
  58 #include <err.h>
  59 #include <fcntl.h>
  60 #include <stdio.h>
  61 #include <stdlib.h>
  62 #include <string.h>
  63 #include <unistd.h>
  64
  65 #include <cam/scsi/scsi_all.h>
  66 #include <cam/scsi/scsi_message.h>
  67 #include <camlib.h>
  68
  69 #include "progress.h"
  70
  71 #include "camcontrol.h"
  72
  73 #define WB_TIMEOUT 50000        /* 50 seconds */
  74
  75 typedef enum {
  76         VENDOR_HGST,
  77         VENDOR_HITACHI,
  78         VENDOR_HP,
  79         VENDOR_IBM,
  80         VENDOR_PLEXTOR,
  81         VENDOR_QUALSTAR,
  82         VENDOR_QUANTUM,
  83         VENDOR_SAMSUNG,
  84         VENDOR_SEAGATE,
  85         VENDOR_SMART,
  86         VENDOR_ATA,
  87         VENDOR_UNKNOWN
  88 } fw_vendor_t;
  89
  90 /*
  91  * FW_TUR_READY:     The drive must return good status for a test unit ready.
  92  *
  93  * FW_TUR_NOT_READY: The drive must return not ready status for a test unit
  94  *                   ready.  You may want this in a removable media drive.
  95  *
  96  * FW_TUR_NA:        It doesn't matter whether the drive is ready or not.
  97  *                   This may be the case for a removable media drive.
  98  */
  99 typedef enum {
 100         FW_TUR_NONE,
 101         FW_TUR_READY,
 102         FW_TUR_NOT_READY,
 103         FW_TUR_NA
 104 } fw_tur_status;
 105
 106 /*
 107  * FW_TIMEOUT_DEFAULT:          Attempt to probe for a WRITE BUFFER timeout
 108  *                              value from the drive.  If we get an answer,
 109  *                              use the Recommended timeout.  Otherwise,
 110  *                              use the default value from the table.
 111  *
 112  * FW_TIMEOUT_DEV_REPORTED:     The timeout value was probed directly from
 113  *                              the device.
 114  *
 115  * FW_TIMEOUT_NO_PROBE:         Do not ask the device for a WRITE BUFFER
 116  *                              timeout value.  Use the device-specific
 117  *                              value.
 118  *
 119  * FW_TIMEOUT_USER_SPEC:        The user specified a timeout on the command
 120  *                              line with the -t option.  This overrides any
 121  *                              probe or default timeout.
 122  */
 123 typedef enum {
 124         FW_TIMEOUT_DEFAULT,
 125         FW_TIMEOUT_DEV_REPORTED,
 126         FW_TIMEOUT_NO_PROBE,
 127         FW_TIMEOUT_USER_SPEC
 128 } fw_timeout_type;
 129
 130 /*
 131  * type:                Enumeration for the particular vendor.
 132  *
 133  * pattern:             Pattern to match for the Vendor ID from the SCSI
 134  *                      Inquiry data.
 135  *
 136  * dev_type:            SCSI device type to match, or T_ANY to match any
 137  *                      device from the given vendor.  Note that if there
 138  *                      is a specific device type listed for a particular
 139  *                      vendor, it must be listed before a T_ANY entry.
 140  *
 141  * max_pkt_size:        Maximum packet size when talking to a device.  Note
 142  *                      that although large data sizes may be supported by
 143  *                      the target device, they may not be supported by the
 144  *                      OS or the controller.
 145  *
 146  * cdb_byte2:           This specifies byte 2 (byte 1 when counting from 0)
 147  *                      of the CDB.  This is generally the WRITE BUFFER mode.
 148  *
 149  * cdb_byte2_last:      This specifies byte 2 for the last chunk of the
 150  *                      download.
 151  *
 152  * inc_cdb_buffer_id:   Increment the buffer ID by 1 for each chunk sent
 153  *                      down to the drive.
 154  *
 155  * inc_cdb_offset:      Increment the offset field in the CDB with the byte
 156  *                      offset into the firmware file.
 157  *
 158  * tur_status:          Pay attention to whether the device is ready before
 159  *                      upgrading the firmware, or not.  See above for the
 160  *                      values.
 161  */
 162 struct fw_vendor {
 163         fw_vendor_t type;
 164         const char *pattern;
 165         int dev_type;
 166         int max_pkt_size;
 167         u_int8_t cdb_byte2;
 168         u_int8_t cdb_byte2_last;
 169         int inc_cdb_buffer_id;
 170         int inc_cdb_offset;
 171         fw_tur_status tur_status;
 172         int timeout_ms;
 173         fw_timeout_type timeout_type;
 174 };
 175
 176 /*
 177  * Vendor notes:
 178  *
 179  * HGST:     The packets need to be sent in multiples of 4K.
 180  *
 181  * IBM:      For LTO and TS drives, the buffer ID is ignored in mode 7 (and
 182  *           some other modes).  It treats the request as a firmware download.
 183  *           The offset (and therefore the length of each chunk sent) needs
 184  *           to be a multiple of the offset boundary specified for firmware
 185  *           (buffer ID 4) in the read buffer command.  At least for LTO-6,
 186  *           that seems to be 0, but using a 32K chunk size should satisfy
 187  *           most any alignment requirement.
 188  *
 189  * SmrtStor: Mode 5 is also supported, but since the firmware is 400KB or
 190  *           so, we can't fit it in a single request in most cases.
 191  */
 192 static struct fw_vendor vendors_list[] = {
 193         {VENDOR_HGST,           "HGST",         T_DIRECT,
 194         0x1000, 0x07, 0x07, 1, 0, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 195         {VENDOR_HITACHI,        "HITACHI",      T_ANY,
 196         0x8000, 0x05, 0x05, 1, 0, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 197         {VENDOR_HP,             "HP",           T_ANY,
 198         0x8000, 0x07, 0x07, 0, 1, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 199         {VENDOR_IBM,            "IBM",          T_SEQUENTIAL,
 200         0x8000, 0x07, 0x07, 0, 1, FW_TUR_NA, 300 * 1000, FW_TIMEOUT_DEFAULT},
 201         {VENDOR_IBM,            "IBM",          T_ANY,
 202         0x8000, 0x05, 0x05, 1, 0, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 203         {VENDOR_PLEXTOR,        "PLEXTOR",      T_ANY,
 204         0x2000, 0x04, 0x05, 0, 1, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 205         {VENDOR_QUALSTAR,       "QUALSTAR",     T_ANY,
 206         0x2030, 0x05, 0x05, 0, 0, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 207         {VENDOR_QUANTUM,        "QUANTUM",      T_ANY,
 208         0x2000, 0x04, 0x05, 0, 1, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 209         {VENDOR_SAMSUNG,        "SAMSUNG",      T_ANY,
 210         0x8000, 0x07, 0x07, 0, 1, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 211         {VENDOR_SEAGATE,        "SEAGATE",      T_ANY,
 212         0x8000, 0x07, 0x07, 0, 1, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 213         {VENDOR_SMART,          "SmrtStor",     T_DIRECT,
 214         0x8000, 0x07, 0x07, 0, 1, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 215         {VENDOR_HGST,           "WD",           T_DIRECT,
 216         0x1000, 0x07, 0x07, 1, 0, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 217         {VENDOR_HGST,           "WDC",          T_DIRECT,
 218         0x1000, 0x07, 0x07, 1, 0, FW_TUR_READY, WB_TIMEOUT, FW_TIMEOUT_DEFAULT},
 219
 220         /*
 221          * We match any ATA device.  This is really just a placeholder,
 222          * since we won't actually send a WRITE BUFFER with any of the
 223          * listed parameters.  If a SATA device is behind a SAS controller,
 224          * the SCSI to ATA translation code (at least for LSI) doesn't
 225          * generally translate a SCSI WRITE BUFFER into an ATA DOWNLOAD
 226          * MICROCODE command.  So, we use the SCSI ATA PASS_THROUGH command
 227          * to send the ATA DOWNLOAD MICROCODE command instead.
 228          */
 229         {VENDOR_ATA,            "ATA",          T_ANY,
 230          0x8000, 0x07, 0x07, 0, 1, FW_TUR_READY, WB_TIMEOUT,
 231          FW_TIMEOUT_NO_PROBE},
 232         {VENDOR_UNKNOWN,        NULL,           T_ANY,
 233         0x0000, 0x00, 0x00, 0, 0, FW_TUR_NONE, WB_TIMEOUT, FW_TIMEOUT_DEFAULT}
 234 };
 235
 236 struct fw_timeout_desc {
 237         fw_timeout_type timeout_type;
 238         const char *timeout_desc;
 239 };
 240
 241 static const struct fw_timeout_desc fw_timeout_desc_table[] = {
 242         { FW_TIMEOUT_DEFAULT, "the default" },
 243         { FW_TIMEOUT_DEV_REPORTED, "recommended by this particular device" },
 244         { FW_TIMEOUT_NO_PROBE, "the default" },
 245         { FW_TIMEOUT_USER_SPEC, "what was specified on the command line" }
 246 };
 247
 248 #ifndef ATA_DOWNLOAD_MICROCODE
 249 #define ATA_DOWNLOAD_MICROCODE  0x92
 250 #endif
 251
 252 #define USE_OFFSETS_FEATURE     0x3
 253
 254 #ifndef LOW_SECTOR_SIZE
 255 #define LOW_SECTOR_SIZE         512
 256 #endif
 257
 258 #define ATA_MAKE_LBA(o, p)      \
 259         ((((((o) / LOW_SECTOR_SIZE) >> 8) & 0xff) << 16) | \
 260           ((((o) / LOW_SECTOR_SIZE) & 0xff) << 8) | \
 261           ((((p) / LOW_SECTOR_SIZE) >> 8) & 0xff))
 262
 263 #define ATA_MAKE_SECTORS(p)     (((p) / 512) & 0xff)
 264
 265 #ifndef UNKNOWN_MAX_PKT_SIZE
 266 #define UNKNOWN_MAX_PKT_SIZE    0x8000
 267 #endif
 268
 269 static struct fw_vendor *fw_get_vendor(struct cam_device *cam_dev,
 270                                        struct ata_params *ident_buf);
 271 static int fw_get_timeout(struct cam_device *cam_dev, struct fw_vendor *vp,
 272                           int task_attr, int retry_count, int timeout);
 273 static int fw_validate_ibm(struct cam_device *dev, int retry_count,
 274                            int timeout, int fd, char *buf,
 275                             const char *fw_img_path, int quiet);
 276 static char *fw_read_img(struct cam_device *dev, int retry_count,
 277                          int timeout, int quiet, const char *fw_img_path,
 278                          struct fw_vendor *vp, int *num_bytes);
 279 static int fw_check_device_ready(struct cam_device *dev,
 280                                  camcontrol_devtype devtype,
 281                                  struct fw_vendor *vp, int printerrors,
 282                                  int timeout);
 283 static int fw_download_img(struct cam_device *cam_dev,
 284                            struct fw_vendor *vp, char *buf, int img_size,
 285                            int sim_mode, int printerrors, int quiet,
 286                            int retry_count, int timeout, const char */*name*/,
 287                            camcontrol_devtype devtype);
 288
 289 /*
 290  * Find entry in vendors list that belongs to
 291  * the vendor of given cam device.
 292  */
 293 static struct fw_vendor *
 294 fw_get_vendor(struct cam_device *cam_dev, struct ata_params *ident_buf)
 295 {
 296         char vendor[42];
 297         struct fw_vendor *vp;
 298
 299         if (cam_dev == NULL)
 300                 return (NULL);
 301
 302         if (ident_buf != NULL) {
 303                 cam_strvis((u_char *)vendor, ident_buf->model,
 304                     sizeof(ident_buf->model), sizeof(vendor));
 305                 for (vp = vendors_list; vp->pattern != NULL; vp++) {
 306                         if (vp->type == VENDOR_ATA)
 307                                 return (vp);
 308                 }
 309         } else {
 310                 cam_strvis((u_char *)vendor, (u_char *)cam_dev->inq_data.vendor,
 311                     sizeof(cam_dev->inq_data.vendor), sizeof(vendor));
 312         }
 313         for (vp = vendors_list; vp->pattern != NULL; vp++) {
 314                 if (!cam_strmatch((const u_char *)vendor,
 315                     (const u_char *)vp->pattern, strlen(vendor))) {
 316                         if ((vp->dev_type == T_ANY)
 317                          || (vp->dev_type == SID_TYPE(&cam_dev->inq_data)))
 318                                 break;
 319                 }
 320         }
 321         return (vp);
 322 }
 323
 324 static int
 325 fw_get_timeout(struct cam_device *cam_dev, struct fw_vendor *vp,
 326                int task_attr, int retry_count, int timeout)
 327 {
 328         struct scsi_report_supported_opcodes_one *one;
 329         struct scsi_report_supported_opcodes_timeout *td;
 330         uint8_t *buf = NULL;
 331         uint32_t fill_len = 0, cdb_len = 0, rec_timeout = 0;
 332         int retval = 0;
 333
 334         /*
 335          * If the user has specified a timeout on the command line, we let
 336          * him override any default or probed value.
 337          */
 338         if (timeout != 0) {
 339                 vp->timeout_type = FW_TIMEOUT_USER_SPEC;
 340                 vp->timeout_ms = timeout;
 341                 goto bailout;
 342         }
 343
 344         /*
 345          * Check to see whether we should probe for a timeout for this
 346          * device.
 347          */
 348         if (vp->timeout_type == FW_TIMEOUT_NO_PROBE)
 349                 goto bailout;
 350
 351         retval = scsigetopcodes(/*device*/ cam_dev,
 352                                 /*opcode_set*/ 1,
 353                                 /*opcode*/ WRITE_BUFFER,
 354                                 /*show_sa_errors*/ 1,
 355                                 /*sa_set*/ 0,
 356                                 /*service_action*/ 0,
 357                                 /*timeout_desc*/ 1,
 358                                 /*task_attr*/ task_attr,
 359                                 /*retry_count*/ retry_count,
 360                                 /*timeout*/ 10000,
 361                                 /*verbose*/ 0,
 362                                 /*fill_len*/ &fill_len,
 363                                 /*data_ptr*/ &buf);
 364         /*
 365          * It isn't an error if we can't get a timeout descriptor.  We just
 366          * continue on with the default timeout.
 367          */
 368         if (retval != 0) {
 369                 retval = 0;
 370                 goto bailout;
 371         }
 372
 373         /*
 374          * Even if the drive didn't return a SCSI error, if we don't have
 375          * enough data to contain the one opcode descriptor, the CDB
 376          * structure and a timeout descriptor, we don't have the timeout
 377          * value we're looking for.  So we'll just fall back to the
 378          * default value.
 379          */
 380         if (fill_len < (sizeof(*one) + sizeof(struct scsi_write_buffer) +
 381             sizeof(*td)))
 382                 goto bailout;
 383
 384         one = (struct scsi_report_supported_opcodes_one *)buf;
 385
 386         /*
 387          * If the drive claims to not support the WRITE BUFFER command...
 388          * fall back to the default timeout value and let things fail on
 389          * the actual firmware download.
 390          */
 391         if ((one->support & RSO_ONE_SUP_MASK) == RSO_ONE_SUP_NOT_SUP)
 392                 goto bailout;
 393
 394         cdb_len = scsi_2btoul(one->cdb_length);
 395         td = (struct scsi_report_supported_opcodes_timeout *)
 396             &buf[sizeof(*one) + cdb_len];
 397
 398         rec_timeout = scsi_4btoul(td->recommended_time);
 399         /*
 400          * If the recommended timeout is 0, then the device has probably
 401          * returned a bogus value.
 402          */
 403         if (rec_timeout == 0)
 404                 goto bailout;
 405
 406         /* CAM timeouts are in ms */
 407         rec_timeout *= 1000;
 408
 409         vp->timeout_ms = rec_timeout;
 410         vp->timeout_type = FW_TIMEOUT_DEV_REPORTED;
 411
 412 bailout:
 413         return (retval);
 414 }
 415
 416 #define SVPD_IBM_FW_DESIGNATION         0x03
 417
 418 /*
 419  * IBM LTO and TS tape drives have an INQUIRY VPD page 0x3 with the following
 420  * format:
 421  */
 422 struct fw_ibm_tape_fw_designation {
 423         uint8_t device;
 424         uint8_t page_code;
 425         uint8_t reserved;
 426         uint8_t length;
 427         uint8_t ascii_length;
 428         uint8_t reserved2[3];
 429         uint8_t load_id[4];
 430         uint8_t fw_rev[4];
 431         uint8_t ptf_number[4];
 432         uint8_t patch_number[4];
 433         uint8_t ru_name[8];
 434         uint8_t lib_seq_num[5];
 435 };
 436
 437 /*
 438  * The firmware for IBM tape drives has the following header format.  The
 439  * load_id and ru_name in the header file should match what is returned in
 440  * VPD page 0x3.
 441  */
 442 struct fw_ibm_tape_fw_header {
 443         uint8_t unspec[4];
 444         uint8_t length[4];              /* Firmware and header! */
 445         uint8_t load_id[4];
 446         uint8_t fw_rev[4];
 447         uint8_t reserved[8];
 448         uint8_t ru_name[8];
 449 };
 450
 451 static int
 452 fw_validate_ibm(struct cam_device *dev, int retry_count, int timeout, int fd,
 453                 char *buf, const char *fw_img_path, int quiet)
 454 {
 455         union ccb *ccb;
 456         struct fw_ibm_tape_fw_designation vpd_page;
 457         struct fw_ibm_tape_fw_header *header;
 458         char drive_rev[sizeof(vpd_page.fw_rev) + 1];
 459         char file_rev[sizeof(vpd_page.fw_rev) + 1];
 460         int retval = 1;
 461
 462         ccb = cam_getccb(dev);
 463         if (ccb == NULL) {
 464                 warnx("couldn't allocate CCB");
 465                 goto bailout;
 466         }
 467
 468         bzero(&vpd_page, sizeof(vpd_page));
 469
 470         scsi_inquiry(&ccb->csio,
 471                      /*retries*/ retry_count,
 472                      /*cbfcnp*/ NULL,
 473                      /* tag_action */ MSG_SIMPLE_Q_TAG,
 474                      /* inq_buf */ (u_int8_t *)&vpd_page,
 475                      /* inq_len */ sizeof(vpd_page),
 476                      /* evpd */ 1,
 477                      /* page_code */ SVPD_IBM_FW_DESIGNATION,
 478                      /* sense_len */ SSD_FULL_SIZE,
 479                      /* timeout */ timeout ? timeout : 5000);
 480
 481         /* Disable freezing the device queue */
 482         ccb->ccb_h.flags |= CAM_DEV_QFRZDIS;
 483
 484         if (retry_count != 0)
 485                 ccb->ccb_h.flags |= CAM_PASS_ERR_RECOVER;
 486
 487         if (cam_send_ccb(dev, ccb) < 0) {
 488                 warn("error getting firmware designation page");
 489
 490                 cam_error_print(dev, ccb, CAM_ESF_ALL,
 491                                 CAM_EPF_ALL, stderr);
 492
 493                 cam_freeccb(ccb);
 494                 ccb = NULL;
 495                 goto bailout;
 496         }
 497
 498         if ((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) {
 499                 cam_error_print(dev, ccb, CAM_ESF_ALL,
 500                                 CAM_EPF_ALL, stderr);
 501                 goto bailout;
 502         }
 503
 504         /*
 505          * Read the firmware header only.
 506          */
 507         if (read(fd, buf, sizeof(*header)) != sizeof(*header)) {
 508                 warn("unable to read %zu bytes from %s", sizeof(*header),
 509                      fw_img_path);
 510                 goto bailout;
 511         }
 512
 513         /* Rewind the file back to 0 for the full file read. */
 514         if (lseek(fd, 0, SEEK_SET) == -1) {
 515                 warn("Unable to lseek");
 516                 goto bailout;
 517         }
 518
 519         header = (struct fw_ibm_tape_fw_header *)buf;
 520
 521         bzero(drive_rev, sizeof(drive_rev));
 522         bcopy(vpd_page.fw_rev, drive_rev, sizeof(vpd_page.fw_rev));
 523         bzero(file_rev, sizeof(file_rev));
 524         bcopy(header->fw_rev, file_rev, sizeof(header->fw_rev));
 525
 526         if (quiet == 0) {
 527                 fprintf(stdout, "Current Drive Firmware version: %s\n",
 528                         drive_rev);
 529                 fprintf(stdout, "Firmware File version: %s\n", file_rev);
 530         }
 531
 532         /*
 533          * For IBM tape drives the load ID and RU name reported by the
 534          * drive should match what is in the firmware file.
 535          */
 536         if (bcmp(vpd_page.load_id, header->load_id,
 537                  MIN(sizeof(vpd_page.load_id), sizeof(header->load_id))) != 0) {
 538                 warnx("Drive Firmware load ID 0x%x does not match firmware "
 539                       "file load ID 0x%x", scsi_4btoul(vpd_page.load_id),
 540                       scsi_4btoul(header->load_id));
 541                 goto bailout;
 542         }
 543
 544         if (bcmp(vpd_page.ru_name, header->ru_name,
 545                  MIN(sizeof(vpd_page.ru_name), sizeof(header->ru_name))) != 0) {
 546                 warnx("Drive Firmware RU name 0x%jx does not match firmware "
 547                       "file RU name 0x%jx",
 548                       (uintmax_t)scsi_8btou64(vpd_page.ru_name),
 549                       (uintmax_t)scsi_8btou64(header->ru_name));
 550                 goto bailout;
 551         }
 552         if (quiet == 0)
 553                 fprintf(stdout, "Firmware file is valid for this drive.\n");
 554         retval = 0;
 555 bailout:
 556         cam_freeccb(ccb);
 557
 558         return (retval);
 559 }
 560
 561 /*
 562  * Allocate a buffer and read fw image file into it
 563  * from given path. Number of bytes read is stored
 564  * in num_bytes.
 565  */
 566 static char *
 567 fw_read_img(struct cam_device *dev, int retry_count, int timeout, int quiet,
 568             const char *fw_img_path, struct fw_vendor *vp, int *num_bytes)
 569 {
 570         int fd;
 571         struct stat stbuf;
 572         char *buf;
 573         off_t img_size;
 574         int skip_bytes = 0;
 575
 576         if ((fd = open(fw_img_path, O_RDONLY)) < 0) {
 577                 warn("Could not open image file %s", fw_img_path);
 578                 return (NULL);
 579         }
 580         if (fstat(fd, &stbuf) < 0) {
 581                 warn("Could not stat image file %s", fw_img_path);
 582                 goto bailout1;
 583         }
 584         if ((img_size = stbuf.st_size) == 0) {
 585                 warnx("Zero length image file %s", fw_img_path);
 586                 goto bailout1;
 587         }
 588         if ((buf = malloc(img_size)) == NULL) {
 589                 warnx("Could not allocate buffer to read image file %s",
 590                     fw_img_path);
 591                 goto bailout1;
 592         }
 593         /* Skip headers if applicable. */
 594         switch (vp->type) {
 595         case VENDOR_SEAGATE:
 596                 if (read(fd, buf, 16) != 16) {
 597                         warn("Could not read image file %s", fw_img_path);
 598                         goto bailout;
 599                 }
 600                 if (lseek(fd, 0, SEEK_SET) == -1) {
 601                         warn("Unable to lseek");
 602                         goto bailout;
 603                 }
 604                 if ((strncmp(buf, "SEAGATE,SEAGATE ", 16) == 0) ||
 605                     (img_size % 512 == 80))
 606                         skip_bytes = 80;
 607                 break;
 608         case VENDOR_QUALSTAR:
 609                 skip_bytes = img_size % 1030;
 610                 break;
 611         case VENDOR_IBM: {
 612                 if (vp->dev_type != T_SEQUENTIAL)
 613                         break;
 614                 if (fw_validate_ibm(dev, retry_count, timeout, fd, buf,
 615                                     fw_img_path, quiet) != 0)
 616                         goto bailout;
 617                 break;
 618         }
 619         default:
 620                 break;
 621         }
 622         if (skip_bytes != 0) {
 623                 fprintf(stdout, "Skipping %d byte header.\n", skip_bytes);
 624                 if (lseek(fd, skip_bytes, SEEK_SET) == -1) {
 625                         warn("Could not lseek");
 626                         goto bailout;
 627                 }
 628                 img_size -= skip_bytes;
 629         }
 630         /* Read image into a buffer. */
 631         if (read(fd, buf, img_size) != img_size) {
 632                 warn("Could not read image file %s", fw_img_path);
 633                 goto bailout;
 634         }
 635         *num_bytes = img_size;
 636         close(fd);
 637         return (buf);
 638 bailout:
 639         free(buf);
 640 bailout1:
 641         close(fd);
 642         *num_bytes = 0;
 643         return (NULL);
 644 }
 645
 646 /*
 647  * Returns 0 for "success", where success means that the device has met the
 648  * requirement in the vendor structure for being ready or not ready when
 649  * firmware is downloaded.
 650  *
 651  * Returns 1 for a failure to be ready to accept a firmware download.
 652  * (e.g., a drive needs to be ready, but returns not ready)
 653  *
 654  * Returns -1 for any other failure.
 655  */
 656 static int
 657 fw_check_device_ready(struct cam_device *dev, camcontrol_devtype devtype,
 658                       struct fw_vendor *vp, int printerrors, int timeout)
 659 {
 660         union ccb *ccb;
 661         int retval = 0;
 662         int16_t *ptr = NULL;
 663         size_t dxfer_len = 0;
 664
 665         if ((ccb = cam_getccb(dev)) == NULL) {
 666                 warnx("Could not allocate CCB");
 667                 retval = -1;
 668                 goto bailout;
 669         }
 670
 671         if (devtype != CC_DT_SCSI) {
 672                 dxfer_len = sizeof(struct ata_params);
 673
 674                 ptr = (uint16_t *)malloc(dxfer_len);
 675                 if (ptr == NULL) {
 676                         warnx("can't malloc memory for identify");
 677                         retval = -1;
 678                         goto bailout;
 679                 }
 680                 bzero(ptr, dxfer_len);
 681         }
 682
 683         switch (devtype) {
 684         case CC_DT_SCSI:
 685                 scsi_test_unit_ready(&ccb->csio,
 686                                      /*retries*/ 0,
 687                                      /*cbfcnp*/ NULL,
 688                                      /*tag_action*/ MSG_SIMPLE_Q_TAG,
 689                                      /*sense_len*/ SSD_FULL_SIZE,
 690                                      /*timeout*/ 5000);
 691                 break;
 692         case CC_DT_SATL:
 693         case CC_DT_ATA: {
 694                 retval = build_ata_cmd(ccb,
 695                              /*retries*/ 1,
 696                              /*flags*/ CAM_DIR_IN,
 697                              /*tag_action*/ MSG_SIMPLE_Q_TAG,
 698                              /*protocol*/ AP_PROTO_PIO_IN,
 699                              /*ata_flags*/ AP_FLAG_BYT_BLOK_BLOCKS |
 700                                            AP_FLAG_TLEN_SECT_CNT |
 701                                            AP_FLAG_TDIR_FROM_DEV,
 702                              /*features*/ 0,
 703                              /*sector_count*/ dxfer_len / 512,
 704                              /*lba*/ 0,
 705                              /*command*/ ATA_ATA_IDENTIFY,
 706                              /*auxiliary*/ 0,
 707                              /*data_ptr*/ (uint8_t *)ptr,
 708                              /*dxfer_len*/ dxfer_len,
 709                              /*cdb_storage*/ NULL,
 710                              /*cdb_storage_len*/ 0,
 711                              /*sense_len*/ SSD_FULL_SIZE,
 712                              /*timeout*/ timeout ? timeout : 30 * 1000,
 713                              /*is48bit*/ 0,
 714                              /*devtype*/ devtype);
 715                 if (retval != 0) {
 716                         retval = -1;
 717                         warnx("%s: build_ata_cmd() failed, likely "
 718                             "programmer error", __func__);
 719                         goto bailout;
 720                 }
 721                 break;
 722         }
 723         default:
 724                 warnx("Unknown disk type %d", devtype);
 725                 retval = -1;
 726                 goto bailout;
 727                 break; /*NOTREACHED*/
 728         }
 729
 730         ccb->ccb_h.flags |= CAM_DEV_QFRZDIS;
 731
 732         retval = cam_send_ccb(dev, ccb);
 733         if (retval != 0) {
 734                 warn("error sending %s CCB", (devtype == CC_DT_SCSI) ?
 735                      "Test Unit Ready" : "Identify");
 736                 retval = -1;
 737                 goto bailout;
 738         }
 739
 740         if (((ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP)
 741          && (vp->tur_status == FW_TUR_READY)) {
 742                 warnx("Device is not ready");
 743                 if (printerrors)
 744                         cam_error_print(dev, ccb, CAM_ESF_ALL,
 745                             CAM_EPF_ALL, stderr);
 746                 retval = 1;
 747                 goto bailout;
 748         } else if (((ccb->ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP)
 749                 && (vp->tur_status == FW_TUR_NOT_READY)) {
 750                 warnx("Device cannot have media loaded when firmware is "
 751                     "downloaded");
 752                 retval = 1;
 753                 goto bailout;
 754         }
 755 bailout:
 756         free(ptr);
 757         cam_freeccb(ccb);
 758
 759         return (retval);
 760 }
 761
 762 /*
 763  * Download firmware stored in buf to cam_dev. If simulation mode
 764  * is enabled, only show what packet sizes would be sent to the
 765  * device but do not sent any actual packets
 766  */
 767 static int
 768 fw_download_img(struct cam_device *cam_dev, struct fw_vendor *vp,
 769     char *buf, int img_size, int sim_mode, int printerrors, int quiet,
 770     int retry_count, int timeout, const char *imgname,
 771     camcontrol_devtype devtype)
 772 {
 773         struct scsi_write_buffer cdb;
 774         progress_t progress;
 775         int size = 0;
 776         union ccb *ccb = NULL;
 777         int pkt_count = 0;
 778         int max_pkt_size;
 779         u_int32_t pkt_size = 0;
 780         char *pkt_ptr = buf;
 781         u_int32_t offset;
 782         int last_pkt = 0;
 783         int retval = 0;
 784
 785         /*
 786          * Check to see whether the device is ready to accept a firmware
 787          * download.
 788          */
 789         retval = fw_check_device_ready(cam_dev, devtype, vp, printerrors,
 790                                        timeout);
 791         if (retval != 0)
 792                 goto bailout;
 793
 794         if ((ccb = cam_getccb(cam_dev)) == NULL) {
 795                 warnx("Could not allocate CCB");
 796                 retval = 1;
 797                 goto bailout;
 798         }
 799
 800         max_pkt_size = vp->max_pkt_size;
 801         if (max_pkt_size == 0)
 802                 max_pkt_size = UNKNOWN_MAX_PKT_SIZE;
 803
 804         pkt_size = max_pkt_size;
 805         progress_init(&progress, imgname, size = img_size);
 806         /* Download single fw packets. */
 807         do {
 808                 if (img_size <= max_pkt_size) {
 809                         last_pkt = 1;
 810                         pkt_size = img_size;
 811                 }
 812                 progress_update(&progress, size - img_size);
 813                 if (((sim_mode == 0) && (quiet == 0))
 814                  || ((sim_mode != 0) && (printerrors == 0)))
 815                         progress_draw(&progress);
 816                 bzero(&cdb, sizeof(cdb));
 817                 switch (devtype) {
 818                 case CC_DT_SCSI:
 819                         cdb.opcode  = WRITE_BUFFER;
 820                         cdb.control = 0;
 821                         /* Parameter list length. */
 822                         scsi_ulto3b(pkt_size, &cdb.length[0]);
 823                         offset = vp->inc_cdb_offset ? (pkt_ptr - buf) : 0;
 824                         scsi_ulto3b(offset, &cdb.offset[0]);
 825                         cdb.byte2 = last_pkt ? vp->cdb_byte2_last :
 826                                                vp->cdb_byte2;
 827                         cdb.buffer_id = vp->inc_cdb_buffer_id ? pkt_count : 0;
 828                         /* Zero out payload of ccb union after ccb header. */
 829                         CCB_CLEAR_ALL_EXCEPT_HDR(&ccb->csio);
 830                         /*
 831                          * Copy previously constructed cdb into ccb_scsiio
 832                          * struct.
 833                          */
 834                         bcopy(&cdb, &ccb->csio.cdb_io.cdb_bytes[0],
 835                             sizeof(struct scsi_write_buffer));
 836                         /* Fill rest of ccb_scsiio struct. */
 837                         cam_fill_csio(&ccb->csio,               /* ccb_scsiio*/
 838                             retry_count,                        /* retries*/
 839                             NULL,                               /* cbfcnp*/
 840                             CAM_DIR_OUT | CAM_DEV_QFRZDIS,      /* flags*/
 841                             CAM_TAG_ACTION_NONE,                /* tag_action*/
 842                             (u_char *)pkt_ptr,                  /* data_ptr*/
 843                             pkt_size,                           /* dxfer_len*/
 844                             SSD_FULL_SIZE,                      /* sense_len*/
 845                             sizeof(struct scsi_write_buffer),   /* cdb_len*/
 846                             timeout ? timeout : WB_TIMEOUT);    /* timeout*/
 847                         break;
 848                 case CC_DT_ATA:
 849                 case CC_DT_SATL: {
 850                         uint32_t        off;
 851
 852                         off = (uint32_t)(pkt_ptr - buf);
 853
 854                         retval = build_ata_cmd(ccb,
 855                             /*retry_count*/ retry_count,
 856                             /*flags*/ CAM_DIR_OUT | CAM_DEV_QFRZDIS,
 857                             /*tag_action*/ CAM_TAG_ACTION_NONE,
 858                             /*protocol*/ AP_PROTO_PIO_OUT,
 859                             /*ata_flags*/ AP_FLAG_BYT_BLOK_BYTES |
 860                                           AP_FLAG_TLEN_SECT_CNT |
 861                                           AP_FLAG_TDIR_TO_DEV,
 862                             /*features*/ USE_OFFSETS_FEATURE,
 863                             /*sector_count*/ ATA_MAKE_SECTORS(pkt_size),
 864                             /*lba*/ ATA_MAKE_LBA(off, pkt_size),
 865                             /*command*/ ATA_DOWNLOAD_MICROCODE,
 866                             /*auxiliary*/ 0,
 867                             /*data_ptr*/ (uint8_t *)pkt_ptr,
 868                             /*dxfer_len*/ pkt_size,
 869                             /*cdb_storage*/ NULL,
 870                             /*cdb_storage_len*/ 0,
 871                             /*sense_len*/ SSD_FULL_SIZE,
 872                             /*timeout*/ timeout ? timeout : WB_TIMEOUT,
 873                             /*is48bit*/ 0,
 874                             /*devtype*/ devtype);
 875
 876                         if (retval != 0) {
 877                                 warnx("%s: build_ata_cmd() failed, likely "
 878                                     "programmer error", __func__);
 879                                 goto bailout;
 880                         }
 881                         break;
 882                 }
 883                 default:
 884                         warnx("Unknown device type %d", devtype);
 885                         retval = 1;
 886                         goto bailout;
 887                         break; /*NOTREACHED*/
 888                 }
 889                 if (!sim_mode) {
 890                         /* Execute the command. */
 891                         if (cam_send_ccb(cam_dev, ccb) < 0 ||
 892                             (ccb->ccb_h.status & CAM_STATUS_MASK) !=
 893                             CAM_REQ_CMP) {
 894                                 warnx("Error writing image to device");
 895                                 if (printerrors)
 896                                         cam_error_print(cam_dev, ccb,
 897                                             CAM_ESF_ALL, CAM_EPF_ALL, stderr);
 898                                 retval = 1;
 899                                 goto bailout;
 900                         }
 901                 } else if (printerrors) {
 902                         cam_error_print(cam_dev, ccb, CAM_ESF_COMMAND, 0,
 903                             stdout);
 904                 }
 905
 906                 /* Prepare next round. */
 907                 pkt_count++;
 908                 pkt_ptr += pkt_size;
 909                 img_size -= pkt_size;
 910         } while(!last_pkt);
 911 bailout:
 912         if (quiet == 0)
 913                 progress_complete(&progress, size - img_size);
 914         cam_freeccb(ccb);
 915         return (retval);
 916 }
 917
 918 int
 919 fwdownload(struct cam_device *device, int argc, char **argv,
 920     char *combinedopt, int printerrors, int task_attr, int retry_count,
 921     int timeout)
 922 {
 923         union ccb *ccb = NULL;
 924         struct fw_vendor *vp;
 925         char *fw_img_path = NULL;
 926         struct ata_params *ident_buf = NULL;
 927         camcontrol_devtype devtype;
 928         char *buf = NULL;
 929         int img_size;
 930         int c;
 931         int sim_mode = 0;
 932         int confirmed = 0;
 933         int quiet = 0;
 934         int retval = 0;
 935
 936         while ((c = getopt(argc, argv, combinedopt)) != -1) {
 937                 switch (c) {
 938                 case 'f':
 939                         fw_img_path = optarg;
 940                         break;
 941                 case 'q':
 942                         quiet = 1;
 943                         break;
 944                 case 's':
 945                         sim_mode = 1;
 946                         break;
 947                 case 'y':
 948                         confirmed = 1;
 949                         break;
 950                 default:
 951                         break;
 952                 }
 953         }
 954
 955         if (fw_img_path == NULL)
 956                 errx(1, "you must specify a firmware image file using -f "
 957                      "option");
 958
 959         retval = get_device_type(device, retry_count, timeout, printerrors,
 960                                  &devtype);
 961         if (retval != 0)
 962                 errx(1, "Unable to determine device type");
 963
 964         if ((devtype == CC_DT_ATA)
 965          || (devtype == CC_DT_SATL)) {
 966                 ccb = cam_getccb(device);
 967                 if (ccb == NULL) {
 968                         warnx("couldn't allocate CCB");
 969                         retval = 1;
 970                         goto bailout;
 971                 }
 972
 973                 if (ata_do_identify(device, retry_count, timeout, ccb,
 974                                     &ident_buf) != 0) {
 975                         retval = 1;
 976                         goto bailout;
 977                 }
 978         } else if (devtype != CC_DT_SCSI)
 979                 errx(1, "Unsupported device type %d", devtype);
 980
 981         vp = fw_get_vendor(device, ident_buf);
 982         /*
 983          * Bail out if we have an unknown vendor and this isn't an ATA
 984          * disk.  For a SCSI disk, we have no chance of working properly
 985          * with the default values in the VENDOR_UNKNOWN case.  For an ATA
 986          * disk connected via an ATA transport, we may work for drives that
 987          * support the ATA_DOWNLOAD_MICROCODE command.
 988          */
 989         if (((vp == NULL)
 990           || (vp->type == VENDOR_UNKNOWN))
 991          && (devtype == CC_DT_SCSI))
 992                 errx(1, "Unsupported device");
 993
 994         retval = fw_get_timeout(device, vp, task_attr, retry_count, timeout);
 995         if (retval != 0) {
 996                 warnx("Unable to get a firmware download timeout value");
 997                 goto bailout;
 998         }
 999
1000         buf = fw_read_img(device, retry_count, timeout, quiet, fw_img_path,
1001             vp, &img_size);
1002         if (buf == NULL) {
1003                 retval = 1;
1004                 goto bailout;
1005         }
1006
1007         if (!confirmed) {
1008                 fprintf(stdout, "You are about to download firmware image (%s)"
1009                     " into the following device:\n",
1010                     fw_img_path);
1011                 if (devtype == CC_DT_SCSI) {
1012                         if (scsidoinquiry(device, argc, argv, combinedopt,
1013                                           MSG_SIMPLE_Q_TAG, 0, 5000) != 0) {
1014                                 warnx("Error sending inquiry");
1015                                 retval = 1;
1016                                 goto bailout;
1017                         }
1018                 } else {
1019                         printf("%s%d: ", device->device_name,
1020                             device->dev_unit_num);
1021                         ata_print_ident(ident_buf);
1022                         camxferrate(device);
1023                         free(ident_buf);
1024                 }
1025                 fprintf(stdout, "Using a timeout of %u ms, which is %s.\n",
1026                         vp->timeout_ms,
1027                         fw_timeout_desc_table[vp->timeout_type].timeout_desc);
1028                 fprintf(stdout, "\nIt may damage your drive. ");
1029                 if (!get_confirmation()) {
1030                         retval = 1;
1031                         goto bailout;
1032                 }
1033         }
1034         if ((sim_mode != 0) && (quiet == 0))
1035                 fprintf(stdout, "Running in simulation mode\n");
1036
1037         if (fw_download_img(device, vp, buf, img_size, sim_mode, printerrors,
1038             quiet, retry_count, vp->timeout_ms, fw_img_path, devtype) != 0) {
1039                 fprintf(stderr, "Firmware download failed\n");
1040                 retval = 1;
1041                 goto bailout;
1042         } else if (quiet == 0)
1043                 fprintf(stdout, "Firmware download successful\n");
1044
1045 bailout:
1046         cam_freeccb(ccb);
1047         free(buf);
1048         return (retval);
1049 }
1050