net/qede/base: support handling TLV request from MFW
authorRasesh Mody <rasesh.mody@cavium.com>
Wed, 29 Mar 2017 20:36:28 +0000 (13:36 -0700)
committerFerruh Yigit <ferruh.yigit@intel.com>
Tue, 4 Apr 2017 17:02:51 +0000 (19:02 +0200)
Add support for handling the TLV request from Management FW.

Signed-off-by: Rasesh Mody <rasesh.mody@cavium.com>
drivers/net/qede/base/bcm_osal.h
drivers/net/qede/base/ecore_mcp.c
drivers/net/qede/base/ecore_mcp.h
drivers/net/qede/base/ecore_mcp_api.h
drivers/net/qede/base/ecore_mng_tlv.c [new file with mode: 0644]
drivers/net/qede/qede_if.h

index 63ee6d5..82e3ebd 100644 (file)
@@ -419,5 +419,8 @@ void qede_get_mcp_proto_stats(struct ecore_dev *, enum ecore_mcp_protocol_type,
        qede_get_mcp_proto_stats(dev, type, stats)
 
 #define        OSAL_SLOWPATH_IRQ_REQ(p_hwfn) (0)
+#define OSAL_MFW_TLV_REQ(p_hwfn) (0)
+#define OSAL_MFW_FILL_TLV_DATA(type, buf, data) (0)
+
 
 #endif /* __BCM_OSAL_H */
index 79a907b..2b9c819 100644 (file)
@@ -2502,9 +2502,3 @@ enum _ecore_status_t ecore_mcp_initiate_pf_flr(struct ecore_hwfn *p_hwfn,
        return ecore_mcp_cmd(p_hwfn, p_ptt, DRV_MSG_CODE_INITIATE_PF_FLR, 0,
                             &mcp_resp, &mcp_param);
 }
-
-enum _ecore_status_t
-ecore_mfw_process_tlv_req(struct ecore_hwfn *p_hwfn, struct ecore_ptt *p_ptt)
-{
-       return ECORE_SUCCESS;
-}
index d77b5df..0708923 100644 (file)
@@ -70,6 +70,14 @@ struct ecore_mcp_mb_params {
        u32 mcp_param;
 };
 
+struct ecore_drv_tlv_hdr {
+       u8 tlv_type;    /* According to the enum below */
+       u8 tlv_length;  /* In dwords - not including this header */
+       u8 tlv_reserved;
+#define ECORE_DRV_TLV_FLAGS_CHANGED 0x01
+       u8 tlv_flags;
+};
+
 /**
  * @brief Initialize the interface with the MCP
  *
index 8cad43d..190c135 100644 (file)
@@ -233,9 +233,11 @@ struct ecore_mba_vers {
 };
 
 enum ecore_mfw_tlv_type {
-       ECORE_MFW_TLV_GENERIC = 0x1,    /* Core driver TLVs */
-       ECORE_MFW_TLV_FCOE = 0x2,       /* FCoE protocol TLVs */
-       ECORE_MFW_TLV_ISCSI = 0x4,      /* SCSI protocol TLVs */
+       ECORE_MFW_TLV_GENERIC = 0x1, /* Core driver TLVs */
+       ECORE_MFW_TLV_ETH = 0x2, /* L2 driver TLVs */
+       ECORE_MFW_TLV_FCOE = 0x4, /* FCoE protocol TLVs */
+       ECORE_MFW_TLV_ISCSI = 0x8, /* SCSI protocol TLVs */
+       ECORE_MFW_TLV_MAX = 0x16,
 };
 
 struct ecore_mfw_tlv_generic {
@@ -247,6 +249,21 @@ struct ecore_mfw_tlv_generic {
        bool additional_mac1_set;
        u64 additional_mac2;
        bool additional_mac2_set;
+       u8 drv_state;
+       bool drv_state_set;
+       u8 pxe_progress;
+       bool pxe_progress_set;
+       u64 rx_frames;
+       bool rx_frames_set;
+       u64 rx_bytes;
+       bool rx_bytes_set;
+       u64 tx_frames;
+       bool tx_frames_set;
+       u64 tx_bytes;
+       bool tx_bytes_set;
+};
+
+struct ecore_mfw_tlv_eth {
        u16 lso_maxoff_size;
        bool lso_maxoff_size_set;
        u16 lso_minseg_size;
@@ -259,12 +276,6 @@ struct ecore_mfw_tlv_generic {
        bool rx_descr_size_set;
        u16 netq_count;
        bool netq_count_set;
-       u16 flex_vlan;
-       bool flex_vlan_set;
-       u8 drv_state;
-       bool drv_state_set;
-       u8 pxe_progress;
-       bool pxe_progress_set;
        u32 tcp4_offloads;
        bool tcp4_offloads_set;
        u32 tcp6_offloads;
@@ -273,14 +284,6 @@ struct ecore_mfw_tlv_generic {
        bool tx_descr_qdepth_set;
        u16 rx_descr_qdepth;
        bool rx_descr_qdepth_set;
-       u64 rx_frames;
-       bool rx_frames_set;
-       u64 rx_bytes;
-       bool rx_bytes_set;
-       u64 tx_frames;
-       bool tx_frames_set;
-       u64 tx_bytes;
-       bool tx_bytes_set;
        u8 iov_offload;
        bool iov_offload_set;
        u8 txqs_empty;
@@ -446,8 +449,8 @@ struct ecore_mfw_tlv_fcoe {
        bool ols_set;
        u8 lr;
        bool lr_set;
-       u8 llr;
-       bool llrt;
+       u8 lrr;
+       bool lrr_set;
        u8 tx_lip;
        bool tx_lip_set;
        u8 rx_lip;
@@ -511,12 +514,11 @@ struct ecore_mfw_tlv_iscsi {
        bool tx_frames_set;
        u64 tx_bytes;
        bool tx_bytes_set;
-       u32 cpcp_spcp_map;
-       bool cpcp_spcp_map_set;
 };
 
 union ecore_mfw_tlv_data {
        struct ecore_mfw_tlv_generic generic;
+       struct ecore_mfw_tlv_eth eth;
        struct ecore_mfw_tlv_fcoe fcoe;
        struct ecore_mfw_tlv_iscsi iscsi;
 };
diff --git a/drivers/net/qede/base/ecore_mng_tlv.c b/drivers/net/qede/base/ecore_mng_tlv.c
new file mode 100644 (file)
index 0000000..0065d12
--- /dev/null
@@ -0,0 +1,1536 @@
+#include "bcm_osal.h"
+#include "ecore.h"
+#include "ecore_status.h"
+#include "ecore_mcp.h"
+#include "ecore_hw.h"
+#include "reg_addr.h"
+
+#define TLV_TYPE(p)    (p[0])
+#define TLV_LENGTH(p)  (p[1])
+#define TLV_FLAGS(p)   (p[3])
+
+static enum _ecore_status_t
+ecore_mfw_get_tlv_group(u8 tlv_type, u8 *tlv_group)
+{
+       switch (tlv_type) {
+       case DRV_TLV_FEATURE_FLAGS:
+       case DRV_TLV_LOCAL_ADMIN_ADDR:
+       case DRV_TLV_ADDITIONAL_MAC_ADDR_1:
+       case DRV_TLV_ADDITIONAL_MAC_ADDR_2:
+       case DRV_TLV_OS_DRIVER_STATES:
+       case DRV_TLV_PXE_BOOT_PROGRESS:
+       case DRV_TLV_RX_FRAMES_RECEIVED:
+       case DRV_TLV_RX_BYTES_RECEIVED:
+       case DRV_TLV_TX_FRAMES_SENT:
+       case DRV_TLV_TX_BYTES_SENT:
+               *tlv_group |= ECORE_MFW_TLV_GENERIC;
+               break;
+       case DRV_TLV_LSO_MAX_OFFLOAD_SIZE:
+       case DRV_TLV_LSO_MIN_SEGMENT_COUNT:
+       case DRV_TLV_PROMISCUOUS_MODE:
+       case DRV_TLV_TX_DESCRIPTORS_QUEUE_SIZE:
+       case DRV_TLV_RX_DESCRIPTORS_QUEUE_SIZE:
+       case DRV_TLV_NUM_OF_NET_QUEUE_VMQ_CFG:
+       case DRV_TLV_NUM_OFFLOADED_CONNECTIONS_TCP_IPV4:
+       case DRV_TLV_NUM_OFFLOADED_CONNECTIONS_TCP_IPV6:
+       case DRV_TLV_TX_DESCRIPTOR_QUEUE_AVG_DEPTH:
+       case DRV_TLV_RX_DESCRIPTORS_QUEUE_AVG_DEPTH:
+       case DRV_TLV_IOV_OFFLOAD:
+       case DRV_TLV_TX_QUEUES_EMPTY:
+       case DRV_TLV_RX_QUEUES_EMPTY:
+       case DRV_TLV_TX_QUEUES_FULL:
+       case DRV_TLV_RX_QUEUES_FULL:
+               *tlv_group |= ECORE_MFW_TLV_ETH;
+               break;
+       case DRV_TLV_SCSI_TO:
+       case DRV_TLV_R_T_TOV:
+       case DRV_TLV_R_A_TOV:
+       case DRV_TLV_E_D_TOV:
+       case DRV_TLV_CR_TOV:
+       case DRV_TLV_BOOT_TYPE:
+       case DRV_TLV_NPIV_STATE:
+       case DRV_TLV_NUM_OF_NPIV_IDS:
+       case DRV_TLV_SWITCH_NAME:
+       case DRV_TLV_SWITCH_PORT_NUM:
+       case DRV_TLV_SWITCH_PORT_ID:
+       case DRV_TLV_VENDOR_NAME:
+       case DRV_TLV_SWITCH_MODEL:
+       case DRV_TLV_SWITCH_FW_VER:
+       case DRV_TLV_QOS_PRIORITY_PER_802_1P:
+       case DRV_TLV_PORT_ALIAS:
+       case DRV_TLV_PORT_STATE:
+       case DRV_TLV_FIP_TX_DESCRIPTORS_QUEUE_SIZE:
+       case DRV_TLV_FCOE_RX_DESCRIPTORS_QUEUE_SIZE:
+       case DRV_TLV_LINK_FAILURE_COUNT:
+       case DRV_TLV_FCOE_BOOT_PROGRESS:
+       case DRV_TLV_RX_BROADCAST_PACKETS:
+       case DRV_TLV_TX_BROADCAST_PACKETS:
+       case DRV_TLV_FCOE_TX_DESCRIPTOR_QUEUE_AVG_DEPTH:
+       case DRV_TLV_FCOE_RX_DESCRIPTORS_QUEUE_AVG_DEPTH:
+       case DRV_TLV_FCOE_RX_FRAMES_RECEIVED:
+       case DRV_TLV_FCOE_RX_BYTES_RECEIVED:
+       case DRV_TLV_FCOE_TX_FRAMES_SENT:
+       case DRV_TLV_FCOE_TX_BYTES_SENT:
+       case DRV_TLV_CRC_ERROR_COUNT:
+       case DRV_TLV_CRC_ERROR_1_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_CRC_ERROR_1_TIMESTAMP:
+       case DRV_TLV_CRC_ERROR_2_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_CRC_ERROR_2_TIMESTAMP:
+       case DRV_TLV_CRC_ERROR_3_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_CRC_ERROR_3_TIMESTAMP:
+       case DRV_TLV_CRC_ERROR_4_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_CRC_ERROR_4_TIMESTAMP:
+       case DRV_TLV_CRC_ERROR_5_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_CRC_ERROR_5_TIMESTAMP:
+       case DRV_TLV_LOSS_OF_SYNC_ERROR_COUNT:
+       case DRV_TLV_LOSS_OF_SIGNAL_ERRORS:
+       case DRV_TLV_PRIMITIVE_SEQUENCE_PROTOCOL_ERROR_COUNT:
+       case DRV_TLV_DISPARITY_ERROR_COUNT:
+       case DRV_TLV_CODE_VIOLATION_ERROR_COUNT:
+       case DRV_TLV_LAST_FLOGI_ISSUED_COMMON_PARAMETERS_WORD_1:
+       case DRV_TLV_LAST_FLOGI_ISSUED_COMMON_PARAMETERS_WORD_2:
+       case DRV_TLV_LAST_FLOGI_ISSUED_COMMON_PARAMETERS_WORD_3:
+       case DRV_TLV_LAST_FLOGI_ISSUED_COMMON_PARAMETERS_WORD_4:
+       case DRV_TLV_LAST_FLOGI_TIMESTAMP:
+       case DRV_TLV_LAST_FLOGI_ACC_COMMON_PARAMETERS_WORD_1:
+       case DRV_TLV_LAST_FLOGI_ACC_COMMON_PARAMETERS_WORD_2:
+       case DRV_TLV_LAST_FLOGI_ACC_COMMON_PARAMETERS_WORD_3:
+       case DRV_TLV_LAST_FLOGI_ACC_COMMON_PARAMETERS_WORD_4:
+       case DRV_TLV_LAST_FLOGI_ACC_TIMESTAMP:
+       case DRV_TLV_LAST_FLOGI_RJT:
+       case DRV_TLV_LAST_FLOGI_RJT_TIMESTAMP:
+       case DRV_TLV_FDISCS_SENT_COUNT:
+       case DRV_TLV_FDISC_ACCS_RECEIVED:
+       case DRV_TLV_FDISC_RJTS_RECEIVED:
+       case DRV_TLV_PLOGI_SENT_COUNT:
+       case DRV_TLV_PLOGI_ACCS_RECEIVED:
+       case DRV_TLV_PLOGI_RJTS_RECEIVED:
+       case DRV_TLV_PLOGI_1_SENT_DESTINATION_FC_ID:
+       case DRV_TLV_PLOGI_1_TIMESTAMP:
+       case DRV_TLV_PLOGI_2_SENT_DESTINATION_FC_ID:
+       case DRV_TLV_PLOGI_2_TIMESTAMP:
+       case DRV_TLV_PLOGI_3_SENT_DESTINATION_FC_ID:
+       case DRV_TLV_PLOGI_3_TIMESTAMP:
+       case DRV_TLV_PLOGI_4_SENT_DESTINATION_FC_ID:
+       case DRV_TLV_PLOGI_4_TIMESTAMP:
+       case DRV_TLV_PLOGI_5_SENT_DESTINATION_FC_ID:
+       case DRV_TLV_PLOGI_5_TIMESTAMP:
+       case DRV_TLV_PLOGI_1_ACC_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_PLOGI_1_ACC_TIMESTAMP:
+       case DRV_TLV_PLOGI_2_ACC_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_PLOGI_2_ACC_TIMESTAMP:
+       case DRV_TLV_PLOGI_3_ACC_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_PLOGI_3_ACC_TIMESTAMP:
+       case DRV_TLV_PLOGI_4_ACC_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_PLOGI_4_ACC_TIMESTAMP:
+       case DRV_TLV_PLOGI_5_ACC_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_PLOGI_5_ACC_TIMESTAMP:
+       case DRV_TLV_LOGOS_ISSUED:
+       case DRV_TLV_LOGO_ACCS_RECEIVED:
+       case DRV_TLV_LOGO_RJTS_RECEIVED:
+       case DRV_TLV_LOGO_1_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_LOGO_1_TIMESTAMP:
+       case DRV_TLV_LOGO_2_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_LOGO_2_TIMESTAMP:
+       case DRV_TLV_LOGO_3_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_LOGO_3_TIMESTAMP:
+       case DRV_TLV_LOGO_4_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_LOGO_4_TIMESTAMP:
+       case DRV_TLV_LOGO_5_RECEIVED_SOURCE_FC_ID:
+       case DRV_TLV_LOGO_5_TIMESTAMP:
+       case DRV_TLV_LOGOS_RECEIVED:
+       case DRV_TLV_ACCS_ISSUED:
+       case DRV_TLV_PRLIS_ISSUED:
+       case DRV_TLV_ACCS_RECEIVED:
+       case DRV_TLV_ABTS_SENT_COUNT:
+       case DRV_TLV_ABTS_ACCS_RECEIVED:
+       case DRV_TLV_ABTS_RJTS_RECEIVED:
+       case DRV_TLV_ABTS_1_SENT_DESTINATION_FC_ID:
+       case DRV_TLV_ABTS_1_TIMESTAMP:
+       case DRV_TLV_ABTS_2_SENT_DESTINATION_FC_ID:
+       case DRV_TLV_ABTS_2_TIMESTAMP:
+       case DRV_TLV_ABTS_3_SENT_DESTINATION_FC_ID:
+       case DRV_TLV_ABTS_3_TIMESTAMP:
+       case DRV_TLV_ABTS_4_SENT_DESTINATION_FC_ID:
+       case DRV_TLV_ABTS_4_TIMESTAMP:
+       case DRV_TLV_ABTS_5_SENT_DESTINATION_FC_ID:
+       case DRV_TLV_ABTS_5_TIMESTAMP:
+       case DRV_TLV_RSCNS_RECEIVED:
+       case DRV_TLV_LAST_RSCN_RECEIVED_N_PORT_1:
+       case DRV_TLV_LAST_RSCN_RECEIVED_N_PORT_2:
+       case DRV_TLV_LAST_RSCN_RECEIVED_N_PORT_3:
+       case DRV_TLV_LAST_RSCN_RECEIVED_N_PORT_4:
+       case DRV_TLV_LUN_RESETS_ISSUED:
+       case DRV_TLV_ABORT_TASK_SETS_ISSUED:
+       case DRV_TLV_TPRLOS_SENT:
+       case DRV_TLV_NOS_SENT_COUNT:
+       case DRV_TLV_NOS_RECEIVED_COUNT:
+       case DRV_TLV_OLS_COUNT:
+       case DRV_TLV_LR_COUNT:
+       case DRV_TLV_LRR_COUNT:
+       case DRV_TLV_LIP_SENT_COUNT:
+       case DRV_TLV_LIP_RECEIVED_COUNT:
+       case DRV_TLV_EOFA_COUNT:
+       case DRV_TLV_EOFNI_COUNT:
+       case DRV_TLV_SCSI_STATUS_CHECK_CONDITION_COUNT:
+       case DRV_TLV_SCSI_STATUS_CONDITION_MET_COUNT:
+       case DRV_TLV_SCSI_STATUS_BUSY_COUNT:
+       case DRV_TLV_SCSI_STATUS_INTERMEDIATE_COUNT:
+       case DRV_TLV_SCSI_STATUS_INTERMEDIATE_CONDITION_MET_COUNT:
+       case DRV_TLV_SCSI_STATUS_RESERVATION_CONFLICT_COUNT:
+       case DRV_TLV_SCSI_STATUS_TASK_SET_FULL_COUNT:
+       case DRV_TLV_SCSI_STATUS_ACA_ACTIVE_COUNT:
+       case DRV_TLV_SCSI_STATUS_TASK_ABORTED_COUNT:
+       case DRV_TLV_SCSI_CHECK_CONDITION_1_RECEIVED_SK_ASC_ASCQ:
+       case DRV_TLV_SCSI_CHECK_1_TIMESTAMP:
+       case DRV_TLV_SCSI_CHECK_CONDITION_2_RECEIVED_SK_ASC_ASCQ:
+       case DRV_TLV_SCSI_CHECK_2_TIMESTAMP:
+       case DRV_TLV_SCSI_CHECK_CONDITION_3_RECEIVED_SK_ASC_ASCQ:
+       case DRV_TLV_SCSI_CHECK_3_TIMESTAMP:
+       case DRV_TLV_SCSI_CHECK_CONDITION_4_RECEIVED_SK_ASC_ASCQ:
+       case DRV_TLV_SCSI_CHECK_4_TIMESTAMP:
+       case DRV_TLV_SCSI_CHECK_CONDITION_5_RECEIVED_SK_ASC_ASCQ:
+       case DRV_TLV_SCSI_CHECK_5_TIMESTAMP:
+               *tlv_group = ECORE_MFW_TLV_FCOE;
+               break;
+       case DRV_TLV_TARGET_LLMNR_ENABLED:
+       case DRV_TLV_HEADER_DIGEST_FLAG_ENABLED:
+       case DRV_TLV_DATA_DIGEST_FLAG_ENABLED:
+       case DRV_TLV_AUTHENTICATION_METHOD:
+       case DRV_TLV_ISCSI_BOOT_TARGET_PORTAL:
+       case DRV_TLV_MAX_FRAME_SIZE:
+       case DRV_TLV_PDU_TX_DESCRIPTORS_QUEUE_SIZE:
+       case DRV_TLV_PDU_RX_DESCRIPTORS_QUEUE_SIZE:
+       case DRV_TLV_ISCSI_BOOT_PROGRESS:
+       case DRV_TLV_PDU_TX_DESCRIPTOR_QUEUE_AVG_DEPTH:
+       case DRV_TLV_PDU_RX_DESCRIPTORS_QUEUE_AVG_DEPTH:
+       case DRV_TLV_ISCSI_PDU_RX_FRAMES_RECEIVED:
+       case DRV_TLV_ISCSI_PDU_RX_BYTES_RECEIVED:
+       case DRV_TLV_ISCSI_PDU_TX_FRAMES_SENT:
+       case DRV_TLV_ISCSI_PDU_TX_BYTES_SENT:
+               *tlv_group |= ECORE_MFW_TLV_ISCSI;
+               break;
+       default:
+               return ECORE_INVAL;
+       }
+
+       return ECORE_SUCCESS;
+}
+
+static int
+ecore_mfw_get_gen_tlv_value(struct ecore_drv_tlv_hdr *p_tlv,
+                           struct ecore_mfw_tlv_generic *p_drv_buf,
+                           u8 **p_tlv_buf)
+{
+       switch (p_tlv->tlv_type) {
+       case DRV_TLV_FEATURE_FLAGS:
+               if (p_drv_buf->feat_flags_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->feat_flags;
+                       return sizeof(p_drv_buf->feat_flags);
+               }
+               break;
+       case DRV_TLV_LOCAL_ADMIN_ADDR:
+               if (p_drv_buf->local_mac_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->local_mac;
+                       return sizeof(p_drv_buf->local_mac);
+               }
+               break;
+       case DRV_TLV_ADDITIONAL_MAC_ADDR_1:
+               if (p_drv_buf->additional_mac1_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->additional_mac1;
+                       return sizeof(p_drv_buf->additional_mac1);
+               }
+               break;
+       case DRV_TLV_ADDITIONAL_MAC_ADDR_2:
+               if (p_drv_buf->additional_mac2_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->additional_mac2;
+                       return sizeof(p_drv_buf->additional_mac2);
+               }
+               break;
+       case DRV_TLV_OS_DRIVER_STATES:
+               if (p_drv_buf->drv_state_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->drv_state;
+                       return sizeof(p_drv_buf->drv_state);
+               }
+               break;
+       case DRV_TLV_PXE_BOOT_PROGRESS:
+               if (p_drv_buf->pxe_progress_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->pxe_progress;
+                       return sizeof(p_drv_buf->pxe_progress);
+               }
+               break;
+       case DRV_TLV_RX_FRAMES_RECEIVED:
+               if (p_drv_buf->rx_frames_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_frames;
+                       return sizeof(p_drv_buf->rx_frames);
+               }
+               break;
+       case DRV_TLV_RX_BYTES_RECEIVED:
+               if (p_drv_buf->rx_bytes_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_bytes;
+                       return sizeof(p_drv_buf->rx_bytes);
+               }
+               break;
+       case DRV_TLV_TX_FRAMES_SENT:
+               if (p_drv_buf->tx_frames_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_frames;
+                       return sizeof(p_drv_buf->tx_frames);
+               }
+               break;
+       case DRV_TLV_TX_BYTES_SENT:
+               if (p_drv_buf->tx_bytes_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_bytes;
+                       return sizeof(p_drv_buf->tx_bytes);
+               }
+               break;
+       default:
+               break;
+       }
+
+       return -1;
+}
+
+static int
+ecore_mfw_get_eth_tlv_value(struct ecore_drv_tlv_hdr *p_tlv,
+                           struct ecore_mfw_tlv_eth *p_drv_buf,
+                           u8 **p_tlv_buf)
+{
+       switch (p_tlv->tlv_type) {
+       case DRV_TLV_LSO_MAX_OFFLOAD_SIZE:
+               if (p_drv_buf->lso_maxoff_size_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->lso_maxoff_size;
+                       return sizeof(p_drv_buf->lso_maxoff_size);
+               }
+               break;
+       case DRV_TLV_LSO_MIN_SEGMENT_COUNT:
+               if (p_drv_buf->lso_minseg_size_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->lso_minseg_size;
+                       return sizeof(p_drv_buf->lso_minseg_size);
+               }
+               break;
+       case DRV_TLV_PROMISCUOUS_MODE:
+               if (p_drv_buf->prom_mode_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->prom_mode;
+                       return sizeof(p_drv_buf->prom_mode);
+               }
+               break;
+       case DRV_TLV_TX_DESCRIPTORS_QUEUE_SIZE:
+               if (p_drv_buf->tx_descr_size_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_descr_size;
+                       return sizeof(p_drv_buf->tx_descr_size);
+               }
+               break;
+       case DRV_TLV_RX_DESCRIPTORS_QUEUE_SIZE:
+               if (p_drv_buf->rx_descr_size_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_descr_size;
+                       return sizeof(p_drv_buf->rx_descr_size);
+               }
+               break;
+       case DRV_TLV_NUM_OF_NET_QUEUE_VMQ_CFG:
+               if (p_drv_buf->netq_count_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->netq_count;
+                       return sizeof(p_drv_buf->netq_count);
+               }
+               break;
+       case DRV_TLV_NUM_OFFLOADED_CONNECTIONS_TCP_IPV4:
+               if (p_drv_buf->tcp4_offloads_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tcp4_offloads;
+                       return sizeof(p_drv_buf->tcp4_offloads);
+               }
+               break;
+       case DRV_TLV_NUM_OFFLOADED_CONNECTIONS_TCP_IPV6:
+               if (p_drv_buf->tcp6_offloads_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tcp6_offloads;
+                       return sizeof(p_drv_buf->tcp6_offloads);
+               }
+               break;
+       case DRV_TLV_TX_DESCRIPTOR_QUEUE_AVG_DEPTH:
+               if (p_drv_buf->tx_descr_qdepth_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_descr_qdepth;
+                       return sizeof(p_drv_buf->tx_descr_qdepth);
+               }
+               break;
+       case DRV_TLV_RX_DESCRIPTORS_QUEUE_AVG_DEPTH:
+               if (p_drv_buf->rx_descr_qdepth_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_descr_qdepth;
+                       return sizeof(p_drv_buf->rx_descr_qdepth);
+               }
+               break;
+       case DRV_TLV_IOV_OFFLOAD:
+               if (p_drv_buf->iov_offload_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->iov_offload;
+                       return sizeof(p_drv_buf->iov_offload);
+               }
+               break;
+       case DRV_TLV_TX_QUEUES_EMPTY:
+               if (p_drv_buf->txqs_empty_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->txqs_empty;
+                       return sizeof(p_drv_buf->txqs_empty);
+               }
+               break;
+       case DRV_TLV_RX_QUEUES_EMPTY:
+               if (p_drv_buf->rxqs_empty_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rxqs_empty;
+                       return sizeof(p_drv_buf->rxqs_empty);
+               }
+               break;
+       case DRV_TLV_TX_QUEUES_FULL:
+               if (p_drv_buf->num_txqs_full_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->num_txqs_full;
+                       return sizeof(p_drv_buf->num_txqs_full);
+               }
+               break;
+       case DRV_TLV_RX_QUEUES_FULL:
+               if (p_drv_buf->num_rxqs_full_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->num_rxqs_full;
+                       return sizeof(p_drv_buf->num_rxqs_full);
+               }
+               break;
+       default:
+               break;
+       }
+
+       return -1;
+}
+
+static int
+ecore_mfw_get_fcoe_tlv_value(struct ecore_drv_tlv_hdr *p_tlv,
+                            struct ecore_mfw_tlv_fcoe *p_drv_buf,
+                            u8 **p_tlv_buf)
+{
+       switch (p_tlv->tlv_type) {
+       case DRV_TLV_SCSI_TO:
+               if (p_drv_buf->scsi_timeout_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_timeout;
+                       return sizeof(p_drv_buf->scsi_timeout);
+               }
+               break;
+       case DRV_TLV_R_T_TOV:
+               if (p_drv_buf->rt_tov_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rt_tov;
+                       return sizeof(p_drv_buf->rt_tov);
+               }
+               break;
+       case DRV_TLV_R_A_TOV:
+               if (p_drv_buf->ra_tov_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->ra_tov;
+                       return sizeof(p_drv_buf->ra_tov);
+               }
+               break;
+       case DRV_TLV_E_D_TOV:
+               if (p_drv_buf->ed_tov_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->ed_tov;
+                       return sizeof(p_drv_buf->ed_tov);
+               }
+               break;
+       case DRV_TLV_CR_TOV:
+               if (p_drv_buf->cr_tov_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->cr_tov;
+                       return sizeof(p_drv_buf->cr_tov);
+               }
+               break;
+       case DRV_TLV_BOOT_TYPE:
+               if (p_drv_buf->boot_type_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->boot_type;
+                       return sizeof(p_drv_buf->boot_type);
+               }
+               break;
+       case DRV_TLV_NPIV_STATE:
+               if (p_drv_buf->npiv_state_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->npiv_state;
+                       return sizeof(p_drv_buf->npiv_state);
+               }
+               break;
+       case DRV_TLV_NUM_OF_NPIV_IDS:
+               if (p_drv_buf->num_npiv_ids_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->num_npiv_ids;
+                       return sizeof(p_drv_buf->num_npiv_ids);
+               }
+               break;
+       case DRV_TLV_SWITCH_NAME:
+               if (p_drv_buf->switch_name_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->switch_name;
+                       return sizeof(p_drv_buf->switch_name);
+               }
+               break;
+       case DRV_TLV_SWITCH_PORT_NUM:
+               if (p_drv_buf->switch_portnum_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->switch_portnum;
+                       return sizeof(p_drv_buf->switch_portnum);
+               }
+               break;
+       case DRV_TLV_SWITCH_PORT_ID:
+               if (p_drv_buf->switch_portid_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->switch_portid;
+                       return sizeof(p_drv_buf->switch_portid);
+               }
+               break;
+       case DRV_TLV_VENDOR_NAME:
+               if (p_drv_buf->vendor_name_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->vendor_name;
+                       return sizeof(p_drv_buf->vendor_name);
+               }
+               break;
+       case DRV_TLV_SWITCH_MODEL:
+               if (p_drv_buf->switch_model_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->switch_model;
+                       return sizeof(p_drv_buf->switch_model);
+               }
+               break;
+       case DRV_TLV_SWITCH_FW_VER:
+               if (p_drv_buf->switch_fw_version_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->switch_fw_version;
+                       return sizeof(p_drv_buf->switch_fw_version);
+               }
+               break;
+       case DRV_TLV_QOS_PRIORITY_PER_802_1P:
+               if (p_drv_buf->qos_pri_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->qos_pri;
+                       return sizeof(p_drv_buf->qos_pri);
+               }
+               break;
+       case DRV_TLV_PORT_ALIAS:
+               if (p_drv_buf->port_alias_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->port_alias;
+                       return sizeof(p_drv_buf->port_alias);
+               }
+               break;
+       case DRV_TLV_PORT_STATE:
+               if (p_drv_buf->port_state_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->port_state;
+                       return sizeof(p_drv_buf->port_state);
+               }
+               break;
+       case DRV_TLV_FIP_TX_DESCRIPTORS_QUEUE_SIZE:
+               if (p_drv_buf->fip_tx_descr_size_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fip_tx_descr_size;
+                       return sizeof(p_drv_buf->fip_tx_descr_size);
+               }
+               break;
+       case DRV_TLV_FCOE_RX_DESCRIPTORS_QUEUE_SIZE:
+               if (p_drv_buf->fip_rx_descr_size_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fip_rx_descr_size;
+                       return sizeof(p_drv_buf->fip_rx_descr_size);
+               }
+               break;
+       case DRV_TLV_LINK_FAILURE_COUNT:
+               if (p_drv_buf->link_failures_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->link_failures;
+                       return sizeof(p_drv_buf->link_failures);
+               }
+               break;
+       case DRV_TLV_FCOE_BOOT_PROGRESS:
+               if (p_drv_buf->fcoe_boot_progress_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fcoe_boot_progress;
+                       return sizeof(p_drv_buf->fcoe_boot_progress);
+               }
+               break;
+       case DRV_TLV_RX_BROADCAST_PACKETS:
+               if (p_drv_buf->rx_bcast_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_bcast;
+                       return sizeof(p_drv_buf->rx_bcast);
+               }
+               break;
+       case DRV_TLV_TX_BROADCAST_PACKETS:
+               if (p_drv_buf->tx_bcast_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_bcast;
+                       return sizeof(p_drv_buf->tx_bcast);
+               }
+               break;
+       case DRV_TLV_FCOE_TX_DESCRIPTOR_QUEUE_AVG_DEPTH:
+               if (p_drv_buf->fcoe_txq_depth_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fcoe_txq_depth;
+                       return sizeof(p_drv_buf->fcoe_txq_depth);
+               }
+               break;
+       case DRV_TLV_FCOE_RX_DESCRIPTORS_QUEUE_AVG_DEPTH:
+               if (p_drv_buf->fcoe_rxq_depth_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fcoe_rxq_depth;
+                       return sizeof(p_drv_buf->fcoe_rxq_depth);
+               }
+               break;
+       case DRV_TLV_FCOE_RX_FRAMES_RECEIVED:
+               if (p_drv_buf->fcoe_rx_frames_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fcoe_rx_frames;
+                       return sizeof(p_drv_buf->fcoe_rx_frames);
+               }
+               break;
+       case DRV_TLV_FCOE_RX_BYTES_RECEIVED:
+               if (p_drv_buf->fcoe_rx_bytes_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fcoe_rx_bytes;
+                       return sizeof(p_drv_buf->fcoe_rx_bytes);
+               }
+               break;
+       case DRV_TLV_FCOE_TX_FRAMES_SENT:
+               if (p_drv_buf->fcoe_tx_frames_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fcoe_tx_frames;
+                       return sizeof(p_drv_buf->fcoe_tx_frames);
+               }
+               break;
+       case DRV_TLV_FCOE_TX_BYTES_SENT:
+               if (p_drv_buf->fcoe_tx_bytes_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fcoe_tx_bytes;
+                       return sizeof(p_drv_buf->fcoe_tx_bytes);
+               }
+               break;
+       case DRV_TLV_CRC_ERROR_COUNT:
+               if (p_drv_buf->crc_count_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->crc_count;
+                       return sizeof(p_drv_buf->crc_count);
+               }
+               break;
+       case DRV_TLV_CRC_ERROR_1_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->crc_err_src_fcid_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->crc_err_src_fcid[0];
+                       return sizeof(p_drv_buf->crc_err_src_fcid[0]);
+               }
+               break;
+       case DRV_TLV_CRC_ERROR_2_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->crc_err_src_fcid_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->crc_err_src_fcid[1];
+                       return sizeof(p_drv_buf->crc_err_src_fcid[1]);
+               }
+               break;
+       case DRV_TLV_CRC_ERROR_3_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->crc_err_src_fcid_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->crc_err_src_fcid[2];
+                       return sizeof(p_drv_buf->crc_err_src_fcid[2]);
+               }
+               break;
+       case DRV_TLV_CRC_ERROR_4_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->crc_err_src_fcid_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->crc_err_src_fcid[3];
+                       return sizeof(p_drv_buf->crc_err_src_fcid[3]);
+               }
+               break;
+       case DRV_TLV_CRC_ERROR_5_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->crc_err_src_fcid_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->crc_err_src_fcid[4];
+                       return sizeof(p_drv_buf->crc_err_src_fcid[4]);
+               }
+               break;
+       case DRV_TLV_CRC_ERROR_1_TIMESTAMP:
+               if (p_drv_buf->crc_err_tstamp_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->crc_err_tstamp[0];
+                       return sizeof(p_drv_buf->crc_err_tstamp[0]);
+               }
+               break;
+       case DRV_TLV_CRC_ERROR_2_TIMESTAMP:
+               if (p_drv_buf->crc_err_tstamp_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->crc_err_tstamp[1];
+                       return sizeof(p_drv_buf->crc_err_tstamp[1]);
+               }
+               break;
+       case DRV_TLV_CRC_ERROR_3_TIMESTAMP:
+               if (p_drv_buf->crc_err_tstamp_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->crc_err_tstamp[2];
+                       return sizeof(p_drv_buf->crc_err_tstamp[2]);
+               }
+               break;
+       case DRV_TLV_CRC_ERROR_4_TIMESTAMP:
+               if (p_drv_buf->crc_err_tstamp_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->crc_err_tstamp[3];
+                       return sizeof(p_drv_buf->crc_err_tstamp[3]);
+               }
+               break;
+       case DRV_TLV_CRC_ERROR_5_TIMESTAMP:
+               if (p_drv_buf->crc_err_tstamp_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->crc_err_tstamp[4];
+                       return sizeof(p_drv_buf->crc_err_tstamp[4]);
+               }
+               break;
+       case DRV_TLV_LOSS_OF_SYNC_ERROR_COUNT:
+               if (p_drv_buf->losync_err_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->losync_err;
+                       return sizeof(p_drv_buf->losync_err);
+               }
+               break;
+       case DRV_TLV_LOSS_OF_SIGNAL_ERRORS:
+               if (p_drv_buf->losig_err_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->losig_err;
+                       return sizeof(p_drv_buf->losig_err);
+               }
+               break;
+       case DRV_TLV_PRIMITIVE_SEQUENCE_PROTOCOL_ERROR_COUNT:
+               if (p_drv_buf->primtive_err_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->primtive_err;
+                       return sizeof(p_drv_buf->primtive_err);
+               }
+               break;
+       case DRV_TLV_DISPARITY_ERROR_COUNT:
+               if (p_drv_buf->disparity_err_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->disparity_err;
+                       return sizeof(p_drv_buf->disparity_err);
+               }
+               break;
+       case DRV_TLV_CODE_VIOLATION_ERROR_COUNT:
+               if (p_drv_buf->code_violation_err_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->code_violation_err;
+                       return sizeof(p_drv_buf->code_violation_err);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_ISSUED_COMMON_PARAMETERS_WORD_1:
+               if (p_drv_buf->flogi_param_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_param[0];
+                       return sizeof(p_drv_buf->flogi_param[0]);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_ISSUED_COMMON_PARAMETERS_WORD_2:
+               if (p_drv_buf->flogi_param_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_param[1];
+                       return sizeof(p_drv_buf->flogi_param[1]);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_ISSUED_COMMON_PARAMETERS_WORD_3:
+               if (p_drv_buf->flogi_param_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_param[2];
+                       return sizeof(p_drv_buf->flogi_param[2]);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_ISSUED_COMMON_PARAMETERS_WORD_4:
+               if (p_drv_buf->flogi_param_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_param[3];
+                       return sizeof(p_drv_buf->flogi_param[3]);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_TIMESTAMP:
+               if (p_drv_buf->flogi_tstamp_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_tstamp;
+                       return sizeof(p_drv_buf->flogi_tstamp);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_ACC_COMMON_PARAMETERS_WORD_1:
+               if (p_drv_buf->flogi_acc_param_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_acc_param[0];
+                       return sizeof(p_drv_buf->flogi_acc_param[0]);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_ACC_COMMON_PARAMETERS_WORD_2:
+               if (p_drv_buf->flogi_acc_param_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_acc_param[1];
+                       return sizeof(p_drv_buf->flogi_acc_param[1]);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_ACC_COMMON_PARAMETERS_WORD_3:
+               if (p_drv_buf->flogi_acc_param_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_acc_param[2];
+                       return sizeof(p_drv_buf->flogi_acc_param[2]);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_ACC_COMMON_PARAMETERS_WORD_4:
+               if (p_drv_buf->flogi_acc_param_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_acc_param[3];
+                       return sizeof(p_drv_buf->flogi_acc_param[3]);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_ACC_TIMESTAMP:
+               if (p_drv_buf->flogi_acc_tstamp_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_acc_tstamp;
+                       return sizeof(p_drv_buf->flogi_acc_tstamp);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_RJT:
+               if (p_drv_buf->flogi_rjt_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_rjt;
+                       return sizeof(p_drv_buf->flogi_rjt);
+               }
+               break;
+       case DRV_TLV_LAST_FLOGI_RJT_TIMESTAMP:
+               if (p_drv_buf->flogi_rjt_tstamp_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->flogi_rjt_tstamp;
+                       return sizeof(p_drv_buf->flogi_rjt_tstamp);
+               }
+               break;
+       case DRV_TLV_FDISCS_SENT_COUNT:
+               if (p_drv_buf->fdiscs_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fdiscs;
+                       return sizeof(p_drv_buf->fdiscs);
+               }
+               break;
+       case DRV_TLV_FDISC_ACCS_RECEIVED:
+               if (p_drv_buf->fdisc_acc_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fdisc_acc;
+                       return sizeof(p_drv_buf->fdisc_acc);
+               }
+               break;
+       case DRV_TLV_FDISC_RJTS_RECEIVED:
+               if (p_drv_buf->fdisc_rjt_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->fdisc_rjt;
+                       return sizeof(p_drv_buf->fdisc_rjt);
+               }
+               break;
+       case DRV_TLV_PLOGI_SENT_COUNT:
+               if (p_drv_buf->plogi_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi;
+                       return sizeof(p_drv_buf->plogi);
+               }
+               break;
+       case DRV_TLV_PLOGI_ACCS_RECEIVED:
+               if (p_drv_buf->plogi_acc_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_acc;
+                       return sizeof(p_drv_buf->plogi_acc);
+               }
+               break;
+       case DRV_TLV_PLOGI_RJTS_RECEIVED:
+               if (p_drv_buf->plogi_rjt_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_rjt;
+                       return sizeof(p_drv_buf->plogi_rjt);
+               }
+               break;
+       case DRV_TLV_PLOGI_1_SENT_DESTINATION_FC_ID:
+               if (p_drv_buf->plogi_dst_fcid_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_dst_fcid[0];
+                       return sizeof(p_drv_buf->plogi_dst_fcid[0]);
+               }
+               break;
+       case DRV_TLV_PLOGI_2_SENT_DESTINATION_FC_ID:
+               if (p_drv_buf->plogi_dst_fcid_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_dst_fcid[1];
+                       return sizeof(p_drv_buf->plogi_dst_fcid[1]);
+               }
+               break;
+       case DRV_TLV_PLOGI_3_SENT_DESTINATION_FC_ID:
+               if (p_drv_buf->plogi_dst_fcid_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_dst_fcid[2];
+                       return sizeof(p_drv_buf->plogi_dst_fcid[2]);
+               }
+               break;
+       case DRV_TLV_PLOGI_4_SENT_DESTINATION_FC_ID:
+               if (p_drv_buf->plogi_dst_fcid_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_dst_fcid[3];
+                       return sizeof(p_drv_buf->plogi_dst_fcid[3]);
+               }
+               break;
+       case DRV_TLV_PLOGI_5_SENT_DESTINATION_FC_ID:
+               if (p_drv_buf->plogi_dst_fcid_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_dst_fcid[4];
+                       return sizeof(p_drv_buf->plogi_dst_fcid[4]);
+               }
+               break;
+       case DRV_TLV_PLOGI_1_TIMESTAMP:
+               if (p_drv_buf->plogi_tstamp_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_tstamp[0];
+                       return sizeof(p_drv_buf->plogi_tstamp[0]);
+               }
+               break;
+       case DRV_TLV_PLOGI_2_TIMESTAMP:
+               if (p_drv_buf->plogi_tstamp_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_tstamp[1];
+                       return sizeof(p_drv_buf->plogi_tstamp[1]);
+               }
+               break;
+       case DRV_TLV_PLOGI_3_TIMESTAMP:
+               if (p_drv_buf->plogi_tstamp_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_tstamp[2];
+                       return sizeof(p_drv_buf->plogi_tstamp[2]);
+               }
+               break;
+       case DRV_TLV_PLOGI_4_TIMESTAMP:
+               if (p_drv_buf->plogi_tstamp_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_tstamp[3];
+                       return sizeof(p_drv_buf->plogi_tstamp[3]);
+               }
+               break;
+       case DRV_TLV_PLOGI_5_TIMESTAMP:
+               if (p_drv_buf->plogi_tstamp_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_tstamp[4];
+                       return sizeof(p_drv_buf->plogi_tstamp[4]);
+               }
+               break;
+       case DRV_TLV_PLOGI_1_ACC_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->plogi_acc_src_fcid_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_acc_src_fcid[0];
+                       return sizeof(p_drv_buf->plogi_acc_src_fcid[0]);
+               }
+               break;
+       case DRV_TLV_PLOGI_2_ACC_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->plogi_acc_src_fcid_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_acc_src_fcid[1];
+                       return sizeof(p_drv_buf->plogi_acc_src_fcid[1]);
+               }
+               break;
+       case DRV_TLV_PLOGI_3_ACC_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->plogi_acc_src_fcid_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_acc_src_fcid[2];
+                       return sizeof(p_drv_buf->plogi_acc_src_fcid[2]);
+               }
+               break;
+       case DRV_TLV_PLOGI_4_ACC_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->plogi_acc_src_fcid_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_acc_src_fcid[3];
+                       return sizeof(p_drv_buf->plogi_acc_src_fcid[3]);
+               }
+               break;
+       case DRV_TLV_PLOGI_5_ACC_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->plogi_acc_src_fcid_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_acc_src_fcid[4];
+                       return sizeof(p_drv_buf->plogi_acc_src_fcid[4]);
+               }
+               break;
+       case DRV_TLV_PLOGI_1_ACC_TIMESTAMP:
+               if (p_drv_buf->plogi_acc_tstamp_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_acc_tstamp[0];
+                       return sizeof(p_drv_buf->plogi_acc_tstamp[0]);
+               }
+               break;
+       case DRV_TLV_PLOGI_2_ACC_TIMESTAMP:
+               if (p_drv_buf->plogi_acc_tstamp_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_acc_tstamp[1];
+                       return sizeof(p_drv_buf->plogi_acc_tstamp[1]);
+               }
+               break;
+       case DRV_TLV_PLOGI_3_ACC_TIMESTAMP:
+               if (p_drv_buf->plogi_acc_tstamp_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_acc_tstamp[2];
+                       return sizeof(p_drv_buf->plogi_acc_tstamp[2]);
+               }
+               break;
+       case DRV_TLV_PLOGI_4_ACC_TIMESTAMP:
+               if (p_drv_buf->plogi_acc_tstamp_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_acc_tstamp[3];
+                       return sizeof(p_drv_buf->plogi_acc_tstamp[3]);
+               }
+               break;
+       case DRV_TLV_PLOGI_5_ACC_TIMESTAMP:
+               if (p_drv_buf->plogi_acc_tstamp_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogi_acc_tstamp[4];
+                       return sizeof(p_drv_buf->plogi_acc_tstamp[4]);
+               }
+               break;
+       case DRV_TLV_LOGOS_ISSUED:
+               if (p_drv_buf->tx_plogos_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_plogos;
+                       return sizeof(p_drv_buf->tx_plogos);
+               }
+               break;
+       case DRV_TLV_LOGO_ACCS_RECEIVED:
+               if (p_drv_buf->plogo_acc_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_acc;
+                       return sizeof(p_drv_buf->plogo_acc);
+               }
+               break;
+       case DRV_TLV_LOGO_RJTS_RECEIVED:
+               if (p_drv_buf->plogo_rjt_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_rjt;
+                       return sizeof(p_drv_buf->plogo_rjt);
+               }
+               break;
+       case DRV_TLV_LOGO_1_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->plogo_src_fcid_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_src_fcid[0];
+                       return sizeof(p_drv_buf->plogo_src_fcid[0]);
+               }
+               break;
+       case DRV_TLV_LOGO_2_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->plogo_src_fcid_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_src_fcid[1];
+                       return sizeof(p_drv_buf->plogo_src_fcid[1]);
+               }
+               break;
+       case DRV_TLV_LOGO_3_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->plogo_src_fcid_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_src_fcid[2];
+                       return sizeof(p_drv_buf->plogo_src_fcid[2]);
+               }
+               break;
+       case DRV_TLV_LOGO_4_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->plogo_src_fcid_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_src_fcid[3];
+                       return sizeof(p_drv_buf->plogo_src_fcid[3]);
+               }
+               break;
+       case DRV_TLV_LOGO_5_RECEIVED_SOURCE_FC_ID:
+               if (p_drv_buf->plogo_src_fcid_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_src_fcid[4];
+                       return sizeof(p_drv_buf->plogo_src_fcid[4]);
+               }
+               break;
+       case DRV_TLV_LOGO_1_TIMESTAMP:
+               if (p_drv_buf->plogo_tstamp_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_tstamp[0];
+                       return sizeof(p_drv_buf->plogo_tstamp[0]);
+               }
+               break;
+       case DRV_TLV_LOGO_2_TIMESTAMP:
+               if (p_drv_buf->plogo_tstamp_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_tstamp[1];
+                       return sizeof(p_drv_buf->plogo_tstamp[1]);
+               }
+               break;
+       case DRV_TLV_LOGO_3_TIMESTAMP:
+               if (p_drv_buf->plogo_tstamp_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_tstamp[2];
+                       return sizeof(p_drv_buf->plogo_tstamp[2]);
+               }
+               break;
+       case DRV_TLV_LOGO_4_TIMESTAMP:
+               if (p_drv_buf->plogo_tstamp_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_tstamp[3];
+                       return sizeof(p_drv_buf->plogo_tstamp[3]);
+               }
+               break;
+       case DRV_TLV_LOGO_5_TIMESTAMP:
+               if (p_drv_buf->plogo_tstamp_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->plogo_tstamp[4];
+                       return sizeof(p_drv_buf->plogo_tstamp[4]);
+               }
+               break;
+       case DRV_TLV_LOGOS_RECEIVED:
+               if (p_drv_buf->rx_logos_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_logos;
+                       return sizeof(p_drv_buf->rx_logos);
+               }
+               break;
+       case DRV_TLV_ACCS_ISSUED:
+               if (p_drv_buf->tx_accs_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_accs;
+                       return sizeof(p_drv_buf->tx_accs);
+               }
+               break;
+       case DRV_TLV_PRLIS_ISSUED:
+               if (p_drv_buf->tx_prlis_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_prlis;
+                       return sizeof(p_drv_buf->tx_prlis);
+               }
+               break;
+       case DRV_TLV_ACCS_RECEIVED:
+               if (p_drv_buf->rx_accs_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_accs;
+                       return sizeof(p_drv_buf->rx_accs);
+               }
+               break;
+       case DRV_TLV_ABTS_SENT_COUNT:
+               if (p_drv_buf->tx_abts_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_abts;
+                       return sizeof(p_drv_buf->tx_abts);
+               }
+               break;
+       case DRV_TLV_ABTS_ACCS_RECEIVED:
+               if (p_drv_buf->rx_abts_acc_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_abts_acc;
+                       return sizeof(p_drv_buf->rx_abts_acc);
+               }
+               break;
+       case DRV_TLV_ABTS_RJTS_RECEIVED:
+               if (p_drv_buf->rx_abts_rjt_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_abts_rjt;
+                       return sizeof(p_drv_buf->rx_abts_rjt);
+               }
+               break;
+       case DRV_TLV_ABTS_1_SENT_DESTINATION_FC_ID:
+               if (p_drv_buf->abts_dst_fcid_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->abts_dst_fcid[0];
+                       return sizeof(p_drv_buf->abts_dst_fcid[0]);
+               }
+               break;
+       case DRV_TLV_ABTS_2_SENT_DESTINATION_FC_ID:
+               if (p_drv_buf->abts_dst_fcid_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->abts_dst_fcid[1];
+                       return sizeof(p_drv_buf->abts_dst_fcid[1]);
+               }
+               break;
+       case DRV_TLV_ABTS_3_SENT_DESTINATION_FC_ID:
+               if (p_drv_buf->abts_dst_fcid_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->abts_dst_fcid[2];
+                       return sizeof(p_drv_buf->abts_dst_fcid[2]);
+               }
+               break;
+       case DRV_TLV_ABTS_4_SENT_DESTINATION_FC_ID:
+               if (p_drv_buf->abts_dst_fcid_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->abts_dst_fcid[3];
+                       return sizeof(p_drv_buf->abts_dst_fcid[3]);
+               }
+               break;
+       case DRV_TLV_ABTS_5_SENT_DESTINATION_FC_ID:
+               if (p_drv_buf->abts_dst_fcid_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->abts_dst_fcid[4];
+                       return sizeof(p_drv_buf->abts_dst_fcid[4]);
+               }
+               break;
+       case DRV_TLV_ABTS_1_TIMESTAMP:
+               if (p_drv_buf->abts_tstamp_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->abts_tstamp[0];
+                       return sizeof(p_drv_buf->abts_tstamp[0]);
+               }
+               break;
+       case DRV_TLV_ABTS_2_TIMESTAMP:
+               if (p_drv_buf->abts_tstamp_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->abts_tstamp[1];
+                       return sizeof(p_drv_buf->abts_tstamp[1]);
+               }
+               break;
+       case DRV_TLV_ABTS_3_TIMESTAMP:
+               if (p_drv_buf->abts_tstamp_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->abts_tstamp[2];
+                       return sizeof(p_drv_buf->abts_tstamp[2]);
+               }
+               break;
+       case DRV_TLV_ABTS_4_TIMESTAMP:
+               if (p_drv_buf->abts_tstamp_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->abts_tstamp[3];
+                       return sizeof(p_drv_buf->abts_tstamp[3]);
+               }
+               break;
+       case DRV_TLV_ABTS_5_TIMESTAMP:
+               if (p_drv_buf->abts_tstamp_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->abts_tstamp[4];
+                       return sizeof(p_drv_buf->abts_tstamp[4]);
+               }
+               break;
+       case DRV_TLV_RSCNS_RECEIVED:
+               if (p_drv_buf->rx_rscn_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_rscn;
+                       return sizeof(p_drv_buf->rx_rscn);
+               }
+               break;
+       case DRV_TLV_LAST_RSCN_RECEIVED_N_PORT_1:
+               if (p_drv_buf->rx_rscn_nport_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_rscn_nport[0];
+                       return sizeof(p_drv_buf->rx_rscn_nport[0]);
+               }
+               break;
+       case DRV_TLV_LAST_RSCN_RECEIVED_N_PORT_2:
+               if (p_drv_buf->rx_rscn_nport_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_rscn_nport[1];
+                       return sizeof(p_drv_buf->rx_rscn_nport[1]);
+               }
+               break;
+       case DRV_TLV_LAST_RSCN_RECEIVED_N_PORT_3:
+               if (p_drv_buf->rx_rscn_nport_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_rscn_nport[2];
+                       return sizeof(p_drv_buf->rx_rscn_nport[2]);
+               }
+               break;
+       case DRV_TLV_LAST_RSCN_RECEIVED_N_PORT_4:
+               if (p_drv_buf->rx_rscn_nport_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_rscn_nport[3];
+                       return sizeof(p_drv_buf->rx_rscn_nport[3]);
+               }
+               break;
+       case DRV_TLV_LUN_RESETS_ISSUED:
+               if (p_drv_buf->tx_lun_rst_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_lun_rst;
+                       return sizeof(p_drv_buf->tx_lun_rst);
+               }
+               break;
+       case DRV_TLV_ABORT_TASK_SETS_ISSUED:
+               if (p_drv_buf->abort_task_sets_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->abort_task_sets;
+                       return sizeof(p_drv_buf->abort_task_sets);
+               }
+               break;
+       case DRV_TLV_TPRLOS_SENT:
+               if (p_drv_buf->tx_tprlos_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_tprlos;
+                       return sizeof(p_drv_buf->tx_tprlos);
+               }
+               break;
+       case DRV_TLV_NOS_SENT_COUNT:
+               if (p_drv_buf->tx_nos_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_nos;
+                       return sizeof(p_drv_buf->tx_nos);
+               }
+               break;
+       case DRV_TLV_NOS_RECEIVED_COUNT:
+               if (p_drv_buf->rx_nos_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_nos;
+                       return sizeof(p_drv_buf->rx_nos);
+               }
+               break;
+       case DRV_TLV_OLS_COUNT:
+               if (p_drv_buf->ols_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->ols;
+                       return sizeof(p_drv_buf->ols);
+               }
+               break;
+       case DRV_TLV_LR_COUNT:
+               if (p_drv_buf->lr_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->lr;
+                       return sizeof(p_drv_buf->lr);
+               }
+               break;
+       case DRV_TLV_LRR_COUNT:
+               if (p_drv_buf->lrr_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->lrr;
+                       return sizeof(p_drv_buf->lrr);
+               }
+               break;
+       case DRV_TLV_LIP_SENT_COUNT:
+               if (p_drv_buf->tx_lip_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_lip;
+                       return sizeof(p_drv_buf->tx_lip);
+               }
+               break;
+       case DRV_TLV_LIP_RECEIVED_COUNT:
+               if (p_drv_buf->rx_lip_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_lip;
+                       return sizeof(p_drv_buf->rx_lip);
+               }
+               break;
+       case DRV_TLV_EOFA_COUNT:
+               if (p_drv_buf->eofa_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->eofa;
+                       return sizeof(p_drv_buf->eofa);
+               }
+               break;
+       case DRV_TLV_EOFNI_COUNT:
+               if (p_drv_buf->eofni_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->eofni;
+                       return sizeof(p_drv_buf->eofni);
+               }
+               break;
+       case DRV_TLV_SCSI_STATUS_CHECK_CONDITION_COUNT:
+               if (p_drv_buf->scsi_chks_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_chks;
+                       return sizeof(p_drv_buf->scsi_chks);
+               }
+               break;
+       case DRV_TLV_SCSI_STATUS_CONDITION_MET_COUNT:
+               if (p_drv_buf->scsi_cond_met_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_cond_met;
+                       return sizeof(p_drv_buf->scsi_cond_met);
+               }
+               break;
+       case DRV_TLV_SCSI_STATUS_BUSY_COUNT:
+               if (p_drv_buf->scsi_busy_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_busy;
+                       return sizeof(p_drv_buf->scsi_busy);
+               }
+               break;
+       case DRV_TLV_SCSI_STATUS_INTERMEDIATE_COUNT:
+               if (p_drv_buf->scsi_inter_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_inter;
+                       return sizeof(p_drv_buf->scsi_inter);
+               }
+               break;
+       case DRV_TLV_SCSI_STATUS_INTERMEDIATE_CONDITION_MET_COUNT:
+               if (p_drv_buf->scsi_inter_cond_met_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_inter_cond_met;
+                       return sizeof(p_drv_buf->scsi_inter_cond_met);
+               }
+               break;
+       case DRV_TLV_SCSI_STATUS_RESERVATION_CONFLICT_COUNT:
+               if (p_drv_buf->scsi_rsv_conflicts_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_rsv_conflicts;
+                       return sizeof(p_drv_buf->scsi_rsv_conflicts);
+               }
+               break;
+       case DRV_TLV_SCSI_STATUS_TASK_SET_FULL_COUNT:
+               if (p_drv_buf->scsi_tsk_full_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_tsk_full;
+                       return sizeof(p_drv_buf->scsi_tsk_full);
+               }
+               break;
+       case DRV_TLV_SCSI_STATUS_ACA_ACTIVE_COUNT:
+               if (p_drv_buf->scsi_aca_active_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_aca_active;
+                       return sizeof(p_drv_buf->scsi_aca_active);
+               }
+               break;
+       case DRV_TLV_SCSI_STATUS_TASK_ABORTED_COUNT:
+               if (p_drv_buf->scsi_tsk_abort_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_tsk_abort;
+                       return sizeof(p_drv_buf->scsi_tsk_abort);
+               }
+               break;
+       case DRV_TLV_SCSI_CHECK_CONDITION_1_RECEIVED_SK_ASC_ASCQ:
+               if (p_drv_buf->scsi_rx_chk_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_rx_chk[0];
+                       return sizeof(p_drv_buf->scsi_rx_chk[0]);
+               }
+               break;
+       case DRV_TLV_SCSI_CHECK_CONDITION_2_RECEIVED_SK_ASC_ASCQ:
+               if (p_drv_buf->scsi_rx_chk_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_rx_chk[1];
+                       return sizeof(p_drv_buf->scsi_rx_chk[1]);
+               }
+               break;
+       case DRV_TLV_SCSI_CHECK_CONDITION_3_RECEIVED_SK_ASC_ASCQ:
+               if (p_drv_buf->scsi_rx_chk_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_rx_chk[2];
+                       return sizeof(p_drv_buf->scsi_rx_chk[2]);
+               }
+               break;
+       case DRV_TLV_SCSI_CHECK_CONDITION_4_RECEIVED_SK_ASC_ASCQ:
+               if (p_drv_buf->scsi_rx_chk_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_rx_chk[3];
+                       return sizeof(p_drv_buf->scsi_rx_chk[4]);
+               }
+               break;
+       case DRV_TLV_SCSI_CHECK_CONDITION_5_RECEIVED_SK_ASC_ASCQ:
+               if (p_drv_buf->scsi_rx_chk_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_rx_chk[4];
+                       return sizeof(p_drv_buf->scsi_rx_chk[4]);
+               }
+               break;
+       case DRV_TLV_SCSI_CHECK_1_TIMESTAMP:
+               if (p_drv_buf->scsi_chk_tstamp_set[0]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_chk_tstamp[0];
+                       return sizeof(p_drv_buf->scsi_chk_tstamp[0]);
+               }
+               break;
+       case DRV_TLV_SCSI_CHECK_2_TIMESTAMP:
+               if (p_drv_buf->scsi_chk_tstamp_set[1]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_chk_tstamp[1];
+                       return sizeof(p_drv_buf->scsi_chk_tstamp[1]);
+               }
+               break;
+       case DRV_TLV_SCSI_CHECK_3_TIMESTAMP:
+               if (p_drv_buf->scsi_chk_tstamp_set[2]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_chk_tstamp[2];
+                       return sizeof(p_drv_buf->scsi_chk_tstamp[2]);
+               }
+               break;
+       case DRV_TLV_SCSI_CHECK_4_TIMESTAMP:
+               if (p_drv_buf->scsi_chk_tstamp_set[3]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_chk_tstamp[3];
+                       return sizeof(p_drv_buf->scsi_chk_tstamp[3]);
+               }
+               break;
+       case DRV_TLV_SCSI_CHECK_5_TIMESTAMP:
+               if (p_drv_buf->scsi_chk_tstamp_set[4]) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->scsi_chk_tstamp[4];
+                       return sizeof(p_drv_buf->scsi_chk_tstamp[4]);
+               }
+               break;
+       default:
+               break;
+       }
+
+       return -1;
+}
+
+static int
+ecore_mfw_get_iscsi_tlv_value(struct ecore_drv_tlv_hdr *p_tlv,
+                             struct ecore_mfw_tlv_iscsi *p_drv_buf,
+                             u8 **p_tlv_buf)
+{
+       switch (p_tlv->tlv_type) {
+       case DRV_TLV_TARGET_LLMNR_ENABLED:
+               if (p_drv_buf->target_llmnr_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->target_llmnr;
+                       return sizeof(p_drv_buf->target_llmnr);
+               }
+               break;
+       case DRV_TLV_HEADER_DIGEST_FLAG_ENABLED:
+               if (p_drv_buf->header_digest_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->header_digest;
+                       return sizeof(p_drv_buf->header_digest);
+               }
+               break;
+       case DRV_TLV_DATA_DIGEST_FLAG_ENABLED:
+               if (p_drv_buf->data_digest_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->data_digest;
+                       return sizeof(p_drv_buf->data_digest);
+               }
+               break;
+       case DRV_TLV_AUTHENTICATION_METHOD:
+               if (p_drv_buf->auth_method_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->auth_method;
+                       return sizeof(p_drv_buf->auth_method);
+               }
+               break;
+       case DRV_TLV_ISCSI_BOOT_TARGET_PORTAL:
+               if (p_drv_buf->boot_taget_portal_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->boot_taget_portal;
+                       return sizeof(p_drv_buf->boot_taget_portal);
+               }
+               break;
+       case DRV_TLV_MAX_FRAME_SIZE:
+               if (p_drv_buf->frame_size_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->frame_size;
+                       return sizeof(p_drv_buf->frame_size);
+               }
+               break;
+       case DRV_TLV_PDU_TX_DESCRIPTORS_QUEUE_SIZE:
+               if (p_drv_buf->tx_desc_size_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_desc_size;
+                       return sizeof(p_drv_buf->tx_desc_size);
+               }
+               break;
+       case DRV_TLV_PDU_RX_DESCRIPTORS_QUEUE_SIZE:
+               if (p_drv_buf->rx_desc_size_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_desc_size;
+                       return sizeof(p_drv_buf->rx_desc_size);
+               }
+               break;
+       case DRV_TLV_ISCSI_BOOT_PROGRESS:
+               if (p_drv_buf->boot_progress_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->boot_progress;
+                       return sizeof(p_drv_buf->boot_progress);
+               }
+               break;
+       case DRV_TLV_PDU_TX_DESCRIPTOR_QUEUE_AVG_DEPTH:
+               if (p_drv_buf->tx_desc_qdepth_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_desc_qdepth;
+                       return sizeof(p_drv_buf->tx_desc_qdepth);
+               }
+               break;
+       case DRV_TLV_PDU_RX_DESCRIPTORS_QUEUE_AVG_DEPTH:
+               if (p_drv_buf->rx_desc_qdepth_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_desc_qdepth;
+                       return sizeof(p_drv_buf->rx_desc_qdepth);
+               }
+               break;
+       case DRV_TLV_ISCSI_PDU_RX_FRAMES_RECEIVED:
+               if (p_drv_buf->rx_frames_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_frames;
+                       return sizeof(p_drv_buf->rx_frames);
+               }
+               break;
+       case DRV_TLV_ISCSI_PDU_RX_BYTES_RECEIVED:
+               if (p_drv_buf->rx_bytes_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->rx_bytes;
+                       return sizeof(p_drv_buf->rx_bytes);
+               }
+               break;
+       case DRV_TLV_ISCSI_PDU_TX_FRAMES_SENT:
+               if (p_drv_buf->tx_frames_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_frames;
+                       return sizeof(p_drv_buf->tx_frames);
+               }
+               break;
+       case DRV_TLV_ISCSI_PDU_TX_BYTES_SENT:
+               if (p_drv_buf->tx_bytes_set) {
+                       *p_tlv_buf = (u8 *)&p_drv_buf->tx_bytes;
+                       return sizeof(p_drv_buf->tx_bytes);
+               }
+               break;
+       default:
+               break;
+       }
+
+       return -1;
+}
+
+static enum _ecore_status_t
+ecore_mfw_update_tlvs(u8 tlv_group, struct ecore_hwfn *p_hwfn,
+                     struct ecore_ptt *p_ptt, u8 *p_mfw_buf, u32 size)
+{
+       union ecore_mfw_tlv_data *p_tlv_data;
+       struct ecore_drv_tlv_hdr tlv;
+       u8 *p_tlv_ptr = OSAL_NULL, *p_temp;
+       u32 offset;
+       int len;
+
+       p_tlv_data = OSAL_VALLOC(p_hwfn->p_dev, sizeof(*p_tlv_data));
+       if (!p_tlv_data)
+               return ECORE_NOMEM;
+
+       OSAL_MEMSET(p_tlv_data, 0, sizeof(*p_tlv_data));
+       if (OSAL_MFW_FILL_TLV_DATA(p_hwfn, tlv_group, p_tlv_data)) {
+               OSAL_VFREE(p_hwfn->p_dev, p_tlv_data);
+               return ECORE_INVAL;
+       }
+
+       offset = 0;
+       OSAL_MEMSET(&tlv, 0, sizeof(tlv));
+       while (offset < size) {
+               p_temp = &p_mfw_buf[offset];
+               tlv.tlv_type = TLV_TYPE(p_temp);
+               tlv.tlv_length = TLV_LENGTH(p_temp);
+               tlv.tlv_flags = TLV_FLAGS(p_temp);
+               DP_INFO(p_hwfn, "Type %d length = %d flags = 0x%x\n",
+                       tlv.tlv_type, tlv.tlv_length, tlv.tlv_flags);
+
+               offset += sizeof(tlv);
+               if (tlv_group == ECORE_MFW_TLV_GENERIC)
+                       len = ecore_mfw_get_gen_tlv_value(&tlv,
+                                       &p_tlv_data->generic, &p_tlv_ptr);
+               else if (tlv_group == ECORE_MFW_TLV_ETH)
+                       len = ecore_mfw_get_eth_tlv_value(&tlv,
+                                       &p_tlv_data->eth, &p_tlv_ptr);
+               else if (tlv_group == ECORE_MFW_TLV_FCOE)
+                       len = ecore_mfw_get_fcoe_tlv_value(&tlv,
+                                       &p_tlv_data->fcoe, &p_tlv_ptr);
+               else
+                       len = ecore_mfw_get_iscsi_tlv_value(&tlv,
+                                       &p_tlv_data->iscsi, &p_tlv_ptr);
+
+               if (len > 0) {
+                       OSAL_WARN(len > 4 * tlv.tlv_length,
+                                 "Incorrect MFW TLV length");
+                       len = OSAL_MIN_T(int, len, 4 * tlv.tlv_length);
+                       tlv.tlv_flags |= ECORE_DRV_TLV_FLAGS_CHANGED;
+                       /* TODO: Endianness handling? */
+                       OSAL_MEMCPY(p_mfw_buf, &tlv, sizeof(tlv));
+                       OSAL_MEMCPY(p_mfw_buf + offset, p_tlv_ptr, len);
+               }
+
+               offset += sizeof(u32) * tlv.tlv_length;
+       }
+
+       OSAL_VFREE(p_hwfn->p_dev, p_tlv_data);
+
+       return ECORE_SUCCESS;
+}
+
+enum _ecore_status_t
+ecore_mfw_process_tlv_req(struct ecore_hwfn *p_hwfn, struct ecore_ptt *p_ptt)
+{
+       u32 addr, size, offset, resp, param, val;
+       u8 tlv_group = 0, id, *p_mfw_buf = OSAL_NULL, *p_temp;
+       u32 global_offsize, global_addr;
+       enum _ecore_status_t rc;
+       struct ecore_drv_tlv_hdr tlv;
+
+       addr = SECTION_OFFSIZE_ADDR(p_hwfn->mcp_info->public_base,
+                                   PUBLIC_GLOBAL);
+       global_offsize = ecore_rd(p_hwfn, p_ptt, addr);
+       global_addr = SECTION_ADDR(global_offsize, 0);
+       addr = global_addr + OFFSETOF(struct public_global, data_ptr);
+       size = ecore_rd(p_hwfn, p_ptt, global_addr +
+                       OFFSETOF(struct public_global, data_size));
+
+       if (!size) {
+               DP_NOTICE(p_hwfn, false, "Invalid TLV req size = %d\n", size);
+               goto drv_done;
+       }
+
+       p_mfw_buf = (void *)OSAL_VALLOC(p_hwfn->p_dev, size);
+       if (!p_mfw_buf) {
+               DP_NOTICE(p_hwfn, false,
+                         "Failed allocate memory for p_mfw_buf\n");
+               goto drv_done;
+       }
+
+       /* Read the TLV request to local buffer */
+       for (offset = 0; offset < size; offset += sizeof(u32)) {
+               val = ecore_rd(p_hwfn, p_ptt, addr + offset);
+               OSAL_MEMCPY(&p_mfw_buf[offset], &val, sizeof(u32));
+       }
+
+       /* Parse the headers to enumerate the requested TLV groups */
+       for (offset = 0; offset < size;
+            offset += sizeof(tlv) + sizeof(u32) * tlv.tlv_length) {
+               p_temp = &p_mfw_buf[offset];
+               tlv.tlv_type = TLV_TYPE(p_temp);
+               tlv.tlv_length = TLV_LENGTH(p_temp);
+               if (ecore_mfw_get_tlv_group(tlv.tlv_type, &tlv_group))
+                       goto drv_done;
+       }
+
+       /* Update the TLV values in the local buffer */
+       for (id = ECORE_MFW_TLV_GENERIC; id < ECORE_MFW_TLV_MAX; id <<= 1) {
+               if (tlv_group & id) {
+                       if (ecore_mfw_update_tlvs(id, p_hwfn, p_ptt, p_mfw_buf,
+                                                 size))
+                               goto drv_done;
+               }
+       }
+
+       /* Write the TLV data to shared memory */
+       for (offset = 0; offset < size; offset += sizeof(u32)) {
+               val = (u32)p_mfw_buf[offset];
+               ecore_wr(p_hwfn, p_ptt, addr + offset, val);
+               offset += sizeof(u32);
+       }
+
+drv_done:
+       rc = ecore_mcp_cmd(p_hwfn, p_ptt, DRV_MSG_CODE_GET_TLV_DONE, 0, &resp,
+                          &param);
+
+       OSAL_VFREE(p_hwfn->p_dev, p_mfw_buf);
+
+       return rc;
+}
index 0a1f7db..bfd96d6 100644 (file)
@@ -96,8 +96,29 @@ struct qed_slowpath_params {
 
 #define ILT_PAGE_SIZE_TCFC 0x8000      /* 32KB */
 
+struct qed_eth_tlvs {
+       u16 feat_flags;
+       u8 mac[3][ETH_ALEN];
+       u16 lso_maxoff;
+       u16 lso_minseg;
+       bool prom_mode;
+       u16 num_txqs;
+       u16 num_rxqs;
+       u16 num_netqs;
+       u16 flex_vlan;
+       u32 tcp4_offloads;
+       u32 tcp6_offloads;
+       u16 tx_avg_qdepth;
+       u16 rx_avg_qdepth;
+       u8 txqs_empty;
+       u8 rxqs_empty;
+       u8 num_txqs_full;
+       u8 num_rxqs_full;
+};
+
 struct qed_common_cb_ops {
        void (*link_update)(void *dev, struct qed_link_output *link);
+       void (*get_tlv_data)(void *dev, struct qed_eth_tlvs *data);
 };
 
 struct qed_selftest_ops {