brintos

brintos / linux-shallow public Read only

0
0
Text · 3.6 KiB · b1ad7c4 Raw
132 lines · c
1// SPDX-License-Identifier: GPL-2.02/* Copyright(c) 2013 - 2018 Intel Corporation. */3 4#include "i40e_diag.h"5#include "i40e_prototype.h"6 7/**8 * i40e_diag_reg_pattern_test9 * @hw: pointer to the hw struct10 * @reg: reg to be tested11 * @mask: bits to be touched12 **/13static 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, 0xFFFFFFFF18	};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 47const 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_test73 * @hw: pointer to the hw struct74 *75 * Perform registers diagnostic test76 **/77int 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_test114 * @hw: pointer to the hw struct115 *116 * Perform EEPROM diagnostic test117 **/118int 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, &reg_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	else130		return -EIO;131}132