1 files changed, 49 insertions, 0 deletions

diff --git a/drivers/net/ethernet/qlogic/qed/qed_mcp.c b/drivers/net/ethernet/qlogic/qed/qed_mcp.c
index 4e0b443c9519..62a220fce6e1 100644
--- a/drivers/net/ethernet/qlogic/qed/qed_mcp.c
+++ b/drivers/net/ethernet/qlogic/qed/qed_mcp.c
@@ -2463,6 +2463,55 @@ out:
         return rc;
 }
 
+int qed_mcp_phy_sfp_read(struct qed_hwfn *p_hwfn, struct qed_ptt *p_ptt,
+                         u32 port, u32 addr, u32 offset, u32 len, u8 *p_buf)
+{
+        u32 bytes_left, bytes_to_copy, buf_size, nvm_offset = 0;
+        u32 resp, param;
+        int rc;
+
+        nvm_offset |= (port << DRV_MB_PARAM_TRANSCEIVER_PORT_OFFSET) &
+                       DRV_MB_PARAM_TRANSCEIVER_PORT_MASK;
+        nvm_offset |= (addr << DRV_MB_PARAM_TRANSCEIVER_I2C_ADDRESS_OFFSET) &
+                       DRV_MB_PARAM_TRANSCEIVER_I2C_ADDRESS_MASK;
+
+        addr = offset;
+        offset = 0;
+        bytes_left = len;
+        while (bytes_left > 0) {
+                bytes_to_copy = min_t(u32, bytes_left,
+                                      MAX_I2C_TRANSACTION_SIZE);
+                nvm_offset &= (DRV_MB_PARAM_TRANSCEIVER_I2C_ADDRESS_MASK |
+                               DRV_MB_PARAM_TRANSCEIVER_PORT_MASK);
+                nvm_offset |= ((addr + offset) <<
+                               DRV_MB_PARAM_TRANSCEIVER_OFFSET_OFFSET) &
+                               DRV_MB_PARAM_TRANSCEIVER_OFFSET_MASK;
+                nvm_offset |= (bytes_to_copy <<
+                               DRV_MB_PARAM_TRANSCEIVER_SIZE_OFFSET) &
+                               DRV_MB_PARAM_TRANSCEIVER_SIZE_MASK;
+                rc = qed_mcp_nvm_rd_cmd(p_hwfn, p_ptt,
+                                        DRV_MSG_CODE_TRANSCEIVER_READ,
+                                        nvm_offset, &resp, &param, &buf_size,
+                                        (u32 *)(p_buf + offset));
+                if (rc) {
+                        DP_NOTICE(p_hwfn,
+                                  "Failed to send a transceiver read command to the MFW. rc = %d.\n",
+                                  rc);
+                        return rc;
+                }
+
+                if (resp == FW_MSG_CODE_TRANSCEIVER_NOT_PRESENT)
+                        return -ENODEV;
+                else if (resp != FW_MSG_CODE_TRANSCEIVER_DIAG_OK)
+                        return -EINVAL;
+
+                offset += buf_size;
+                bytes_left -= buf_size;
+        }
+
+        return 0;
+}
+
 int qed_mcp_bist_register_test(struct qed_hwfn *p_hwfn, struct qed_ptt *p_ptt)
 {
         u32 drv_mb_param = 0, rsp, param;