[PATCH OLK-6.6 01/16] crypto: hisilicon/qm - reset device before enabling it

29 Mar 2024

driver inclusion
category: feature
bugzilla: https://gitee.com/openeuler/kernel/issues/I9CB6L
CVE: NA
----------------------------------------------------------------------
When the device is re-enabled, data that has not been cleared
may exist on the device. Therefore, reset the device to
the initial state before enabling the device. If an abnormal
interrupt event is reported when the device is enabled,
the device will not be reset.
Signed-off-by: Weili Qian qianweili@huawei.com
Signed-off-by: JiangShui Yang yangjiangshui@h-partners.com
---
 drivers/crypto/hisilicon/hpre/hpre_main.c |  24 +++--
 drivers/crypto/hisilicon/qm.c             | 115 +++++++++++++++-------
 drivers/crypto/hisilicon/sec2/sec_main.c  |  18 ++--
 drivers/crypto/hisilicon/zip/zip_main.c   |  18 +++-
 4 files changed, 119 insertions(+), 56 deletions(-)

diff --git a/drivers/crypto/hisilicon/hpre/hpre_main.c b/drivers/crypto/hisilicon/hpre/hpre_main.c
index e970dd629234..e11d0b189896 100644
--- a/drivers/crypto/hisilicon/hpre/hpre_main.c
+++ b/drivers/crypto/hisilicon/hpre/hpre_main.c
@@ -357,6 +357,8 @@ static struct dfx_diff_registers hpre_diff_regs[] = {
    },
 };
+static const struct hisi_qm_err_ini hpre_err_ini;
+
 bool hpre_check_alg_support(struct hisi_qm *qm, u32 alg)
 {
    u32 cap_val;
@@ -1161,6 +1163,7 @@ static int hpre_qm_init(struct hisi_qm *qm, struct pci_dev *pdev)
    	qm->qp_num = pf_q_num;
    	qm->debug.curr_qm_qp_num = pf_q_num;
    	qm->qm_list = &hpre_devices;
+		qm->err_ini = &hpre_err_ini;
    	if (pf_q_num_flag)
    		set_bit(QM_MODULE_PARAM, &qm->misc_ctl);
    }
