| 1 | // SPDX-License-Identifier: GPL-2.0 |
| 2 | /* Copyright(c) 2013 - 2018 Intel Corporation. */ |
| 3 | |
| 4 | #include "i40e_diag.h" |
| 5 | #include "i40e_prototype.h" |
| 6 | |
| 7 | /** |
| 8 | * i40e_diag_reg_pattern_test |
| 9 | * @hw: pointer to the hw struct |
| 10 | * @reg: reg to be tested |
| 11 | * @mask: bits to be touched |
| 12 | **/ |
| 13 | static int i40e_diag_reg_pattern_test(struct i40e_hw *hw, |
| 14 | u32 reg, u32 mask) |
| 15 | { |
| 16 | static const u32 patterns[] = { |
| 17 | 0x5A5A5A5A, 0xA5A5A5A5, 0x00000000, 0xFFFFFFFF |
| 18 | }; |
| 19 | u32 pat, val, orig_val; |
| 20 | int i; |
| 21 | |
| 22 | orig_val = rd32(hw, reg); |
| 23 | for (i = 0; i < ARRAY_SIZE(patterns); i++) { |
| 24 | pat = patterns[i]; |
| 25 | wr32(hw, reg, (pat & mask)); |
| 26 | val = rd32(hw, reg); |
| 27 | if ((val & mask) != (pat & mask)) { |
| 28 | i40e_debug(hw, I40E_DEBUG_DIAG, |
| 29 | "%s: reg pattern test failed - reg 0x%08x pat 0x%08x val 0x%08x\n" , |
| 30 | __func__, reg, pat, val); |
| 31 | return -EIO; |
| 32 | } |
| 33 | } |
| 34 | |
| 35 | wr32(hw, reg, orig_val); |
| 36 | val = rd32(hw, reg); |
| 37 | if (val != orig_val) { |
| 38 | i40e_debug(hw, I40E_DEBUG_DIAG, |
| 39 | "%s: reg restore test failed - reg 0x%08x orig_val 0x%08x val 0x%08x\n" , |
| 40 | __func__, reg, orig_val, val); |
| 41 | return -EIO; |
| 42 | } |
| 43 | |
| 44 | return 0; |
| 45 | } |
| 46 | |
| 47 | const struct i40e_diag_reg_test_info i40e_reg_list[] = { |
| 48 | /* offset mask elements stride */ |
| 49 | {I40E_QTX_CTL(0), 0x0000FFBF, 1, |
| 50 | I40E_QTX_CTL(1) - I40E_QTX_CTL(0)}, |
| 51 | {I40E_PFINT_ITR0(0), 0x00000FFF, 3, |
| 52 | I40E_PFINT_ITR0(1) - I40E_PFINT_ITR0(0)}, |
| 53 | {I40E_PFINT_ITRN(0, 0), 0x00000FFF, 1, |
| 54 | I40E_PFINT_ITRN(0, 1) - I40E_PFINT_ITRN(0, 0)}, |
| 55 | {I40E_PFINT_ITRN(1, 0), 0x00000FFF, 1, |
| 56 | I40E_PFINT_ITRN(1, 1) - I40E_PFINT_ITRN(1, 0)}, |
| 57 | {I40E_PFINT_ITRN(2, 0), 0x00000FFF, 1, |
| 58 | I40E_PFINT_ITRN(2, 1) - I40E_PFINT_ITRN(2, 0)}, |
| 59 | {I40E_PFINT_STAT_CTL0, 0x0000000C, 1, 0}, |
| 60 | {I40E_PFINT_LNKLST0, 0x00001FFF, 1, 0}, |
| 61 | {I40E_PFINT_LNKLSTN(0), 0x000007FF, 1, |
| 62 | I40E_PFINT_LNKLSTN(1) - I40E_PFINT_LNKLSTN(0)}, |
| 63 | {I40E_QINT_TQCTL(0), 0x000000FF, 1, |
| 64 | I40E_QINT_TQCTL(1) - I40E_QINT_TQCTL(0)}, |
| 65 | {I40E_QINT_RQCTL(0), 0x000000FF, 1, |
| 66 | I40E_QINT_RQCTL(1) - I40E_QINT_RQCTL(0)}, |
| 67 | {I40E_PFINT_ICR0_ENA, 0xF7F20000, 1, 0}, |
| 68 | { 0 } |
| 69 | }; |
| 70 | |
| 71 | /** |
| 72 | * i40e_diag_reg_test |
| 73 | * @hw: pointer to the hw struct |
| 74 | * |
| 75 | * Perform registers diagnostic test |
| 76 | **/ |
| 77 | int i40e_diag_reg_test(struct i40e_hw *hw) |
| 78 | { |
| 79 | int ret_code = 0; |
| 80 | u32 reg, mask; |
| 81 | u32 elements; |
| 82 | u32 i, j; |
| 83 | |
| 84 | for (i = 0; i40e_reg_list[i].offset != 0 && |
| 85 | !ret_code; i++) { |
| 86 | |
| 87 | elements = i40e_reg_list[i].elements; |
| 88 | /* set actual reg range for dynamically allocated resources */ |
| 89 | if (i40e_reg_list[i].offset == I40E_QTX_CTL(0) && |
| 90 | hw->func_caps.num_tx_qp != 0) |
| 91 | elements = hw->func_caps.num_tx_qp; |
| 92 | if ((i40e_reg_list[i].offset == I40E_PFINT_ITRN(0, 0) || |
| 93 | i40e_reg_list[i].offset == I40E_PFINT_ITRN(1, 0) || |
| 94 | i40e_reg_list[i].offset == I40E_PFINT_ITRN(2, 0) || |
| 95 | i40e_reg_list[i].offset == I40E_QINT_TQCTL(0) || |
| 96 | i40e_reg_list[i].offset == I40E_QINT_RQCTL(0)) && |
| 97 | hw->func_caps.num_msix_vectors != 0) |
| 98 | elements = hw->func_caps.num_msix_vectors - 1; |
| 99 | |
| 100 | /* test register access */ |
| 101 | mask = i40e_reg_list[i].mask; |
| 102 | for (j = 0; j < elements && !ret_code; j++) { |
| 103 | reg = i40e_reg_list[i].offset + |
| 104 | (j * i40e_reg_list[i].stride); |
| 105 | ret_code = i40e_diag_reg_pattern_test(hw, reg, mask); |
| 106 | } |
| 107 | } |
| 108 | |
| 109 | return ret_code; |
| 110 | } |
| 111 | |
| 112 | /** |
| 113 | * i40e_diag_eeprom_test |
| 114 | * @hw: pointer to the hw struct |
| 115 | * |
| 116 | * Perform EEPROM diagnostic test |
| 117 | **/ |
| 118 | int i40e_diag_eeprom_test(struct i40e_hw *hw) |
| 119 | { |
| 120 | int ret_code; |
| 121 | u16 reg_val; |
| 122 | |
| 123 | /* read NVM control word and if NVM valid, validate EEPROM checksum*/ |
| 124 | ret_code = i40e_read_nvm_word(hw, I40E_SR_NVM_CONTROL_WORD, data: ®_val); |
| 125 | if (!ret_code && |
| 126 | ((reg_val & I40E_SR_CONTROL_WORD_1_MASK) == |
| 127 | BIT(I40E_SR_CONTROL_WORD_1_SHIFT))) |
| 128 | return i40e_validate_nvm_checksum(hw, NULL); |
| 129 | else |
| 130 | return -EIO; |
| 131 | } |
| 132 | |