drivers/net/sfc/base/siena_nvram.c

   1 /*
   2  * Copyright (c) 2009-2016 Solarflare Communications Inc.
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions are met:
   7  *
   8  * 1. Redistributions of source code must retain the above copyright notice,
   9  *    this list of conditions and the following disclaimer.
  10  * 2. Redistributions in binary form must reproduce the above copyright notice,
  11  *    this list of conditions and the following disclaimer in the documentation
  12  *    and/or other materials provided with the distribution.
  13  *
  14  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  15  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
  16  * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
  17  * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
  18  * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
  19  * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
  20  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
  21  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  22  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
  23  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
  24  * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  *
  26  * The views and conclusions contained in the software and documentation are
  27  * those of the authors and should not be interpreted as representing official
  28  * policies, either expressed or implied, of the FreeBSD Project.
  29  */
  30
  31 #include "efx.h"
  32 #include "efx_impl.h"
  33
  34 #if EFSYS_OPT_SIENA
  35
  36 #if EFSYS_OPT_VPD || EFSYS_OPT_NVRAM
  37
  38         __checkReturn           efx_rc_t
  39 siena_nvram_partn_size(
  40         __in                    efx_nic_t *enp,
  41         __in                    uint32_t partn,
  42         __out                   size_t *sizep)
  43 {
  44         efx_rc_t rc;
  45
  46         if ((1 << partn) & ~enp->en_u.siena.enu_partn_mask) {
  47                 rc = ENOTSUP;
  48                 goto fail1;
  49         }
  50
  51         if ((rc = efx_mcdi_nvram_info(enp, partn, sizep,
  52             NULL, NULL, NULL)) != 0) {
  53                 goto fail2;
  54         }
  55
  56         return (0);
  57
  58 fail2:
  59         EFSYS_PROBE(fail2);
  60 fail1:
  61         EFSYS_PROBE1(fail1, efx_rc_t, rc);
  62
  63         return (rc);
  64 }
  65
  66         __checkReturn           efx_rc_t
  67 siena_nvram_partn_lock(
  68         __in                    efx_nic_t *enp,
  69         __in                    uint32_t partn)
  70 {
  71         efx_rc_t rc;
  72
  73         if ((rc = efx_mcdi_nvram_update_start(enp, partn)) != 0) {
  74                 goto fail1;
  75         }
  76
  77         return (0);
  78
  79 fail1:
  80         EFSYS_PROBE1(fail1, efx_rc_t, rc);
  81
  82         return (rc);
  83 }
  84
  85         __checkReturn           efx_rc_t
  86 siena_nvram_partn_read(
  87         __in                    efx_nic_t *enp,
  88         __in                    uint32_t partn,
  89         __in                    unsigned int offset,
  90         __out_bcount(size)      caddr_t data,
  91         __in                    size_t size)
  92 {
  93         size_t chunk;
  94         efx_rc_t rc;
  95
  96         while (size > 0) {
  97                 chunk = MIN(size, SIENA_NVRAM_CHUNK);
  98
  99                 if ((rc = efx_mcdi_nvram_read(enp, partn, offset, data, chunk,
 100                             MC_CMD_NVRAM_READ_IN_V2_DEFAULT)) != 0) {
 101                         goto fail1;
 102                 }
 103
 104                 size -= chunk;
 105                 data += chunk;
 106                 offset += chunk;
 107         }
 108
 109         return (0);
 110
 111 fail1:
 112         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 113
 114         return (rc);
 115 }
 116
 117         __checkReturn           efx_rc_t
 118 siena_nvram_partn_erase(
 119         __in                    efx_nic_t *enp,
 120         __in                    uint32_t partn,
 121         __in                    unsigned int offset,
 122         __in                    size_t size)
 123 {
 124         efx_rc_t rc;
 125
 126         if ((rc = efx_mcdi_nvram_erase(enp, partn, offset, size)) != 0) {
 127                 goto fail1;
 128         }
 129
 130         return (0);
 131
 132 fail1:
 133         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 134
 135         return (rc);
 136 }
 137
 138         __checkReturn           efx_rc_t
 139 siena_nvram_partn_write(
 140         __in                    efx_nic_t *enp,
 141         __in                    uint32_t partn,
 142         __in                    unsigned int offset,
 143         __out_bcount(size)      caddr_t data,
 144         __in                    size_t size)
 145 {
 146         size_t chunk;
 147         efx_rc_t rc;
 148
 149         while (size > 0) {
 150                 chunk = MIN(size, SIENA_NVRAM_CHUNK);
 151
 152                 if ((rc = efx_mcdi_nvram_write(enp, partn, offset,
 153                             data, chunk)) != 0) {
 154                         goto fail1;
 155                 }
 156
 157                 size -= chunk;
 158                 data += chunk;
 159                 offset += chunk;
 160         }
 161
 162         return (0);
 163
 164 fail1:
 165         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 166
 167         return (rc);
 168 }
 169
 170         __checkReturn           efx_rc_t
 171 siena_nvram_partn_unlock(
 172         __in                    efx_nic_t *enp,
 173         __in                    uint32_t partn)
 174 {
 175         boolean_t reboot;
 176         efx_rc_t rc;
 177
 178         /*
 179          * Reboot into the new image only for PHYs. The driver has to
 180          * explicitly cope with an MC reboot after a firmware update.
 181          */
 182         reboot = (partn == MC_CMD_NVRAM_TYPE_PHY_PORT0 ||
 183                     partn == MC_CMD_NVRAM_TYPE_PHY_PORT1 ||
 184                     partn == MC_CMD_NVRAM_TYPE_DISABLED_CALLISTO);
 185
 186         rc = efx_mcdi_nvram_update_finish(enp, partn, reboot, NULL);
 187         if (rc != 0)
 188                 goto fail1;
 189
 190         return (0);
 191
 192 fail1:
 193         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 194
 195         return (rc);
 196 }
 197
 198 #endif  /* EFSYS_OPT_VPD || EFSYS_OPT_NVRAM */
 199
 200 #if EFSYS_OPT_NVRAM
 201
 202 typedef struct siena_parttbl_entry_s {
 203         unsigned int            partn;
 204         unsigned int            port;
 205         efx_nvram_type_t        nvtype;
 206 } siena_parttbl_entry_t;
 207
 208 static siena_parttbl_entry_t siena_parttbl[] = {
 209         {MC_CMD_NVRAM_TYPE_DISABLED_CALLISTO,   1, EFX_NVRAM_NULLPHY},
 210         {MC_CMD_NVRAM_TYPE_DISABLED_CALLISTO,   2, EFX_NVRAM_NULLPHY},
 211         {MC_CMD_NVRAM_TYPE_MC_FW,               1, EFX_NVRAM_MC_FIRMWARE},
 212         {MC_CMD_NVRAM_TYPE_MC_FW,               2, EFX_NVRAM_MC_FIRMWARE},
 213         {MC_CMD_NVRAM_TYPE_MC_FW_BACKUP,        1, EFX_NVRAM_MC_GOLDEN},
 214         {MC_CMD_NVRAM_TYPE_MC_FW_BACKUP,        2, EFX_NVRAM_MC_GOLDEN},
 215         {MC_CMD_NVRAM_TYPE_EXP_ROM,             1, EFX_NVRAM_BOOTROM},
 216         {MC_CMD_NVRAM_TYPE_EXP_ROM,             2, EFX_NVRAM_BOOTROM},
 217         {MC_CMD_NVRAM_TYPE_EXP_ROM_CFG_PORT0,   1, EFX_NVRAM_BOOTROM_CFG},
 218         {MC_CMD_NVRAM_TYPE_EXP_ROM_CFG_PORT1,   2, EFX_NVRAM_BOOTROM_CFG},
 219         {MC_CMD_NVRAM_TYPE_PHY_PORT0,           1, EFX_NVRAM_PHY},
 220         {MC_CMD_NVRAM_TYPE_PHY_PORT1,           2, EFX_NVRAM_PHY},
 221         {MC_CMD_NVRAM_TYPE_FPGA,                1, EFX_NVRAM_FPGA},
 222         {MC_CMD_NVRAM_TYPE_FPGA,                2, EFX_NVRAM_FPGA},
 223         {MC_CMD_NVRAM_TYPE_FPGA_BACKUP,         1, EFX_NVRAM_FPGA_BACKUP},
 224         {MC_CMD_NVRAM_TYPE_FPGA_BACKUP,         2, EFX_NVRAM_FPGA_BACKUP},
 225         {MC_CMD_NVRAM_TYPE_FC_FW,               1, EFX_NVRAM_FCFW},
 226         {MC_CMD_NVRAM_TYPE_FC_FW,               2, EFX_NVRAM_FCFW},
 227         {MC_CMD_NVRAM_TYPE_CPLD,                1, EFX_NVRAM_CPLD},
 228         {MC_CMD_NVRAM_TYPE_CPLD,                2, EFX_NVRAM_CPLD},
 229         {MC_CMD_NVRAM_TYPE_LICENSE,             1, EFX_NVRAM_LICENSE},
 230         {MC_CMD_NVRAM_TYPE_LICENSE,             2, EFX_NVRAM_LICENSE}
 231 };
 232
 233         __checkReturn           efx_rc_t
 234 siena_nvram_type_to_partn(
 235         __in                    efx_nic_t *enp,
 236         __in                    efx_nvram_type_t type,
 237         __out                   uint32_t *partnp)
 238 {
 239         efx_mcdi_iface_t *emip = &(enp->en_mcdi.em_emip);
 240         unsigned int i;
 241
 242         EFSYS_ASSERT3U(type, <, EFX_NVRAM_NTYPES);
 243         EFSYS_ASSERT(partnp != NULL);
 244
 245         for (i = 0; i < EFX_ARRAY_SIZE(siena_parttbl); i++) {
 246                 siena_parttbl_entry_t *entry = &siena_parttbl[i];
 247
 248                 if (entry->port == emip->emi_port && entry->nvtype == type) {
 249                         *partnp = entry->partn;
 250                         return (0);
 251                 }
 252         }
 253
 254         return (ENOTSUP);
 255 }
 256
 257
 258 #if EFSYS_OPT_DIAG
 259
 260         __checkReturn           efx_rc_t
 261 siena_nvram_test(
 262         __in                    efx_nic_t *enp)
 263 {
 264         efx_mcdi_iface_t *emip = &(enp->en_mcdi.em_emip);
 265         siena_parttbl_entry_t *entry;
 266         unsigned int i;
 267         efx_rc_t rc;
 268
 269         /*
 270          * Iterate over the list of supported partition types
 271          * applicable to *this* port
 272          */
 273         for (i = 0; i < EFX_ARRAY_SIZE(siena_parttbl); i++) {
 274                 entry = &siena_parttbl[i];
 275
 276                 if (entry->port != emip->emi_port ||
 277                     !(enp->en_u.siena.enu_partn_mask & (1 << entry->partn)))
 278                         continue;
 279
 280                 if ((rc = efx_mcdi_nvram_test(enp, entry->partn)) != 0) {
 281                         goto fail1;
 282                 }
 283         }
 284
 285         return (0);
 286
 287 fail1:
 288         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 289
 290         return (rc);
 291 }
 292
 293 #endif  /* EFSYS_OPT_DIAG */
 294
 295
 296 #define SIENA_DYNAMIC_CFG_SIZE(_nitems)                                 \
 297         (sizeof (siena_mc_dynamic_config_hdr_t) + ((_nitems) *          \
 298         sizeof (((siena_mc_dynamic_config_hdr_t *)NULL)->fw_version[0])))
 299
 300         __checkReturn           efx_rc_t
 301 siena_nvram_get_dynamic_cfg(
 302         __in                    efx_nic_t *enp,
 303         __in                    uint32_t partn,
 304         __in                    boolean_t vpd,
 305         __out                   siena_mc_dynamic_config_hdr_t **dcfgp,
 306         __out                   size_t *sizep)
 307 {
 308         siena_mc_dynamic_config_hdr_t *dcfg = NULL;
 309         size_t size;
 310         uint8_t cksum;
 311         unsigned int vpd_offset;
 312         unsigned int vpd_length;
 313         unsigned int hdr_length;
 314         unsigned int nversions;
 315         unsigned int pos;
 316         unsigned int region;
 317         efx_rc_t rc;
 318
 319         EFSYS_ASSERT(partn == MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT0 ||
 320                     partn == MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT1);
 321
 322         /*
 323          * Allocate sufficient memory for the entire dynamiccfg area, even
 324          * if we're not actually going to read in the VPD.
 325          */
 326         if ((rc = siena_nvram_partn_size(enp, partn, &size)) != 0)
 327                 goto fail1;
 328
 329         EFSYS_KMEM_ALLOC(enp->en_esip, size, dcfg);
 330         if (dcfg == NULL) {
 331                 rc = ENOMEM;
 332                 goto fail2;
 333         }
 334
 335         if ((rc = siena_nvram_partn_read(enp, partn, 0,
 336             (caddr_t)dcfg, SIENA_NVRAM_CHUNK)) != 0)
 337                 goto fail3;
 338
 339         /* Verify the magic */
 340         if (EFX_DWORD_FIELD(dcfg->magic, EFX_DWORD_0)
 341             != SIENA_MC_DYNAMIC_CONFIG_MAGIC)
 342                 goto invalid1;
 343
 344         /* All future versions of the structure must be backwards compatible */
 345         EFX_STATIC_ASSERT(SIENA_MC_DYNAMIC_CONFIG_VERSION == 0);
 346
 347         hdr_length = EFX_WORD_FIELD(dcfg->length, EFX_WORD_0);
 348         nversions = EFX_DWORD_FIELD(dcfg->num_fw_version_items, EFX_DWORD_0);
 349         vpd_offset = EFX_DWORD_FIELD(dcfg->dynamic_vpd_offset, EFX_DWORD_0);
 350         vpd_length = EFX_DWORD_FIELD(dcfg->dynamic_vpd_length, EFX_DWORD_0);
 351
 352         /* Verify the hdr doesn't overflow the partn size */
 353         if (hdr_length > size || vpd_offset > size || vpd_length > size ||
 354             vpd_length + vpd_offset > size)
 355                 goto invalid2;
 356
 357         /* Verify the header has room for all it's versions */
 358         if (hdr_length < SIENA_DYNAMIC_CFG_SIZE(0) ||
 359             hdr_length < SIENA_DYNAMIC_CFG_SIZE(nversions))
 360                 goto invalid3;
 361
 362         /*
 363          * Read the remaining portion of the dcfg, either including
 364          * the whole of VPD (there is no vpd length in this structure,
 365          * so we have to parse each tag), or just the dcfg header itself
 366          */
 367         region = vpd ? vpd_offset + vpd_length : hdr_length;
 368         if (region > SIENA_NVRAM_CHUNK) {
 369                 if ((rc = siena_nvram_partn_read(enp, partn, SIENA_NVRAM_CHUNK,
 370                     (caddr_t)dcfg + SIENA_NVRAM_CHUNK,
 371                     region - SIENA_NVRAM_CHUNK)) != 0)
 372                         goto fail4;
 373         }
 374
 375         /* Verify checksum */
 376         cksum = 0;
 377         for (pos = 0; pos < hdr_length; pos++)
 378                 cksum += ((uint8_t *)dcfg)[pos];
 379         if (cksum != 0)
 380                 goto invalid4;
 381
 382         goto done;
 383
 384 invalid4:
 385         EFSYS_PROBE(invalid4);
 386 invalid3:
 387         EFSYS_PROBE(invalid3);
 388 invalid2:
 389         EFSYS_PROBE(invalid2);
 390 invalid1:
 391         EFSYS_PROBE(invalid1);
 392
 393         /*
 394          * Construct a new "null" dcfg, with an empty version vector,
 395          * and an empty VPD chunk trailing. This has the neat side effect
 396          * of testing the exception paths in the write path.
 397          */
 398         EFX_POPULATE_DWORD_1(dcfg->magic,
 399                             EFX_DWORD_0, SIENA_MC_DYNAMIC_CONFIG_MAGIC);
 400         EFX_POPULATE_WORD_1(dcfg->length, EFX_WORD_0, sizeof (*dcfg));
 401         EFX_POPULATE_BYTE_1(dcfg->version, EFX_BYTE_0,
 402                             SIENA_MC_DYNAMIC_CONFIG_VERSION);
 403         EFX_POPULATE_DWORD_1(dcfg->dynamic_vpd_offset,
 404                             EFX_DWORD_0, sizeof (*dcfg));
 405         EFX_POPULATE_DWORD_1(dcfg->dynamic_vpd_length, EFX_DWORD_0, 0);
 406         EFX_POPULATE_DWORD_1(dcfg->num_fw_version_items, EFX_DWORD_0, 0);
 407
 408 done:
 409         *dcfgp = dcfg;
 410         *sizep = size;
 411
 412         return (0);
 413
 414 fail4:
 415         EFSYS_PROBE(fail4);
 416 fail3:
 417         EFSYS_PROBE(fail3);
 418
 419         EFSYS_KMEM_FREE(enp->en_esip, size, dcfg);
 420
 421 fail2:
 422         EFSYS_PROBE(fail2);
 423 fail1:
 424         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 425
 426         return (rc);
 427 }
 428
 429         __checkReturn           efx_rc_t
 430 siena_nvram_get_subtype(
 431         __in                    efx_nic_t *enp,
 432         __in                    uint32_t partn,
 433         __out                   uint32_t *subtypep)
 434 {
 435         efx_mcdi_req_t req;
 436         uint8_t payload[MAX(MC_CMD_GET_BOARD_CFG_IN_LEN,
 437                             MC_CMD_GET_BOARD_CFG_OUT_LENMAX)];
 438         efx_word_t *fw_list;
 439         efx_rc_t rc;
 440
 441         (void) memset(payload, 0, sizeof (payload));
 442         req.emr_cmd = MC_CMD_GET_BOARD_CFG;
 443         req.emr_in_buf = payload;
 444         req.emr_in_length = MC_CMD_GET_BOARD_CFG_IN_LEN;
 445         req.emr_out_buf = payload;
 446         req.emr_out_length = MC_CMD_GET_BOARD_CFG_OUT_LENMAX;
 447
 448         efx_mcdi_execute(enp, &req);
 449
 450         if (req.emr_rc != 0) {
 451                 rc = req.emr_rc;
 452                 goto fail1;
 453         }
 454
 455         if (req.emr_out_length_used < MC_CMD_GET_BOARD_CFG_OUT_LENMIN) {
 456                 rc = EMSGSIZE;
 457                 goto fail2;
 458         }
 459
 460         if (req.emr_out_length_used <
 461             MC_CMD_GET_BOARD_CFG_OUT_FW_SUBTYPE_LIST_OFST +
 462             (partn + 1) * sizeof (efx_word_t)) {
 463                 rc = ENOENT;
 464                 goto fail3;
 465         }
 466
 467         fw_list = MCDI_OUT2(req, efx_word_t,
 468                             GET_BOARD_CFG_OUT_FW_SUBTYPE_LIST);
 469         *subtypep = EFX_WORD_FIELD(fw_list[partn], EFX_WORD_0);
 470
 471         return (0);
 472
 473 fail3:
 474         EFSYS_PROBE(fail3);
 475 fail2:
 476         EFSYS_PROBE(fail2);
 477 fail1:
 478         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 479
 480         return (rc);
 481 }
 482
 483         __checkReturn           efx_rc_t
 484 siena_nvram_partn_get_version(
 485         __in                    efx_nic_t *enp,
 486         __in                    uint32_t partn,
 487         __out                   uint32_t *subtypep,
 488         __out_ecount(4)         uint16_t version[4])
 489 {
 490         siena_mc_dynamic_config_hdr_t *dcfg;
 491         siena_parttbl_entry_t *entry;
 492         uint32_t dcfg_partn;
 493         unsigned int i;
 494         efx_rc_t rc;
 495
 496         if ((1 << partn) & ~enp->en_u.siena.enu_partn_mask) {
 497                 rc = ENOTSUP;
 498                 goto fail1;
 499         }
 500
 501         if ((rc = siena_nvram_get_subtype(enp, partn, subtypep)) != 0)
 502                 goto fail2;
 503
 504         /*
 505          * Some partitions are accessible from both ports (for instance BOOTROM)
 506          * Find the highest version reported by all dcfg structures on ports
 507          * that have access to this partition.
 508          */
 509         version[0] = version[1] = version[2] = version[3] = 0;
 510         for (i = 0; i < EFX_ARRAY_SIZE(siena_parttbl); i++) {
 511                 siena_mc_fw_version_t *verp;
 512                 unsigned int nitems;
 513                 uint16_t temp[4];
 514                 size_t length;
 515
 516                 entry = &siena_parttbl[i];
 517                 if (entry->partn != partn)
 518                         continue;
 519
 520                 dcfg_partn = (entry->port == 1)
 521                         ? MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT0
 522                         : MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT1;
 523                 /*
 524                  * Ingore missing partitions on port 2, assuming they're due
 525                  * to to running on a single port part.
 526                  */
 527                 if ((1 << dcfg_partn) &  ~enp->en_u.siena.enu_partn_mask) {
 528                         if (entry->port == 2)
 529                                 continue;
 530                 }
 531
 532                 if ((rc = siena_nvram_get_dynamic_cfg(enp, dcfg_partn,
 533                     B_FALSE, &dcfg, &length)) != 0)
 534                         goto fail3;
 535
 536                 nitems = EFX_DWORD_FIELD(dcfg->num_fw_version_items,
 537                             EFX_DWORD_0);
 538                 if (nitems < entry->partn)
 539                         goto done;
 540
 541                 verp = &dcfg->fw_version[partn];
 542                 temp[0] = EFX_WORD_FIELD(verp->version_w, EFX_WORD_0);
 543                 temp[1] = EFX_WORD_FIELD(verp->version_x, EFX_WORD_0);
 544                 temp[2] = EFX_WORD_FIELD(verp->version_y, EFX_WORD_0);
 545                 temp[3] = EFX_WORD_FIELD(verp->version_z, EFX_WORD_0);
 546                 if (memcmp(version, temp, sizeof (temp)) < 0)
 547                         memcpy(version, temp, sizeof (temp));
 548
 549 done:
 550                 EFSYS_KMEM_FREE(enp->en_esip, length, dcfg);
 551         }
 552
 553         return (0);
 554
 555 fail3:
 556         EFSYS_PROBE(fail3);
 557 fail2:
 558         EFSYS_PROBE(fail2);
 559 fail1:
 560         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 561
 562         return (rc);
 563 }
 564
 565         __checkReturn           efx_rc_t
 566 siena_nvram_partn_rw_start(
 567         __in                    efx_nic_t *enp,
 568         __in                    uint32_t partn,
 569         __out                   size_t *chunk_sizep)
 570 {
 571         efx_rc_t rc;
 572
 573         if ((rc = siena_nvram_partn_lock(enp, partn)) != 0)
 574                 goto fail1;
 575
 576         if (chunk_sizep != NULL)
 577                 *chunk_sizep = SIENA_NVRAM_CHUNK;
 578
 579         return (0);
 580
 581 fail1:
 582         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 583
 584         return (rc);
 585 }
 586
 587         __checkReturn           efx_rc_t
 588 siena_nvram_partn_rw_finish(
 589         __in                    efx_nic_t *enp,
 590         __in                    uint32_t partn)
 591 {
 592         efx_rc_t rc;
 593
 594         if ((rc = siena_nvram_partn_unlock(enp, partn)) != 0)
 595                 goto fail1;
 596
 597         return (0);
 598
 599 fail1:
 600         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 601
 602         return (rc);
 603 }
 604
 605         __checkReturn           efx_rc_t
 606 siena_nvram_partn_set_version(
 607         __in                    efx_nic_t *enp,
 608         __in                    uint32_t partn,
 609         __in_ecount(4)          uint16_t version[4])
 610 {
 611         efx_mcdi_iface_t *emip = &(enp->en_mcdi.em_emip);
 612         siena_mc_dynamic_config_hdr_t *dcfg = NULL;
 613         siena_mc_fw_version_t *fwverp;
 614         uint32_t dcfg_partn;
 615         size_t dcfg_size;
 616         unsigned int hdr_length;
 617         unsigned int vpd_length;
 618         unsigned int vpd_offset;
 619         unsigned int nitems;
 620         unsigned int required_hdr_length;
 621         unsigned int pos;
 622         uint8_t cksum;
 623         uint32_t subtype;
 624         size_t length;
 625         efx_rc_t rc;
 626
 627         dcfg_partn = (emip->emi_port == 1)
 628                 ? MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT0
 629                 : MC_CMD_NVRAM_TYPE_DYNAMIC_CFG_PORT1;
 630
 631         if ((rc = siena_nvram_partn_size(enp, dcfg_partn, &dcfg_size)) != 0)
 632                 goto fail1;
 633
 634         if ((rc = siena_nvram_partn_lock(enp, dcfg_partn)) != 0)
 635                 goto fail2;
 636
 637         if ((rc = siena_nvram_get_dynamic_cfg(enp, dcfg_partn,
 638             B_TRUE, &dcfg, &length)) != 0)
 639                 goto fail3;
 640
 641         hdr_length = EFX_WORD_FIELD(dcfg->length, EFX_WORD_0);
 642         nitems = EFX_DWORD_FIELD(dcfg->num_fw_version_items, EFX_DWORD_0);
 643         vpd_length = EFX_DWORD_FIELD(dcfg->dynamic_vpd_length, EFX_DWORD_0);
 644         vpd_offset = EFX_DWORD_FIELD(dcfg->dynamic_vpd_offset, EFX_DWORD_0);
 645
 646         /*
 647          * NOTE: This function will blatt any fields trailing the version
 648          * vector, or the VPD chunk.
 649          */
 650         required_hdr_length = SIENA_DYNAMIC_CFG_SIZE(partn + 1);
 651         if (required_hdr_length + vpd_length > length) {
 652                 rc = ENOSPC;
 653                 goto fail4;
 654         }
 655
 656         if (vpd_offset < required_hdr_length) {
 657                 (void) memmove((caddr_t)dcfg + required_hdr_length,
 658                         (caddr_t)dcfg + vpd_offset, vpd_length);
 659                 vpd_offset = required_hdr_length;
 660                 EFX_POPULATE_DWORD_1(dcfg->dynamic_vpd_offset,
 661                                     EFX_DWORD_0, vpd_offset);
 662         }
 663
 664         if (hdr_length < required_hdr_length) {
 665                 (void) memset((caddr_t)dcfg + hdr_length, 0,
 666                         required_hdr_length - hdr_length);
 667                 hdr_length = required_hdr_length;
 668                 EFX_POPULATE_WORD_1(dcfg->length,
 669                                     EFX_WORD_0, hdr_length);
 670         }
 671
 672         /* Get the subtype to insert into the fw_subtype array */
 673         if ((rc = siena_nvram_get_subtype(enp, partn, &subtype)) != 0)
 674                 goto fail5;
 675
 676         /* Fill out the new version */
 677         fwverp = &dcfg->fw_version[partn];
 678         EFX_POPULATE_DWORD_1(fwverp->fw_subtype, EFX_DWORD_0, subtype);
 679         EFX_POPULATE_WORD_1(fwverp->version_w, EFX_WORD_0, version[0]);
 680         EFX_POPULATE_WORD_1(fwverp->version_x, EFX_WORD_0, version[1]);
 681         EFX_POPULATE_WORD_1(fwverp->version_y, EFX_WORD_0, version[2]);
 682         EFX_POPULATE_WORD_1(fwverp->version_z, EFX_WORD_0, version[3]);
 683
 684         /* Update the version count */
 685         if (nitems < partn + 1) {
 686                 nitems = partn + 1;
 687                 EFX_POPULATE_DWORD_1(dcfg->num_fw_version_items,
 688                                     EFX_DWORD_0, nitems);
 689         }
 690
 691         /* Update the checksum */
 692         cksum = 0;
 693         for (pos = 0; pos < hdr_length; pos++)
 694                 cksum += ((uint8_t *)dcfg)[pos];
 695         dcfg->csum.eb_u8[0] -= cksum;
 696
 697         /* Erase and write the new partition */
 698         if ((rc = siena_nvram_partn_erase(enp, dcfg_partn, 0, dcfg_size)) != 0)
 699                 goto fail6;
 700
 701         /* Write out the new structure to nvram */
 702         if ((rc = siena_nvram_partn_write(enp, dcfg_partn, 0,
 703             (caddr_t)dcfg, vpd_offset + vpd_length)) != 0)
 704                 goto fail7;
 705
 706         EFSYS_KMEM_FREE(enp->en_esip, length, dcfg);
 707
 708         siena_nvram_partn_unlock(enp, dcfg_partn);
 709
 710         return (0);
 711
 712 fail7:
 713         EFSYS_PROBE(fail7);
 714 fail6:
 715         EFSYS_PROBE(fail6);
 716 fail5:
 717         EFSYS_PROBE(fail5);
 718 fail4:
 719         EFSYS_PROBE(fail4);
 720
 721         EFSYS_KMEM_FREE(enp->en_esip, length, dcfg);
 722 fail3:
 723         EFSYS_PROBE(fail3);
 724 fail2:
 725         EFSYS_PROBE(fail2);
 726 fail1:
 727         EFSYS_PROBE1(fail1, efx_rc_t, rc);
 728
 729         return (rc);
 730 }
 731
 732 #endif  /* EFSYS_OPT_NVRAM */
 733
 734 #endif  /* EFSYS_OPT_SIENA */