@@ -1224,7 +1227,7 @@ static void hpre_show_last_regs_uninit(struct hisi_qm *qm)
 {
    struct qm_debug *debug = &qm->debug;
-	if (qm->fun_type == QM_HW_VF || !debug->last_words)
+	if (!debug->last_words)
    	return;
kfree(debug->last_words);
@@ -1339,6 +1342,17 @@ static const struct hisi_qm_err_ini hpre_err_ini = {
    .err_info_init		= hpre_err_info_init,
 };
+static void hpre_probe_uninit(struct hisi_qm *qm)
+{
+	if (qm->fun_type == QM_HW_VF)
+		return;
+
+	hpre_cnt_regs_clear(qm);
+	qm->debug.curr_qm_qp_num = 0;
+	hpre_show_last_regs_uninit(qm);
+	hpre_close_sva_prefetch(qm);
+}
+
 static int hpre_pf_probe_init(struct hpre *hpre)
 {
    struct hisi_qm *qm = &hpre->qm;
@@ -1350,8 +1364,6 @@ static int hpre_pf_probe_init(struct hpre *hpre)
hpre_open_sva_prefetch(qm);
-	qm->err_ini = &hpre_err_ini;
-	qm->err_ini->err_info_init(qm);
    hisi_qm_dev_err_init(qm);
    ret = hpre_show_last_regs_init(qm);
    if (ret)
@@ -1445,7 +1457,7 @@ static int hpre_probe(struct pci_dev *pdev, const struct pci_device_id *id)
    hisi_qm_stop(qm, QM_NORMAL);
err_with_err_init:
-	hpre_show_last_regs_uninit(qm);
+	hpre_probe_uninit(qm);
    hisi_qm_dev_err_uninit(qm);
err_with_qm_init:
@@ -1469,9 +1481,7 @@ static void hpre_remove(struct pci_dev *pdev)
    hisi_qm_stop(qm, QM_NORMAL);
if (qm->fun_type == QM_HW_PF) {
-		hpre_cnt_regs_clear(qm);
-		qm->debug.curr_qm_qp_num = 0;
-		hpre_show_last_regs_uninit(qm);
+		hpre_probe_uninit(qm);
    	hisi_qm_dev_err_uninit(qm);
    }
diff --git a/drivers/crypto/hisilicon/qm.c b/drivers/crypto/hisilicon/qm.c
index d9caff12cd4d..bbc94cd6e265 100644
--- a/drivers/crypto/hisilicon/qm.c
+++ b/drivers/crypto/hisilicon/qm.c
@@ -451,6 +451,7 @@ static struct qm_typical_qos_table shaper_cbs_s[] = {
 };
static void qm_irqs_unregister(struct hisi_qm *qm);
+static int qm_reset_device(struct hisi_qm *qm);
static u32 qm_get_hw_error_status(struct hisi_qm *qm)
 {
@@ -4186,6 +4187,23 @@ static int qm_controller_reset_prepare(struct hisi_qm *qm)
    return 0;
 }
+static int qm_master_ooo_check(struct hisi_qm *qm)
+{
+	u32 val;
+	int ret;
+
+	/* Check the ooo register of the device before resetting the device. */
+	writel(ACC_MASTER_GLOBAL_CTRL_SHUTDOWN, qm->io_base + ACC_MASTER_GLOBAL_CTRL);
+	ret = readl_relaxed_poll_timeout(qm->io_base + ACC_MASTER_TRANS_RETURN,
+					 val,
+					 (val == ACC_MASTER_TRANS_RETURN_RW),
+					 POLL_PERIOD, POLL_TIMEOUT);
+	if (ret)
+		pci_warn(qm->pdev, "Bus lock! Please reset system.\n");
+
+	return ret;
+}
+
 static void qm_dev_ecc_mbit_handle(struct hisi_qm *qm)
 {
    u32 nfe_enb = 0;
@@ -4208,11 +4226,10 @@ static void qm_dev_ecc_mbit_handle(struct hisi_qm *qm)
    }
 }
-static int qm_soft_reset(struct hisi_qm *qm)
+static int qm_soft_reset_prepare(struct hisi_qm *qm)
 {
    struct pci_dev *pdev = qm->pdev;
    int ret;
-	u32 val;
/* Ensure all doorbells and mailboxes received by QM */
    ret = qm_check_req_recv(qm);
@@ -4234,29 +4251,23 @@ static int qm_soft_reset(struct hisi_qm *qm)
    }
qm_dev_ecc_mbit_handle(qm);
-
-	/* OOO register set and check */
-	writel(ACC_MASTER_GLOBAL_CTRL_SHUTDOWN,
-	       qm->io_base + ACC_MASTER_GLOBAL_CTRL);
-
-	/* If bus lock, reset chip */
-	ret = readl_relaxed_poll_timeout(qm->io_base + ACC_MASTER_TRANS_RETURN,
-					 val,
-					 (val == ACC_MASTER_TRANS_RETURN_RW),
-					 POLL_PERIOD, POLL_TIMEOUT);
-	if (ret) {
-		pci_emerg(pdev, "Bus lock! Please reset system.\n");
+	ret = qm_master_ooo_check(qm);
+	if (ret)
    	return ret;
-	}
if (qm->err_ini->close_sva_prefetch)
    	qm->err_ini->close_sva_prefetch(qm);
ret = qm_set_pf_mse(qm, false);
-	if (ret) {
+	if (ret)
    	pci_err(pdev, "Fails to disable pf MSE bit.\n");
-		return ret;
-	}
+
+	return ret;
+}
+
+static int qm_reset_device(struct hisi_qm *qm)
+{
+	struct pci_dev *pdev = qm->pdev;
/* The reset related sub-control registers are not in PCI BAR */
    if (ACPI_HANDLE(&pdev->dev)) {
@@ -4275,12 +4286,23 @@ static int qm_soft_reset(struct hisi_qm *qm)
    		pci_err(pdev, "Reset step %llu failed!\n", value);
    		return -EIO;
    	}
-	} else {
-		pci_err(pdev, "No reset method!\n");
-		return -EINVAL;
+
+		return 0;
    }
-	return 0;
+	pci_err(pdev, "No reset method!\n");
+	return -EINVAL;
+}
+
+static int qm_soft_reset(struct hisi_qm *qm)
+{
+	int ret;
+
+	ret = qm_soft_reset_prepare(qm);
+	if (ret)
+		return ret;
+
+	return qm_reset_device(qm);
 }
static int qm_vf_reset_done(struct hisi_qm *qm)
@@ -5233,6 +5255,35 @@ static int qm_get_pci_res(struct hisi_qm *qm)
    return ret;
 }
