|
@@ -569,6 +569,31 @@ int qed_mcp_cmd(struct qed_hwfn *p_hwfn,
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+int qed_mcp_nvm_wr_cmd(struct qed_hwfn *p_hwfn,
|
|
|
|
+ struct qed_ptt *p_ptt,
|
|
|
|
+ u32 cmd,
|
|
|
|
+ u32 param,
|
|
|
|
+ u32 *o_mcp_resp,
|
|
|
|
+ u32 *o_mcp_param, u32 i_txn_size, u32 *i_buf)
|
|
|
|
+{
|
|
|
|
+ struct qed_mcp_mb_params mb_params;
|
|
|
|
+ int rc;
|
|
|
|
+
|
|
|
|
+ memset(&mb_params, 0, sizeof(mb_params));
|
|
|
|
+ mb_params.cmd = cmd;
|
|
|
|
+ mb_params.param = param;
|
|
|
|
+ mb_params.p_data_src = i_buf;
|
|
|
|
+ mb_params.data_src_size = (u8)i_txn_size;
|
|
|
|
+ rc = qed_mcp_cmd_and_union(p_hwfn, p_ptt, &mb_params);
|
|
|
|
+ if (rc)
|
|
|
|
+ return rc;
|
|
|
|
+
|
|
|
|
+ *o_mcp_resp = mb_params.mcp_resp;
|
|
|
|
+ *o_mcp_param = mb_params.mcp_param;
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
int qed_mcp_nvm_rd_cmd(struct qed_hwfn *p_hwfn,
|
|
int qed_mcp_nvm_rd_cmd(struct qed_hwfn *p_hwfn,
|
|
struct qed_ptt *p_ptt,
|
|
struct qed_ptt *p_ptt,
|
|
u32 cmd,
|
|
u32 cmd,
|
|
@@ -2261,6 +2286,102 @@ int qed_mcp_nvm_read(struct qed_dev *cdev, u32 addr, u8 *p_buf, u32 len)
|
|
return rc;
|
|
return rc;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
+int qed_mcp_nvm_resp(struct qed_dev *cdev, u8 *p_buf)
|
|
|
|
+{
|
|
|
|
+ struct qed_hwfn *p_hwfn = QED_LEADING_HWFN(cdev);
|
|
|
|
+ struct qed_ptt *p_ptt;
|
|
|
|
+
|
|
|
|
+ p_ptt = qed_ptt_acquire(p_hwfn);
|
|
|
|
+ if (!p_ptt)
|
|
|
|
+ return -EBUSY;
|
|
|
|
+
|
|
|
|
+ memcpy(p_buf, &cdev->mcp_nvm_resp, sizeof(cdev->mcp_nvm_resp));
|
|
|
|
+ qed_ptt_release(p_hwfn, p_ptt);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+int qed_mcp_nvm_put_file_begin(struct qed_dev *cdev, u32 addr)
|
|
|
|
+{
|
|
|
|
+ struct qed_hwfn *p_hwfn = QED_LEADING_HWFN(cdev);
|
|
|
|
+ struct qed_ptt *p_ptt;
|
|
|
|
+ u32 resp, param;
|
|
|
|
+ int rc;
|
|
|
|
+
|
|
|
|
+ p_ptt = qed_ptt_acquire(p_hwfn);
|
|
|
|
+ if (!p_ptt)
|
|
|
|
+ return -EBUSY;
|
|
|
|
+ rc = qed_mcp_cmd(p_hwfn, p_ptt, DRV_MSG_CODE_NVM_PUT_FILE_BEGIN, addr,
|
|
|
|
+ &resp, ¶m);
|
|
|
|
+ cdev->mcp_nvm_resp = resp;
|
|
|
|
+ qed_ptt_release(p_hwfn, p_ptt);
|
|
|
|
+
|
|
|
|
+ return rc;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+int qed_mcp_nvm_write(struct qed_dev *cdev,
|
|
|
|
+ u32 cmd, u32 addr, u8 *p_buf, u32 len)
|
|
|
|
+{
|
|
|
|
+ u32 buf_idx = 0, buf_size, nvm_cmd, nvm_offset, resp = 0, param;
|
|
|
|
+ struct qed_hwfn *p_hwfn = QED_LEADING_HWFN(cdev);
|
|
|
|
+ struct qed_ptt *p_ptt;
|
|
|
|
+ int rc = -EINVAL;
|
|
|
|
+
|
|
|
|
+ p_ptt = qed_ptt_acquire(p_hwfn);
|
|
|
|
+ if (!p_ptt)
|
|
|
|
+ return -EBUSY;
|
|
|
|
+
|
|
|
|
+ switch (cmd) {
|
|
|
|
+ case QED_PUT_FILE_DATA:
|
|
|
|
+ nvm_cmd = DRV_MSG_CODE_NVM_PUT_FILE_DATA;
|
|
|
|
+ break;
|
|
|
|
+ case QED_NVM_WRITE_NVRAM:
|
|
|
|
+ nvm_cmd = DRV_MSG_CODE_NVM_WRITE_NVRAM;
|
|
|
|
+ break;
|
|
|
|
+ default:
|
|
|
|
+ DP_NOTICE(p_hwfn, "Invalid nvm write command 0x%x\n", cmd);
|
|
|
|
+ rc = -EINVAL;
|
|
|
|
+ goto out;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ while (buf_idx < len) {
|
|
|
|
+ buf_size = min_t(u32, (len - buf_idx), MCP_DRV_NVM_BUF_LEN);
|
|
|
|
+ nvm_offset = ((buf_size << DRV_MB_PARAM_NVM_LEN_OFFSET) |
|
|
|
|
+ addr) + buf_idx;
|
|
|
|
+ rc = qed_mcp_nvm_wr_cmd(p_hwfn, p_ptt, nvm_cmd, nvm_offset,
|
|
|
|
+ &resp, ¶m, buf_size,
|
|
|
|
+ (u32 *)&p_buf[buf_idx]);
|
|
|
|
+ if (rc) {
|
|
|
|
+ DP_NOTICE(cdev, "nvm write failed, rc = %d\n", rc);
|
|
|
|
+ resp = FW_MSG_CODE_ERROR;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ if (resp != FW_MSG_CODE_OK &&
|
|
|
|
+ resp != FW_MSG_CODE_NVM_OK &&
|
|
|
|
+ resp != FW_MSG_CODE_NVM_PUT_FILE_FINISH_OK) {
|
|
|
|
+ DP_NOTICE(cdev,
|
|
|
|
+ "nvm write failed, resp = 0x%08x\n", resp);
|
|
|
|
+ rc = -EINVAL;
|
|
|
|
+ break;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ /* This can be a lengthy process, and it's possible scheduler
|
|
|
|
+ * isn't pre-emptable. Sleep a bit to prevent CPU hogging.
|
|
|
|
+ */
|
|
|
|
+ if (buf_idx % 0x1000 > (buf_idx + buf_size) % 0x1000)
|
|
|
|
+ usleep_range(1000, 2000);
|
|
|
|
+
|
|
|
|
+ buf_idx += buf_size;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ cdev->mcp_nvm_resp = resp;
|
|
|
|
+out:
|
|
|
|
+ qed_ptt_release(p_hwfn, p_ptt);
|
|
|
|
+
|
|
|
|
+ return rc;
|
|
|
|
+}
|
|
|
|
+
|
|
int qed_mcp_bist_register_test(struct qed_hwfn *p_hwfn, struct qed_ptt *p_ptt)
|
|
int qed_mcp_bist_register_test(struct qed_hwfn *p_hwfn, struct qed_ptt *p_ptt)
|
|
{
|
|
{
|
|
u32 drv_mb_param = 0, rsp, param;
|
|
u32 drv_mb_param = 0, rsp, param;
|