drivers/net/ice/base/ice_nvm.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(c) 2001-2020 Intel Corporation
   3  */
   4
   5 #include "ice_common.h"
   6
   7 /**
   8  * ice_aq_read_nvm
   9  * @hw: pointer to the HW struct
  10  * @module_typeid: module pointer location in words from the NVM beginning
  11  * @offset: byte offset from the module beginning
  12  * @length: length of the section to be read (in bytes from the offset)
  13  * @data: command buffer (size [bytes] = length)
  14  * @last_command: tells if this is the last command in a series
  15  * @read_shadow_ram: tell if this is a shadow RAM read
  16  * @cd: pointer to command details structure or NULL
  17  *
  18  * Read the NVM using the admin queue commands (0x0701)
  19  */
  20 static enum ice_status
  21 ice_aq_read_nvm(struct ice_hw *hw, u16 module_typeid, u32 offset, u16 length,
  22                 void *data, bool last_command, bool read_shadow_ram,
  23                 struct ice_sq_cd *cd)
  24 {
  25         struct ice_aq_desc desc;
  26         struct ice_aqc_nvm *cmd;
  27
  28         ice_debug(hw, ICE_DBG_TRACE, "%s\n", __func__);
  29
  30         cmd = &desc.params.nvm;
  31
  32         if (offset > ICE_AQC_NVM_MAX_OFFSET)
  33                 return ICE_ERR_PARAM;
  34
  35         ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_nvm_read);
  36
  37         if (!read_shadow_ram && module_typeid == ICE_AQC_NVM_START_POINT)
  38                 cmd->cmd_flags |= ICE_AQC_NVM_FLASH_ONLY;
  39
  40         /* If this is the last command in a series, set the proper flag. */
  41         if (last_command)
  42                 cmd->cmd_flags |= ICE_AQC_NVM_LAST_CMD;
  43         cmd->module_typeid = CPU_TO_LE16(module_typeid);
  44         cmd->offset_low = CPU_TO_LE16(offset & 0xFFFF);
  45         cmd->offset_high = (offset >> 16) & 0xFF;
  46         cmd->length = CPU_TO_LE16(length);
  47
  48         return ice_aq_send_cmd(hw, &desc, data, length, cd);
  49 }
  50
  51 /**
  52  * ice_read_flat_nvm - Read portion of NVM by flat offset
  53  * @hw: pointer to the HW struct
  54  * @offset: offset from beginning of NVM
  55  * @length: (in) number of bytes to read; (out) number of bytes actually read
  56  * @data: buffer to return data in (sized to fit the specified length)
  57  * @read_shadow_ram: if true, read from shadow RAM instead of NVM
  58  *
  59  * Reads a portion of the NVM, as a flat memory space. This function correctly
  60  * breaks read requests across Shadow RAM sectors and ensures that no single
  61  * read request exceeds the maximum 4Kb read for a single AdminQ command.
  62  *
  63  * Returns a status code on failure. Note that the data pointer may be
  64  * partially updated if some reads succeed before a failure.
  65  */
  66 enum ice_status
  67 ice_read_flat_nvm(struct ice_hw *hw, u32 offset, u32 *length, u8 *data,
  68                   bool read_shadow_ram)
  69 {
  70         enum ice_status status;
  71         u32 inlen = *length;
  72         u32 bytes_read = 0;
  73         bool last_cmd;
  74
  75         ice_debug(hw, ICE_DBG_TRACE, "%s\n", __func__);
  76
  77         *length = 0;
  78
  79         /* Verify the length of the read if this is for the Shadow RAM */
  80         if (read_shadow_ram && ((offset + inlen) > (hw->nvm.sr_words * 2u))) {
  81                 ice_debug(hw, ICE_DBG_NVM,
  82                           "NVM error: requested data is beyond Shadow RAM limit\n");
  83                 return ICE_ERR_PARAM;
  84         }
  85
  86         do {
  87                 u32 read_size, sector_offset;
  88
  89                 /* ice_aq_read_nvm cannot read more than 4Kb at a time.
  90                  * Additionally, a read from the Shadow RAM may not cross over
  91                  * a sector boundary. Conveniently, the sector size is also
  92                  * 4Kb.
  93                  */
  94                 sector_offset = offset % ICE_AQ_MAX_BUF_LEN;
  95                 read_size = MIN_T(u32, ICE_AQ_MAX_BUF_LEN - sector_offset,
  96                                   inlen - bytes_read);
  97
  98                 last_cmd = !(bytes_read + read_size < inlen);
  99
 100                 /* ice_aq_read_nvm takes the length as a u16. Our read_size is
 101                  * calculated using a u32, but the ICE_AQ_MAX_BUF_LEN maximum
 102                  * size guarantees that it will fit within the 2 bytes.
 103                  */
 104                 status = ice_aq_read_nvm(hw, ICE_AQC_NVM_START_POINT,
 105                                          offset, (u16)read_size,
 106                                          data + bytes_read, last_cmd,
 107                                          read_shadow_ram, NULL);
 108                 if (status)
 109                         break;
 110
 111                 bytes_read += read_size;
 112                 offset += read_size;
 113         } while (!last_cmd);
 114
 115         *length = bytes_read;
 116         return status;
 117 }
 118
 119 /**
 120  * ice_read_sr_word_aq - Reads Shadow RAM via AQ
 121  * @hw: pointer to the HW structure
 122  * @offset: offset of the Shadow RAM word to read (0x000000 - 0x001FFF)
 123  * @data: word read from the Shadow RAM
 124  *
 125  * Reads one 16 bit word from the Shadow RAM using ice_read_flat_nvm.
 126  */
 127 static enum ice_status
 128 ice_read_sr_word_aq(struct ice_hw *hw, u16 offset, u16 *data)
 129 {
 130         u32 bytes = sizeof(u16);
 131         enum ice_status status;
 132         __le16 data_local;
 133
 134         ice_debug(hw, ICE_DBG_TRACE, "%s\n", __func__);
 135
 136         /* Note that ice_read_flat_nvm checks if the read is past the Shadow
 137          * RAM size, and ensures we don't read across a Shadow RAM sector
 138          * boundary
 139          */
 140         status = ice_read_flat_nvm(hw, offset * sizeof(u16), &bytes,
 141                                    (u8 *)&data_local, true);
 142         if (status)
 143                 return status;
 144
 145         *data = LE16_TO_CPU(data_local);
 146         return ICE_SUCCESS;
 147 }
 148
 149 /**
 150  * ice_read_sr_buf_aq - Reads Shadow RAM buf via AQ
 151  * @hw: pointer to the HW structure
 152  * @offset: offset of the Shadow RAM word to read (0x000000 - 0x001FFF)
 153  * @words: (in) number of words to read; (out) number of words actually read
 154  * @data: words read from the Shadow RAM
 155  *
 156  * Reads 16 bit words (data buf) from the Shadow RAM. Ownership of the NVM is
 157  * taken before reading the buffer and later released.
 158  */
 159 static enum ice_status
 160 ice_read_sr_buf_aq(struct ice_hw *hw, u16 offset, u16 *words, u16 *data)
 161 {
 162         u32 bytes = *words * 2, i;
 163         enum ice_status status;
 164
 165         ice_debug(hw, ICE_DBG_TRACE, "%s\n", __func__);
 166
 167         /* ice_read_flat_nvm takes into account the 4Kb AdminQ and Shadow RAM
 168          * sector restrictions necessary when reading from the NVM.
 169          */
 170         status = ice_read_flat_nvm(hw, offset * 2, &bytes, (u8 *)data, true);
 171
 172         /* Report the number of words successfully read */
 173         *words = bytes / 2;
 174
 175         /* Byte swap the words up to the amount we actually read */
 176         for (i = 0; i < *words; i++)
 177                 data[i] = LE16_TO_CPU(((_FORCE_ __le16 *)data)[i]);
 178
 179         return status;
 180 }
 181
 182 /**
 183  * ice_acquire_nvm - Generic request for acquiring the NVM ownership
 184  * @hw: pointer to the HW structure
 185  * @access: NVM access type (read or write)
 186  *
 187  * This function will request NVM ownership.
 188  */
 189 static enum ice_status
 190 ice_acquire_nvm(struct ice_hw *hw, enum ice_aq_res_access_type access)
 191 {
 192         ice_debug(hw, ICE_DBG_TRACE, "%s\n", __func__);
 193
 194         if (hw->nvm.blank_nvm_mode)
 195                 return ICE_SUCCESS;
 196
 197         return ice_acquire_res(hw, ICE_NVM_RES_ID, access, ICE_NVM_TIMEOUT);
 198 }
 199
 200 /**
 201  * ice_release_nvm - Generic request for releasing the NVM ownership
 202  * @hw: pointer to the HW structure
 203  *
 204  * This function will release NVM ownership.
 205  */
 206 static void ice_release_nvm(struct ice_hw *hw)
 207 {
 208         ice_debug(hw, ICE_DBG_TRACE, "%s\n", __func__);
 209
 210         if (hw->nvm.blank_nvm_mode)
 211                 return;
 212
 213         ice_release_res(hw, ICE_NVM_RES_ID);
 214 }
 215
 216 /**
 217  * ice_read_sr_word - Reads Shadow RAM word and acquire NVM if necessary
 218  * @hw: pointer to the HW structure
 219  * @offset: offset of the Shadow RAM word to read (0x000000 - 0x001FFF)
 220  * @data: word read from the Shadow RAM
 221  *
 222  * Reads one 16 bit word from the Shadow RAM using the ice_read_sr_word_aq.
 223  */
 224 enum ice_status ice_read_sr_word(struct ice_hw *hw, u16 offset, u16 *data)
 225 {
 226         enum ice_status status;
 227
 228         status = ice_acquire_nvm(hw, ICE_RES_READ);
 229         if (!status) {
 230                 status = ice_read_sr_word_aq(hw, offset, data);
 231                 ice_release_nvm(hw);
 232         }
 233
 234         return status;
 235 }
 236
 237 /**
 238  * ice_get_pfa_module_tlv - Reads sub module TLV from NVM PFA
 239  * @hw: pointer to hardware structure
 240  * @module_tlv: pointer to module TLV to return
 241  * @module_tlv_len: pointer to module TLV length to return
 242  * @module_type: module type requested
 243  *
 244  * Finds the requested sub module TLV type from the Preserved Field
 245  * Area (PFA) and returns the TLV pointer and length. The caller can
 246  * use these to read the variable length TLV value.
 247  */
 248 enum ice_status
 249 ice_get_pfa_module_tlv(struct ice_hw *hw, u16 *module_tlv, u16 *module_tlv_len,
 250                        u16 module_type)
 251 {
 252         enum ice_status status;
 253         u16 pfa_len, pfa_ptr;
 254         u16 next_tlv;
 255
 256         status = ice_read_sr_word(hw, ICE_SR_PFA_PTR, &pfa_ptr);
 257         if (status != ICE_SUCCESS) {
 258                 ice_debug(hw, ICE_DBG_INIT, "Preserved Field Array pointer.\n");
 259                 return status;
 260         }
 261         status = ice_read_sr_word(hw, pfa_ptr, &pfa_len);
 262         if (status != ICE_SUCCESS) {
 263                 ice_debug(hw, ICE_DBG_INIT, "Failed to read PFA length.\n");
 264                 return status;
 265         }
 266         /* Starting with first TLV after PFA length, iterate through the list
 267          * of TLVs to find the requested one.
 268          */
 269         next_tlv = pfa_ptr + 1;
 270         while (next_tlv < pfa_ptr + pfa_len) {
 271                 u16 tlv_sub_module_type;
 272                 u16 tlv_len;
 273
 274                 /* Read TLV type */
 275                 status = ice_read_sr_word(hw, next_tlv, &tlv_sub_module_type);
 276                 if (status != ICE_SUCCESS) {
 277                         ice_debug(hw, ICE_DBG_INIT, "Failed to read TLV type.\n");
 278                         break;
 279                 }
 280                 /* Read TLV length */
 281                 status = ice_read_sr_word(hw, next_tlv + 1, &tlv_len);
 282                 if (status != ICE_SUCCESS) {
 283                         ice_debug(hw, ICE_DBG_INIT, "Failed to read TLV length.\n");
 284                         break;
 285                 }
 286                 if (tlv_sub_module_type == module_type) {
 287                         if (tlv_len) {
 288                                 *module_tlv = next_tlv;
 289                                 *module_tlv_len = tlv_len;
 290                                 return ICE_SUCCESS;
 291                         }
 292                         return ICE_ERR_INVAL_SIZE;
 293                 }
 294                 /* Check next TLV, i.e. current TLV pointer + length + 2 words
 295                  * (for current TLV's type and length)
 296                  */
 297                 next_tlv = next_tlv + tlv_len + 2;
 298         }
 299         /* Module does not exist */
 300         return ICE_ERR_DOES_NOT_EXIST;
 301 }
 302
 303 /**
 304  * ice_get_orom_ver_info - Read Option ROM version information
 305  * @hw: pointer to the HW struct
 306  *
 307  * Read the Combo Image version data from the Boot Configuration TLV and fill
 308  * in the option ROM version data.
 309  */
 310 static enum ice_status ice_get_orom_ver_info(struct ice_hw *hw)
 311 {
 312         u16 combo_hi, combo_lo, boot_cfg_tlv, boot_cfg_tlv_len;
 313         struct ice_orom_info *orom = &hw->nvm.orom;
 314         enum ice_status status;
 315         u32 combo_ver;
 316
 317         status = ice_get_pfa_module_tlv(hw, &boot_cfg_tlv, &boot_cfg_tlv_len,
 318                                         ICE_SR_BOOT_CFG_PTR);
 319         if (status) {
 320                 ice_debug(hw, ICE_DBG_INIT,
 321                           "Failed to read Boot Configuration Block TLV.\n");
 322                 return status;
 323         }
 324
 325         /* Boot Configuration Block must have length at least 2 words
 326          * (Combo Image Version High and Combo Image Version Low)
 327          */
 328         if (boot_cfg_tlv_len < 2) {
 329                 ice_debug(hw, ICE_DBG_INIT,
 330                           "Invalid Boot Configuration Block TLV size.\n");
 331                 return ICE_ERR_INVAL_SIZE;
 332         }
 333
 334         status = ice_read_sr_word(hw, (boot_cfg_tlv + ICE_NVM_OROM_VER_OFF),
 335                                   &combo_hi);
 336         if (status) {
 337                 ice_debug(hw, ICE_DBG_INIT, "Failed to read OROM_VER hi.\n");
 338                 return status;
 339         }
 340
 341         status = ice_read_sr_word(hw, (boot_cfg_tlv + ICE_NVM_OROM_VER_OFF + 1),
 342                                   &combo_lo);
 343         if (status) {
 344                 ice_debug(hw, ICE_DBG_INIT, "Failed to read OROM_VER lo.\n");
 345                 return status;
 346         }
 347
 348         combo_ver = ((u32)combo_hi << 16) | combo_lo;
 349
 350         orom->major = (u8)((combo_ver & ICE_OROM_VER_MASK) >>
 351                            ICE_OROM_VER_SHIFT);
 352         orom->patch = (u8)(combo_ver & ICE_OROM_VER_PATCH_MASK);
 353         orom->build = (u16)((combo_ver & ICE_OROM_VER_BUILD_MASK) >>
 354                             ICE_OROM_VER_BUILD_SHIFT);
 355
 356         return ICE_SUCCESS;
 357 }
 358
 359 /**
 360  * ice_discover_flash_size - Discover the available flash size.
 361  * @hw: pointer to the HW struct
 362  *
 363  * The device flash could be up to 16MB in size. However, it is possible that
 364  * the actual size is smaller. Use bisection to determine the accessible size
 365  * of flash memory.
 366  */
 367 static enum ice_status ice_discover_flash_size(struct ice_hw *hw)
 368 {
 369         u32 min_size = 0, max_size = ICE_AQC_NVM_MAX_OFFSET + 1;
 370         enum ice_status status;
 371
 372         ice_debug(hw, ICE_DBG_TRACE, "%s\n", __func__);
 373
 374         status = ice_acquire_nvm(hw, ICE_RES_READ);
 375         if (status)
 376                 return status;
 377
 378         while ((max_size - min_size) > 1) {
 379                 u32 offset = (max_size + min_size) / 2;
 380                 u32 len = 1;
 381                 u8 data;
 382
 383                 status = ice_read_flat_nvm(hw, offset, &len, &data, false);
 384                 if (status == ICE_ERR_AQ_ERROR &&
 385                     hw->adminq.sq_last_status == ICE_AQ_RC_EINVAL) {
 386                         ice_debug(hw, ICE_DBG_NVM,
 387                                   "%s: New upper bound of %u bytes\n",
 388                                   __func__, offset);
 389                         status = ICE_SUCCESS;
 390                         max_size = offset;
 391                 } else if (!status) {
 392                         ice_debug(hw, ICE_DBG_NVM,
 393                                   "%s: New lower bound of %u bytes\n",
 394                                   __func__, offset);
 395                         min_size = offset;
 396                 } else {
 397                         /* an unexpected error occurred */
 398                         goto err_read_flat_nvm;
 399                 }
 400         }
 401
 402         ice_debug(hw, ICE_DBG_NVM,
 403                   "Predicted flash size is %u bytes\n", max_size);
 404
 405         hw->nvm.flash_size = max_size;
 406
 407 err_read_flat_nvm:
 408         ice_release_nvm(hw);
 409
 410         return status;
 411 }
 412
 413 /**
 414  * ice_init_nvm - initializes NVM setting
 415  * @hw: pointer to the HW struct
 416  *
 417  * This function reads and populates NVM settings such as Shadow RAM size,
 418  * max_timeout, and blank_nvm_mode
 419  */
 420 enum ice_status ice_init_nvm(struct ice_hw *hw)
 421 {
 422         struct ice_nvm_info *nvm = &hw->nvm;
 423         u16 eetrack_lo, eetrack_hi, ver;
 424         enum ice_status status;
 425         u32 fla, gens_stat;
 426         u8 sr_size;
 427
 428         ice_debug(hw, ICE_DBG_TRACE, "%s\n", __func__);
 429
 430         /* The SR size is stored regardless of the NVM programming mode
 431          * as the blank mode may be used in the factory line.
 432          */
 433         gens_stat = rd32(hw, GLNVM_GENS);
 434         sr_size = (gens_stat & GLNVM_GENS_SR_SIZE_M) >> GLNVM_GENS_SR_SIZE_S;
 435
 436         /* Switching to words (sr_size contains power of 2) */
 437         nvm->sr_words = BIT(sr_size) * ICE_SR_WORDS_IN_1KB;
 438
 439         /* Check if we are in the normal or blank NVM programming mode */
 440         fla = rd32(hw, GLNVM_FLA);
 441         if (fla & GLNVM_FLA_LOCKED_M) { /* Normal programming mode */
 442                 nvm->blank_nvm_mode = false;
 443         } else {
 444                 /* Blank programming mode */
 445                 nvm->blank_nvm_mode = true;
 446                 ice_debug(hw, ICE_DBG_NVM,
 447                           "NVM init error: unsupported blank mode.\n");
 448                 return ICE_ERR_NVM_BLANK_MODE;
 449         }
 450
 451         status = ice_read_sr_word(hw, ICE_SR_NVM_DEV_STARTER_VER, &ver);
 452         if (status) {
 453                 ice_debug(hw, ICE_DBG_INIT,
 454                           "Failed to read DEV starter version.\n");
 455                 return status;
 456         }
 457         nvm->major_ver = (ver & ICE_NVM_VER_HI_MASK) >> ICE_NVM_VER_HI_SHIFT;
 458         nvm->minor_ver = (ver & ICE_NVM_VER_LO_MASK) >> ICE_NVM_VER_LO_SHIFT;
 459
 460         status = ice_read_sr_word(hw, ICE_SR_NVM_EETRACK_LO, &eetrack_lo);
 461         if (status) {
 462                 ice_debug(hw, ICE_DBG_INIT, "Failed to read EETRACK lo.\n");
 463                 return status;
 464         }
 465         status = ice_read_sr_word(hw, ICE_SR_NVM_EETRACK_HI, &eetrack_hi);
 466         if (status) {
 467                 ice_debug(hw, ICE_DBG_INIT, "Failed to read EETRACK hi.\n");
 468                 return status;
 469         }
 470
 471         nvm->eetrack = (eetrack_hi << 16) | eetrack_lo;
 472
 473         status = ice_discover_flash_size(hw);
 474         if (status) {
 475                 ice_debug(hw, ICE_DBG_NVM,
 476                           "NVM init error: failed to discover flash size.\n");
 477                 return status;
 478         }
 479
 480         switch (hw->device_id) {
 481         /* the following devices do not have boot_cfg_tlv yet */
 482         case ICE_DEV_ID_E822C_BACKPLANE:
 483         case ICE_DEV_ID_E822C_QSFP:
 484         case ICE_DEV_ID_E822C_10G_BASE_T:
 485         case ICE_DEV_ID_E822C_SGMII:
 486         case ICE_DEV_ID_E822C_SFP:
 487         case ICE_DEV_ID_E822L_BACKPLANE:
 488         case ICE_DEV_ID_E822L_SFP:
 489         case ICE_DEV_ID_E822L_10G_BASE_T:
 490         case ICE_DEV_ID_E822L_SGMII:
 491                 return status;
 492         default:
 493                 break;
 494         }
 495
 496         status = ice_get_orom_ver_info(hw);
 497         if (status) {
 498                 ice_debug(hw, ICE_DBG_INIT, "Failed to read Option ROM info.\n");
 499                 return status;
 500         }
 501
 502         return ICE_SUCCESS;
 503 }
 504
 505 /**
 506  * ice_read_sr_buf - Reads Shadow RAM buf and acquire lock if necessary
 507  * @hw: pointer to the HW structure
 508  * @offset: offset of the Shadow RAM word to read (0x000000 - 0x001FFF)
 509  * @words: (in) number of words to read; (out) number of words actually read
 510  * @data: words read from the Shadow RAM
 511  *
 512  * Reads 16 bit words (data buf) from the SR using the ice_read_nvm_buf_aq
 513  * method. The buf read is preceded by the NVM ownership take
 514  * and followed by the release.
 515  */
 516 enum ice_status
 517 ice_read_sr_buf(struct ice_hw *hw, u16 offset, u16 *words, u16 *data)
 518 {
 519         enum ice_status status;
 520
 521         status = ice_acquire_nvm(hw, ICE_RES_READ);
 522         if (!status) {
 523                 status = ice_read_sr_buf_aq(hw, offset, words, data);
 524                 ice_release_nvm(hw);
 525         }
 526
 527         return status;
 528 }
 529
 530 /**
 531  * ice_nvm_validate_checksum
 532  * @hw: pointer to the HW struct
 533  *
 534  * Verify NVM PFA checksum validity (0x0706)
 535  */
 536 enum ice_status ice_nvm_validate_checksum(struct ice_hw *hw)
 537 {
 538         struct ice_aqc_nvm_checksum *cmd;
 539         struct ice_aq_desc desc;
 540         enum ice_status status;
 541
 542         status = ice_acquire_nvm(hw, ICE_RES_READ);
 543         if (status)
 544                 return status;
 545
 546         cmd = &desc.params.nvm_checksum;
 547
 548         ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_nvm_checksum);
 549         cmd->flags = ICE_AQC_NVM_CHECKSUM_VERIFY;
 550
 551         status = ice_aq_send_cmd(hw, &desc, NULL, 0, NULL);
 552         ice_release_nvm(hw);
 553
 554         if (!status)
 555                 if (LE16_TO_CPU(cmd->checksum) != ICE_AQC_NVM_CHECKSUM_CORRECT)
 556                         status = ICE_ERR_NVM_CHECKSUM;
 557
 558         return status;
 559 }
 560
 561 /**
 562  * ice_nvm_access_get_features - Return the NVM access features structure
 563  * @cmd: NVM access command to process
 564  * @data: storage for the driver NVM features
 565  *
 566  * Fill in the data section of the NVM access request with a copy of the NVM
 567  * features structure.
 568  */
 569 enum ice_status
 570 ice_nvm_access_get_features(struct ice_nvm_access_cmd *cmd,
 571                             union ice_nvm_access_data *data)
 572 {
 573         /* The provided data_size must be at least as large as our NVM
 574          * features structure. A larger size should not be treated as an
 575          * error, to allow future extensions to to the features structure to
 576          * work on older drivers.
 577          */
 578         if (cmd->data_size < sizeof(struct ice_nvm_features))
 579                 return ICE_ERR_NO_MEMORY;
 580
 581         /* Initialize the data buffer to zeros */
 582         ice_memset(data, 0, cmd->data_size, ICE_NONDMA_MEM);
 583
 584         /* Fill in the features data */
 585         data->drv_features.major = ICE_NVM_ACCESS_MAJOR_VER;
 586         data->drv_features.minor = ICE_NVM_ACCESS_MINOR_VER;
 587         data->drv_features.size = sizeof(struct ice_nvm_features);
 588         data->drv_features.features[0] = ICE_NVM_FEATURES_0_REG_ACCESS;
 589
 590         return ICE_SUCCESS;
 591 }
 592
 593 /**
 594  * ice_nvm_access_get_module - Helper function to read module value
 595  * @cmd: NVM access command structure
 596  *
 597  * Reads the module value out of the NVM access config field.
 598  */
 599 u32 ice_nvm_access_get_module(struct ice_nvm_access_cmd *cmd)
 600 {
 601         return ((cmd->config & ICE_NVM_CFG_MODULE_M) >> ICE_NVM_CFG_MODULE_S);
 602 }
 603
 604 /**
 605  * ice_nvm_access_get_flags - Helper function to read flags value
 606  * @cmd: NVM access command structure
 607  *
 608  * Reads the flags value out of the NVM access config field.
 609  */
 610 u32 ice_nvm_access_get_flags(struct ice_nvm_access_cmd *cmd)
 611 {
 612         return ((cmd->config & ICE_NVM_CFG_FLAGS_M) >> ICE_NVM_CFG_FLAGS_S);
 613 }
 614
 615 /**
 616  * ice_nvm_access_get_adapter - Helper function to read adapter info
 617  * @cmd: NVM access command structure
 618  *
 619  * Read the adapter info value out of the NVM access config field.
 620  */
 621 u32 ice_nvm_access_get_adapter(struct ice_nvm_access_cmd *cmd)
 622 {
 623         return ((cmd->config & ICE_NVM_CFG_ADAPTER_INFO_M) >>
 624                 ICE_NVM_CFG_ADAPTER_INFO_S);
 625 }
 626
 627 /**
 628  * ice_validate_nvm_rw_reg - Check than an NVM access request is valid
 629  * @cmd: NVM access command structure
 630  *
 631  * Validates that an NVM access structure is request to read or write a valid
 632  * register offset. First validates that the module and flags are correct, and
 633  * then ensures that the register offset is one of the accepted registers.
 634  */
 635 static enum ice_status
 636 ice_validate_nvm_rw_reg(struct ice_nvm_access_cmd *cmd)
 637 {
 638         u32 module, flags, offset;
 639         u16 i;
 640
 641         module = ice_nvm_access_get_module(cmd);
 642         flags = ice_nvm_access_get_flags(cmd);
 643         offset = cmd->offset;
 644
 645         /* Make sure the module and flags indicate a read/write request */
 646         if (module != ICE_NVM_REG_RW_MODULE ||
 647             flags != ICE_NVM_REG_RW_FLAGS ||
 648             cmd->data_size != FIELD_SIZEOF(union ice_nvm_access_data, regval))
 649                 return ICE_ERR_PARAM;
 650
 651         switch (offset) {
 652         case GL_HICR:
 653         case GL_HICR_EN: /* Note, this register is read only */
 654         case GL_FWSTS:
 655         case GL_MNG_FWSM:
 656         case GLGEN_CSR_DEBUG_C:
 657         case GLGEN_RSTAT:
 658         case GLPCI_LBARCTRL:
 659         case GLNVM_GENS:
 660         case GLNVM_FLA:
 661         case PF_FUNC_RID:
 662                 return ICE_SUCCESS;
 663         default:
 664                 break;
 665         }
 666
 667         for (i = 0; i <= ICE_NVM_ACCESS_GL_HIDA_MAX; i++)
 668                 if (offset == (u32)GL_HIDA(i))
 669                         return ICE_SUCCESS;
 670
 671         for (i = 0; i <= ICE_NVM_ACCESS_GL_HIBA_MAX; i++)
 672                 if (offset == (u32)GL_HIBA(i))
 673                         return ICE_SUCCESS;
 674
 675         /* All other register offsets are not valid */
 676         return ICE_ERR_OUT_OF_RANGE;
 677 }
 678
 679 /**
 680  * ice_nvm_access_read - Handle an NVM read request
 681  * @hw: pointer to the HW struct
 682  * @cmd: NVM access command to process
 683  * @data: storage for the register value read
 684  *
 685  * Process an NVM access request to read a register.
 686  */
 687 enum ice_status
 688 ice_nvm_access_read(struct ice_hw *hw, struct ice_nvm_access_cmd *cmd,
 689                     union ice_nvm_access_data *data)
 690 {
 691         enum ice_status status;
 692
 693         ice_debug(hw, ICE_DBG_TRACE, "%s\n", __func__);
 694
 695         /* Always initialize the output data, even on failure */
 696         ice_memset(data, 0, cmd->data_size, ICE_NONDMA_MEM);
 697
 698         /* Make sure this is a valid read/write access request */
 699         status = ice_validate_nvm_rw_reg(cmd);
 700         if (status)
 701                 return status;
 702
 703         ice_debug(hw, ICE_DBG_NVM, "NVM access: reading register %08x\n",
 704                   cmd->offset);
 705
 706         /* Read the register and store the contents in the data field */
 707         data->regval = rd32(hw, cmd->offset);
 708
 709         return ICE_SUCCESS;
 710 }
 711
 712 /**
 713  * ice_nvm_access_write - Handle an NVM write request
 714  * @hw: pointer to the HW struct
 715  * @cmd: NVM access command to process
 716  * @data: NVM access data to write
 717  *
 718  * Process an NVM access request to write a register.
 719  */
 720 enum ice_status
 721 ice_nvm_access_write(struct ice_hw *hw, struct ice_nvm_access_cmd *cmd,
 722                      union ice_nvm_access_data *data)
 723 {
 724         enum ice_status status;
 725
 726         ice_debug(hw, ICE_DBG_TRACE, "%s\n", __func__);
 727
 728         /* Make sure this is a valid read/write access request */
 729         status = ice_validate_nvm_rw_reg(cmd);
 730         if (status)
 731                 return status;
 732
 733         /* Reject requests to write to read-only registers */
 734         switch (cmd->offset) {
 735         case GL_HICR_EN:
 736         case GLGEN_RSTAT:
 737                 return ICE_ERR_OUT_OF_RANGE;
 738         default:
 739                 break;
 740         }
 741
 742         ice_debug(hw, ICE_DBG_NVM,
 743                   "NVM access: writing register %08x with value %08x\n",
 744                   cmd->offset, data->regval);
 745
 746         /* Write the data field to the specified register */
 747         wr32(hw, cmd->offset, data->regval);
 748
 749         return ICE_SUCCESS;
 750 }
 751
 752 /**
 753  * ice_handle_nvm_access - Handle an NVM access request
 754  * @hw: pointer to the HW struct
 755  * @cmd: NVM access command info
 756  * @data: pointer to read or return data
 757  *
 758  * Process an NVM access request. Read the command structure information and
 759  * determine if it is valid. If not, report an error indicating the command
 760  * was invalid.
 761  *
 762  * For valid commands, perform the necessary function, copying the data into
 763  * the provided data buffer.
 764  */
 765 enum ice_status
 766 ice_handle_nvm_access(struct ice_hw *hw, struct ice_nvm_access_cmd *cmd,
 767                       union ice_nvm_access_data *data)
 768 {
 769         u32 module, flags, adapter_info;
 770
 771         ice_debug(hw, ICE_DBG_TRACE, "%s\n", __func__);
 772
 773         /* Extended flags are currently reserved and must be zero */
 774         if ((cmd->config & ICE_NVM_CFG_EXT_FLAGS_M) != 0)
 775                 return ICE_ERR_PARAM;
 776
 777         /* Adapter info must match the HW device ID */
 778         adapter_info = ice_nvm_access_get_adapter(cmd);
 779         if (adapter_info != hw->device_id)
 780                 return ICE_ERR_PARAM;
 781
 782         switch (cmd->command) {
 783         case ICE_NVM_CMD_READ:
 784                 module = ice_nvm_access_get_module(cmd);
 785                 flags = ice_nvm_access_get_flags(cmd);
 786
 787                 /* Getting the driver's NVM features structure shares the same
 788                  * command type as reading a register. Read the config field
 789                  * to determine if this is a request to get features.
 790                  */
 791                 if (module == ICE_NVM_GET_FEATURES_MODULE &&
 792                     flags == ICE_NVM_GET_FEATURES_FLAGS &&
 793                     cmd->offset == 0)
 794                         return ice_nvm_access_get_features(cmd, data);
 795                 else
 796                         return ice_nvm_access_read(hw, cmd, data);
 797         case ICE_NVM_CMD_WRITE:
 798                 return ice_nvm_access_write(hw, cmd, data);
 799         default:
 800                 return ICE_ERR_PARAM;
 801         }
 802 }