+static int qm_clear_device(struct hisi_qm *qm)
+{
+	acpi_handle handle = ACPI_HANDLE(&qm->pdev->dev);
+	int ret;
+
+	if (qm->fun_type == QM_HW_VF)
+		return 0;
+
+	/* Device does not support reset, return */
+	if (!qm->err_ini->err_info_init)
+		return 0;
+	qm->err_ini->err_info_init(qm);
+
+	if (!handle)
+		return 0;
+
+	/* No reset method, return */
+	if (!acpi_has_method(handle, qm->err_info.acpi_rst))
+		return 0;
+
+	ret = qm_master_ooo_check(qm);
+	if (ret) {
+		writel(0x0, qm->io_base + ACC_MASTER_GLOBAL_CTRL);
+		return ret;
+	}
+
+	return qm_reset_device(qm);
+}
+
 static int hisi_qm_pci_init(struct hisi_qm *qm)
 {
    struct pci_dev *pdev = qm->pdev;
@@ -5262,8 +5313,14 @@ static int hisi_qm_pci_init(struct hisi_qm *qm)
    	goto err_get_pci_res;
    }
+	ret = qm_clear_device(qm);
+	if (ret)
+		goto err_free_vectors;
+
    return 0;
+err_free_vectors:
+	pci_free_irq_vectors(pdev);
 err_get_pci_res:
    qm_put_pci_res(qm);
 err_disable_pcidev:
@@ -5564,7 +5621,6 @@ static int qm_prepare_for_suspend(struct hisi_qm *qm)
 {
    struct pci_dev *pdev = qm->pdev;
    int ret;
-	u32 val;
ret = qm->ops->set_msi(qm, false);
    if (ret) {
@@ -5572,18 +5628,9 @@ static int qm_prepare_for_suspend(struct hisi_qm *qm)
    	return ret;
    }
-	/* shutdown OOO register */
-	writel(ACC_MASTER_GLOBAL_CTRL_SHUTDOWN,
-	       qm->io_base + ACC_MASTER_GLOBAL_CTRL);
-
-	ret = readl_relaxed_poll_timeout(qm->io_base + ACC_MASTER_TRANS_RETURN,
-					 val,
-					 (val == ACC_MASTER_TRANS_RETURN_RW),
-					 POLL_PERIOD, POLL_TIMEOUT);
-	if (ret) {
-		pci_emerg(pdev, "Bus lock! Please reset system.\n");
+	ret = qm_master_ooo_check(qm);
+	if (ret)
    	return ret;
-	}
ret = qm_set_pf_mse(qm, false);
    if (ret)
diff --git a/drivers/crypto/hisilicon/sec2/sec_main.c b/drivers/crypto/hisilicon/sec2/sec_main.c
index d7047200ee7a..85ca2050f13d 100644
--- a/drivers/crypto/hisilicon/sec2/sec_main.c
+++ b/drivers/crypto/hisilicon/sec2/sec_main.c
@@ -954,7 +954,7 @@ static void sec_show_last_regs_uninit(struct hisi_qm *qm)
 {
    struct qm_debug *debug = &qm->debug;
-	if (qm->fun_type == QM_HW_VF || !debug->last_words)
+	if (!debug->last_words)
    	return;
kfree(debug->last_words);
@@ -1065,9 +1065,6 @@ static int sec_pf_probe_init(struct sec_dev *sec)
    struct hisi_qm *qm = &sec->qm;
    int ret;
-	qm->err_ini = &sec_err_ini;
-	qm->err_ini->err_info_init(qm);
-
    ret = sec_set_user_domain_and_cache(qm);
    if (ret)
    	return ret;
@@ -1122,6 +1119,7 @@ static int sec_qm_init(struct hisi_qm *qm, struct pci_dev *pdev)
    	qm->qp_num = pf_q_num;
    	qm->debug.curr_qm_qp_num = pf_q_num;
    	qm->qm_list = &sec_devices;
+		qm->err_ini = &sec_err_ini;
    	if (pf_q_num_flag)
    		set_bit(QM_MODULE_PARAM, &qm->misc_ctl);
    } else if (qm->fun_type == QM_HW_VF && qm->ver == QM_HW_V1) {
@@ -1186,6 +1184,12 @@ static int sec_probe_init(struct sec_dev *sec)
static void sec_probe_uninit(struct hisi_qm *qm)
 {
+	if (qm->fun_type == QM_HW_VF)
+		return;
+
+	sec_debug_regs_clear(qm);
+	sec_show_last_regs_uninit(qm);
+	sec_close_sva_prefetch(qm);
    hisi_qm_dev_err_uninit(qm);
 }
@@ -1254,7 +1258,6 @@ static int sec_probe(struct pci_dev *pdev, const struct pci_device_id *id)
    sec_debugfs_exit(qm);
    hisi_qm_stop(qm, QM_NORMAL);
 err_probe_uninit:
-	sec_show_last_regs_uninit(qm);
    sec_probe_uninit(qm);
 err_qm_uninit:
    sec_qm_uninit(qm);
@@ -1276,11 +1279,6 @@ static void sec_remove(struct pci_dev *pdev)
    sec_debugfs_exit(qm);
(void)hisi_qm_stop(qm, QM_NORMAL);
-
-	if (qm->fun_type == QM_HW_PF)
-		sec_debug_regs_clear(qm);
-	sec_show_last_regs_uninit(qm);
-
    sec_probe_uninit(qm);
sec_qm_uninit(qm);
diff --git a/drivers/crypto/hisilicon/zip/zip_main.c b/drivers/crypto/hisilicon/zip/zip_main.c
index 6239dc47d8a0..26b4c848ff12 100644
--- a/drivers/crypto/hisilicon/zip/zip_main.c
+++ b/drivers/crypto/hisilicon/zip/zip_main.c
@@ -986,7 +986,7 @@ static void hisi_zip_show_last_regs_uninit(struct hisi_qm *qm)
 {
    struct qm_debug *debug = &qm->debug;
-	if (qm->fun_type == QM_HW_VF || !debug->last_words)
+	if (!debug->last_words)
    	return;
kfree(debug->last_words);
@@ -1150,8 +1150,6 @@ static int hisi_zip_pf_probe_init(struct hisi_zip *hisi_zip)
hisi_zip->ctrl = ctrl;
    ctrl->hisi_zip = hisi_zip;
-	qm->err_ini = &hisi_zip_err_ini;
-	qm->err_ini->err_info_init(qm);
ret = hisi_zip_set_user_domain_and_cache(qm);
    if (ret)
@@ -1212,6 +1210,7 @@ static int hisi_zip_qm_init(struct hisi_qm *qm, struct pci_dev *pdev)
    	qm->qp_num = pf_q_num;
    	qm->debug.curr_qm_qp_num = pf_q_num;
    	qm->qm_list = &zip_devices;
+		qm->err_ini = &hisi_zip_err_ini;
    	if (pf_q_num_flag)
    		set_bit(QM_MODULE_PARAM, &qm->misc_ctl);
    } else if (qm->fun_type == QM_HW_VF && qm->ver == QM_HW_V1) {
@@ -1278,6 +1277,15 @@ static int hisi_zip_probe_init(struct hisi_zip *hisi_zip)
    return 0;
 }
+static void hisi_zip_probe_uninit(struct hisi_qm *qm)
+{
+	if (qm->fun_type == QM_HW_VF)
+		return;
+
+	hisi_zip_show_last_regs_uninit(qm);
+	hisi_zip_close_sva_prefetch(qm);
+}
+
 static int hisi_zip_probe(struct pci_dev *pdev, const struct pci_device_id *id)
 {
    struct hisi_zip *hisi_zip;
@@ -1342,7 +1350,7 @@ static int hisi_zip_probe(struct pci_dev *pdev, const struct pci_device_id *id)
    hisi_qm_stop(qm, QM_NORMAL);
err_dev_err_uninit:
-	hisi_zip_show_last_regs_uninit(qm);
+	hisi_zip_probe_uninit(qm);
    hisi_qm_dev_err_uninit(qm);
err_qm_uninit:
@@ -1365,7 +1373,7 @@ static void hisi_zip_remove(struct pci_dev *pdev)
hisi_zip_debugfs_exit(qm);
    hisi_qm_stop(qm, QM_NORMAL);
-	hisi_zip_show_last_regs_uninit(qm);
+	hisi_zip_probe_uninit(qm);
    hisi_qm_dev_err_uninit(qm);
    hisi_zip_qm_uninit(qm);
 }
-- 
2.33.0


    

2024

2023

2022

2021

2020

2019

[PATCH OLK-6.6 01/16] crypto: hisilicon/qm - reset device before enabling it