treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / crypto / hisilicon / hpre / hpre_main.c
blob401747de67a8723b669d18968319bb0af4fb682b
1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (c) 2018-2019 HiSilicon Limited. */
3 #include <linux/acpi.h>
4 #include <linux/aer.h>
5 #include <linux/bitops.h>
6 #include <linux/debugfs.h>
7 #include <linux/init.h>
8 #include <linux/io.h>
9 #include <linux/kernel.h>
10 #include <linux/module.h>
11 #include <linux/pci.h>
12 #include <linux/topology.h>
13 #include "hpre.h"
15 #define HPRE_VF_NUM 63
16 #define HPRE_QUEUE_NUM_V2 1024
17 #define HPRE_QM_ABNML_INT_MASK 0x100004
18 #define HPRE_CTRL_CNT_CLR_CE_BIT BIT(0)
19 #define HPRE_COMM_CNT_CLR_CE 0x0
20 #define HPRE_CTRL_CNT_CLR_CE 0x301000
21 #define HPRE_FSM_MAX_CNT 0x301008
22 #define HPRE_VFG_AXQOS 0x30100c
23 #define HPRE_VFG_AXCACHE 0x301010
24 #define HPRE_RDCHN_INI_CFG 0x301014
25 #define HPRE_AWUSR_FP_CFG 0x301018
26 #define HPRE_BD_ENDIAN 0x301020
27 #define HPRE_ECC_BYPASS 0x301024
28 #define HPRE_RAS_WIDTH_CFG 0x301028
29 #define HPRE_POISON_BYPASS 0x30102c
30 #define HPRE_BD_ARUSR_CFG 0x301030
31 #define HPRE_BD_AWUSR_CFG 0x301034
32 #define HPRE_TYPES_ENB 0x301038
33 #define HPRE_DATA_RUSER_CFG 0x30103c
34 #define HPRE_DATA_WUSER_CFG 0x301040
35 #define HPRE_INT_MASK 0x301400
36 #define HPRE_INT_STATUS 0x301800
37 #define HPRE_CORE_INT_ENABLE 0
38 #define HPRE_CORE_INT_DISABLE 0x003fffff
39 #define HPRE_RAS_ECC_1BIT_TH 0x30140c
40 #define HPRE_RDCHN_INI_ST 0x301a00
41 #define HPRE_CLSTR_BASE 0x302000
42 #define HPRE_CORE_EN_OFFSET 0x04
43 #define HPRE_CORE_INI_CFG_OFFSET 0x20
44 #define HPRE_CORE_INI_STATUS_OFFSET 0x80
45 #define HPRE_CORE_HTBT_WARN_OFFSET 0x8c
46 #define HPRE_CORE_IS_SCHD_OFFSET 0x90
48 #define HPRE_RAS_CE_ENB 0x301410
49 #define HPRE_HAC_RAS_CE_ENABLE 0x3f
50 #define HPRE_RAS_NFE_ENB 0x301414
51 #define HPRE_HAC_RAS_NFE_ENABLE 0x3fffc0
52 #define HPRE_RAS_FE_ENB 0x301418
53 #define HPRE_HAC_RAS_FE_ENABLE 0
55 #define HPRE_CORE_ENB (HPRE_CLSTR_BASE + HPRE_CORE_EN_OFFSET)
56 #define HPRE_CORE_INI_CFG (HPRE_CLSTR_BASE + HPRE_CORE_INI_CFG_OFFSET)
57 #define HPRE_CORE_INI_STATUS (HPRE_CLSTR_BASE + HPRE_CORE_INI_STATUS_OFFSET)
58 #define HPRE_HAC_ECC1_CNT 0x301a04
59 #define HPRE_HAC_ECC2_CNT 0x301a08
60 #define HPRE_HAC_INT_STATUS 0x301800
61 #define HPRE_HAC_SOURCE_INT 0x301600
62 #define MASTER_GLOBAL_CTRL_SHUTDOWN 1
63 #define MASTER_TRANS_RETURN_RW 3
64 #define HPRE_MASTER_TRANS_RETURN 0x300150
65 #define HPRE_MASTER_GLOBAL_CTRL 0x300000
66 #define HPRE_CLSTR_ADDR_INTRVL 0x1000
67 #define HPRE_CLUSTER_INQURY 0x100
68 #define HPRE_CLSTR_ADDR_INQRY_RSLT 0x104
69 #define HPRE_TIMEOUT_ABNML_BIT 6
70 #define HPRE_PASID_EN_BIT 9
71 #define HPRE_REG_RD_INTVRL_US 10
72 #define HPRE_REG_RD_TMOUT_US 1000
73 #define HPRE_DBGFS_VAL_MAX_LEN 20
74 #define HPRE_PCI_DEVICE_ID 0xa258
75 #define HPRE_PCI_VF_DEVICE_ID 0xa259
76 #define HPRE_ADDR(qm, offset) ((qm)->io_base + (offset))
77 #define HPRE_QM_USR_CFG_MASK 0xfffffffe
78 #define HPRE_QM_AXI_CFG_MASK 0xffff
79 #define HPRE_QM_VFG_AX_MASK 0xff
80 #define HPRE_BD_USR_MASK 0x3
81 #define HPRE_CLUSTER_CORE_MASK 0xf
83 #define HPRE_VIA_MSI_DSM 1
85 static LIST_HEAD(hpre_list);
86 static DEFINE_MUTEX(hpre_list_lock);
87 static const char hpre_name[] = "hisi_hpre";
88 static struct dentry *hpre_debugfs_root;
89 static const struct pci_device_id hpre_dev_ids[] = {
90 { PCI_DEVICE(PCI_VENDOR_ID_HUAWEI, HPRE_PCI_DEVICE_ID) },
91 { PCI_DEVICE(PCI_VENDOR_ID_HUAWEI, HPRE_PCI_VF_DEVICE_ID) },
92 { 0, }
95 MODULE_DEVICE_TABLE(pci, hpre_dev_ids);
97 struct hpre_hw_error {
98 u32 int_msk;
99 const char *msg;
102 static const char * const hpre_debug_file_name[] = {
103 [HPRE_CURRENT_QM] = "current_qm",
104 [HPRE_CLEAR_ENABLE] = "rdclr_en",
105 [HPRE_CLUSTER_CTRL] = "cluster_ctrl",
108 static const struct hpre_hw_error hpre_hw_errors[] = {
109 { .int_msk = BIT(0), .msg = "core_ecc_1bit_err_int_set" },
110 { .int_msk = BIT(1), .msg = "core_ecc_2bit_err_int_set" },
111 { .int_msk = BIT(2), .msg = "dat_wb_poison_int_set" },
112 { .int_msk = BIT(3), .msg = "dat_rd_poison_int_set" },
113 { .int_msk = BIT(4), .msg = "bd_rd_poison_int_set" },
114 { .int_msk = BIT(5), .msg = "ooo_ecc_2bit_err_int_set" },
115 { .int_msk = BIT(6), .msg = "cluster1_shb_timeout_int_set" },
116 { .int_msk = BIT(7), .msg = "cluster2_shb_timeout_int_set" },
117 { .int_msk = BIT(8), .msg = "cluster3_shb_timeout_int_set" },
118 { .int_msk = BIT(9), .msg = "cluster4_shb_timeout_int_set" },
119 { .int_msk = GENMASK(15, 10), .msg = "ooo_rdrsp_err_int_set" },
120 { .int_msk = GENMASK(21, 16), .msg = "ooo_wrrsp_err_int_set" },
121 { /* sentinel */ }
124 static const u64 hpre_cluster_offsets[] = {
125 [HPRE_CLUSTER0] =
126 HPRE_CLSTR_BASE + HPRE_CLUSTER0 * HPRE_CLSTR_ADDR_INTRVL,
127 [HPRE_CLUSTER1] =
128 HPRE_CLSTR_BASE + HPRE_CLUSTER1 * HPRE_CLSTR_ADDR_INTRVL,
129 [HPRE_CLUSTER2] =
130 HPRE_CLSTR_BASE + HPRE_CLUSTER2 * HPRE_CLSTR_ADDR_INTRVL,
131 [HPRE_CLUSTER3] =
132 HPRE_CLSTR_BASE + HPRE_CLUSTER3 * HPRE_CLSTR_ADDR_INTRVL,
135 static struct debugfs_reg32 hpre_cluster_dfx_regs[] = {
136 {"CORES_EN_STATUS ", HPRE_CORE_EN_OFFSET},
137 {"CORES_INI_CFG ", HPRE_CORE_INI_CFG_OFFSET},
138 {"CORES_INI_STATUS ", HPRE_CORE_INI_STATUS_OFFSET},
139 {"CORES_HTBT_WARN ", HPRE_CORE_HTBT_WARN_OFFSET},
140 {"CORES_IS_SCHD ", HPRE_CORE_IS_SCHD_OFFSET},
143 static struct debugfs_reg32 hpre_com_dfx_regs[] = {
144 {"READ_CLR_EN ", HPRE_CTRL_CNT_CLR_CE},
145 {"AXQOS ", HPRE_VFG_AXQOS},
146 {"AWUSR_CFG ", HPRE_AWUSR_FP_CFG},
147 {"QM_ARUSR_MCFG1 ", QM_ARUSER_M_CFG_1},
148 {"QM_AWUSR_MCFG1 ", QM_AWUSER_M_CFG_1},
149 {"BD_ENDIAN ", HPRE_BD_ENDIAN},
150 {"ECC_CHECK_CTRL ", HPRE_ECC_BYPASS},
151 {"RAS_INT_WIDTH ", HPRE_RAS_WIDTH_CFG},
152 {"POISON_BYPASS ", HPRE_POISON_BYPASS},
153 {"BD_ARUSER ", HPRE_BD_ARUSR_CFG},
154 {"BD_AWUSER ", HPRE_BD_AWUSR_CFG},
155 {"DATA_ARUSER ", HPRE_DATA_RUSER_CFG},
156 {"DATA_AWUSER ", HPRE_DATA_WUSER_CFG},
157 {"INT_STATUS ", HPRE_INT_STATUS},
160 static int hpre_pf_q_num_set(const char *val, const struct kernel_param *kp)
162 struct pci_dev *pdev;
163 u32 n, q_num;
164 u8 rev_id;
165 int ret;
167 if (!val)
168 return -EINVAL;
170 pdev = pci_get_device(PCI_VENDOR_ID_HUAWEI, HPRE_PCI_DEVICE_ID, NULL);
171 if (!pdev) {
172 q_num = HPRE_QUEUE_NUM_V2;
173 pr_info("No device found currently, suppose queue number is %d\n",
174 q_num);
175 } else {
176 rev_id = pdev->revision;
177 if (rev_id != QM_HW_V2)
178 return -EINVAL;
180 q_num = HPRE_QUEUE_NUM_V2;
183 ret = kstrtou32(val, 10, &n);
184 if (ret != 0 || n == 0 || n > q_num)
185 return -EINVAL;
187 return param_set_int(val, kp);
190 static const struct kernel_param_ops hpre_pf_q_num_ops = {
191 .set = hpre_pf_q_num_set,
192 .get = param_get_int,
195 static u32 hpre_pf_q_num = HPRE_PF_DEF_Q_NUM;
196 module_param_cb(hpre_pf_q_num, &hpre_pf_q_num_ops, &hpre_pf_q_num, 0444);
197 MODULE_PARM_DESC(hpre_pf_q_num, "Number of queues in PF of CS(1-1024)");
199 static inline void hpre_add_to_list(struct hpre *hpre)
201 mutex_lock(&hpre_list_lock);
202 list_add_tail(&hpre->list, &hpre_list);
203 mutex_unlock(&hpre_list_lock);
206 static inline void hpre_remove_from_list(struct hpre *hpre)
208 mutex_lock(&hpre_list_lock);
209 list_del(&hpre->list);
210 mutex_unlock(&hpre_list_lock);
213 struct hpre *hpre_find_device(int node)
215 struct hpre *hpre, *ret = NULL;
216 int min_distance = INT_MAX;
217 struct device *dev;
218 int dev_node = 0;
220 mutex_lock(&hpre_list_lock);
221 list_for_each_entry(hpre, &hpre_list, list) {
222 dev = &hpre->qm.pdev->dev;
223 #ifdef CONFIG_NUMA
224 dev_node = dev->numa_node;
225 if (dev_node < 0)
226 dev_node = 0;
227 #endif
228 if (node_distance(dev_node, node) < min_distance) {
229 ret = hpre;
230 min_distance = node_distance(dev_node, node);
233 mutex_unlock(&hpre_list_lock);
235 return ret;
238 static int hpre_cfg_by_dsm(struct hisi_qm *qm)
240 struct device *dev = &qm->pdev->dev;
241 union acpi_object *obj;
242 guid_t guid;
244 if (guid_parse("b06b81ab-0134-4a45-9b0c-483447b95fa7", &guid)) {
245 dev_err(dev, "Hpre GUID failed\n");
246 return -EINVAL;
249 /* Switch over to MSI handling due to non-standard PCI implementation */
250 obj = acpi_evaluate_dsm(ACPI_HANDLE(dev), &guid,
251 0, HPRE_VIA_MSI_DSM, NULL);
252 if (!obj) {
253 dev_err(dev, "ACPI handle failed!\n");
254 return -EIO;
257 ACPI_FREE(obj);
259 return 0;
262 static int hpre_set_user_domain_and_cache(struct hpre *hpre)
264 struct hisi_qm *qm = &hpre->qm;
265 struct device *dev = &qm->pdev->dev;
266 unsigned long offset;
267 int ret, i;
268 u32 val;
270 writel(HPRE_QM_USR_CFG_MASK, HPRE_ADDR(qm, QM_ARUSER_M_CFG_ENABLE));
271 writel(HPRE_QM_USR_CFG_MASK, HPRE_ADDR(qm, QM_AWUSER_M_CFG_ENABLE));
272 writel_relaxed(HPRE_QM_AXI_CFG_MASK, HPRE_ADDR(qm, QM_AXI_M_CFG));
274 /* disable FLR triggered by BME(bus master enable) */
275 writel(PEH_AXUSER_CFG, HPRE_ADDR(qm, QM_PEH_AXUSER_CFG));
276 writel(PEH_AXUSER_CFG_ENABLE, HPRE_ADDR(qm, QM_PEH_AXUSER_CFG_ENABLE));
278 /* HPRE need more time, we close this interrupt */
279 val = readl_relaxed(HPRE_ADDR(qm, HPRE_QM_ABNML_INT_MASK));
280 val |= BIT(HPRE_TIMEOUT_ABNML_BIT);
281 writel_relaxed(val, HPRE_ADDR(qm, HPRE_QM_ABNML_INT_MASK));
283 writel(0x1, HPRE_ADDR(qm, HPRE_TYPES_ENB));
284 writel(HPRE_QM_VFG_AX_MASK, HPRE_ADDR(qm, HPRE_VFG_AXCACHE));
285 writel(0x0, HPRE_ADDR(qm, HPRE_BD_ENDIAN));
286 writel(0x0, HPRE_ADDR(qm, HPRE_INT_MASK));
287 writel(0x0, HPRE_ADDR(qm, HPRE_RAS_ECC_1BIT_TH));
288 writel(0x0, HPRE_ADDR(qm, HPRE_POISON_BYPASS));
289 writel(0x0, HPRE_ADDR(qm, HPRE_COMM_CNT_CLR_CE));
290 writel(0x0, HPRE_ADDR(qm, HPRE_ECC_BYPASS));
292 writel(HPRE_BD_USR_MASK, HPRE_ADDR(qm, HPRE_BD_ARUSR_CFG));
293 writel(HPRE_BD_USR_MASK, HPRE_ADDR(qm, HPRE_BD_AWUSR_CFG));
294 writel(0x1, HPRE_ADDR(qm, HPRE_RDCHN_INI_CFG));
295 ret = readl_relaxed_poll_timeout(HPRE_ADDR(qm, HPRE_RDCHN_INI_ST), val,
296 val & BIT(0),
297 HPRE_REG_RD_INTVRL_US,
298 HPRE_REG_RD_TMOUT_US);
299 if (ret) {
300 dev_err(dev, "read rd channel timeout fail!\n");
301 return -ETIMEDOUT;
304 for (i = 0; i < HPRE_CLUSTERS_NUM; i++) {
305 offset = i * HPRE_CLSTR_ADDR_INTRVL;
307 /* clusters initiating */
308 writel(HPRE_CLUSTER_CORE_MASK,
309 HPRE_ADDR(qm, offset + HPRE_CORE_ENB));
310 writel(0x1, HPRE_ADDR(qm, offset + HPRE_CORE_INI_CFG));
311 ret = readl_relaxed_poll_timeout(HPRE_ADDR(qm, offset +
312 HPRE_CORE_INI_STATUS), val,
313 ((val & HPRE_CLUSTER_CORE_MASK) ==
314 HPRE_CLUSTER_CORE_MASK),
315 HPRE_REG_RD_INTVRL_US,
316 HPRE_REG_RD_TMOUT_US);
317 if (ret) {
318 dev_err(dev,
319 "cluster %d int st status timeout!\n", i);
320 return -ETIMEDOUT;
324 ret = hpre_cfg_by_dsm(qm);
325 if (ret)
326 dev_err(dev, "acpi_evaluate_dsm err.\n");
328 return ret;
331 static void hpre_cnt_regs_clear(struct hisi_qm *qm)
333 unsigned long offset;
334 int i;
336 /* clear current_qm */
337 writel(0x0, qm->io_base + QM_DFX_MB_CNT_VF);
338 writel(0x0, qm->io_base + QM_DFX_DB_CNT_VF);
340 /* clear clusterX/cluster_ctrl */
341 for (i = 0; i < HPRE_CLUSTERS_NUM; i++) {
342 offset = HPRE_CLSTR_BASE + i * HPRE_CLSTR_ADDR_INTRVL;
343 writel(0x0, qm->io_base + offset + HPRE_CLUSTER_INQURY);
346 /* clear rdclr_en */
347 writel(0x0, qm->io_base + HPRE_CTRL_CNT_CLR_CE);
349 hisi_qm_debug_regs_clear(qm);
352 static void hpre_hw_error_disable(struct hpre *hpre)
354 struct hisi_qm *qm = &hpre->qm;
356 /* disable hpre hw error interrupts */
357 writel(HPRE_CORE_INT_DISABLE, qm->io_base + HPRE_INT_MASK);
360 static void hpre_hw_error_enable(struct hpre *hpre)
362 struct hisi_qm *qm = &hpre->qm;
364 /* enable hpre hw error interrupts */
365 writel(HPRE_CORE_INT_ENABLE, qm->io_base + HPRE_INT_MASK);
366 writel(HPRE_HAC_RAS_CE_ENABLE, qm->io_base + HPRE_RAS_CE_ENB);
367 writel(HPRE_HAC_RAS_NFE_ENABLE, qm->io_base + HPRE_RAS_NFE_ENB);
368 writel(HPRE_HAC_RAS_FE_ENABLE, qm->io_base + HPRE_RAS_FE_ENB);
371 static inline struct hisi_qm *hpre_file_to_qm(struct hpre_debugfs_file *file)
373 struct hpre *hpre = container_of(file->debug, struct hpre, debug);
375 return &hpre->qm;
378 static u32 hpre_current_qm_read(struct hpre_debugfs_file *file)
380 struct hisi_qm *qm = hpre_file_to_qm(file);
382 return readl(qm->io_base + QM_DFX_MB_CNT_VF);
385 static int hpre_current_qm_write(struct hpre_debugfs_file *file, u32 val)
387 struct hisi_qm *qm = hpre_file_to_qm(file);
388 struct hpre_debug *debug = file->debug;
389 struct hpre *hpre = container_of(debug, struct hpre, debug);
390 u32 num_vfs = hpre->num_vfs;
391 u32 vfq_num, tmp;
394 if (val > num_vfs)
395 return -EINVAL;
397 /* According PF or VF Dev ID to calculation curr_qm_qp_num and store */
398 if (val == 0) {
399 qm->debug.curr_qm_qp_num = qm->qp_num;
400 } else {
401 vfq_num = (qm->ctrl_qp_num - qm->qp_num) / num_vfs;
402 if (val == num_vfs) {
403 qm->debug.curr_qm_qp_num =
404 qm->ctrl_qp_num - qm->qp_num - (num_vfs - 1) * vfq_num;
405 } else {
406 qm->debug.curr_qm_qp_num = vfq_num;
410 writel(val, qm->io_base + QM_DFX_MB_CNT_VF);
411 writel(val, qm->io_base + QM_DFX_DB_CNT_VF);
413 tmp = val |
414 (readl(qm->io_base + QM_DFX_SQE_CNT_VF_SQN) & CURRENT_Q_MASK);
415 writel(tmp, qm->io_base + QM_DFX_SQE_CNT_VF_SQN);
417 tmp = val |
418 (readl(qm->io_base + QM_DFX_CQE_CNT_VF_CQN) & CURRENT_Q_MASK);
419 writel(tmp, qm->io_base + QM_DFX_CQE_CNT_VF_CQN);
421 return 0;
424 static u32 hpre_clear_enable_read(struct hpre_debugfs_file *file)
426 struct hisi_qm *qm = hpre_file_to_qm(file);
428 return readl(qm->io_base + HPRE_CTRL_CNT_CLR_CE) &
429 HPRE_CTRL_CNT_CLR_CE_BIT;
432 static int hpre_clear_enable_write(struct hpre_debugfs_file *file, u32 val)
434 struct hisi_qm *qm = hpre_file_to_qm(file);
435 u32 tmp;
437 if (val != 1 && val != 0)
438 return -EINVAL;
440 tmp = (readl(qm->io_base + HPRE_CTRL_CNT_CLR_CE) &
441 ~HPRE_CTRL_CNT_CLR_CE_BIT) | val;
442 writel(tmp, qm->io_base + HPRE_CTRL_CNT_CLR_CE);
444 return 0;
447 static u32 hpre_cluster_inqry_read(struct hpre_debugfs_file *file)
449 struct hisi_qm *qm = hpre_file_to_qm(file);
450 int cluster_index = file->index - HPRE_CLUSTER_CTRL;
451 unsigned long offset = HPRE_CLSTR_BASE +
452 cluster_index * HPRE_CLSTR_ADDR_INTRVL;
454 return readl(qm->io_base + offset + HPRE_CLSTR_ADDR_INQRY_RSLT);
457 static int hpre_cluster_inqry_write(struct hpre_debugfs_file *file, u32 val)
459 struct hisi_qm *qm = hpre_file_to_qm(file);
460 int cluster_index = file->index - HPRE_CLUSTER_CTRL;
461 unsigned long offset = HPRE_CLSTR_BASE + cluster_index *
462 HPRE_CLSTR_ADDR_INTRVL;
464 writel(val, qm->io_base + offset + HPRE_CLUSTER_INQURY);
466 return 0;
469 static ssize_t hpre_ctrl_debug_read(struct file *filp, char __user *buf,
470 size_t count, loff_t *pos)
472 struct hpre_debugfs_file *file = filp->private_data;
473 char tbuf[HPRE_DBGFS_VAL_MAX_LEN];
474 u32 val;
475 int ret;
477 spin_lock_irq(&file->lock);
478 switch (file->type) {
479 case HPRE_CURRENT_QM:
480 val = hpre_current_qm_read(file);
481 break;
482 case HPRE_CLEAR_ENABLE:
483 val = hpre_clear_enable_read(file);
484 break;
485 case HPRE_CLUSTER_CTRL:
486 val = hpre_cluster_inqry_read(file);
487 break;
488 default:
489 spin_unlock_irq(&file->lock);
490 return -EINVAL;
492 spin_unlock_irq(&file->lock);
493 ret = snprintf(tbuf, HPRE_DBGFS_VAL_MAX_LEN, "%u\n", val);
494 return simple_read_from_buffer(buf, count, pos, tbuf, ret);
497 static ssize_t hpre_ctrl_debug_write(struct file *filp, const char __user *buf,
498 size_t count, loff_t *pos)
500 struct hpre_debugfs_file *file = filp->private_data;
501 char tbuf[HPRE_DBGFS_VAL_MAX_LEN];
502 unsigned long val;
503 int len, ret;
505 if (*pos != 0)
506 return 0;
508 if (count >= HPRE_DBGFS_VAL_MAX_LEN)
509 return -ENOSPC;
511 len = simple_write_to_buffer(tbuf, HPRE_DBGFS_VAL_MAX_LEN - 1,
512 pos, buf, count);
513 if (len < 0)
514 return len;
516 tbuf[len] = '\0';
517 if (kstrtoul(tbuf, 0, &val))
518 return -EFAULT;
520 spin_lock_irq(&file->lock);
521 switch (file->type) {
522 case HPRE_CURRENT_QM:
523 ret = hpre_current_qm_write(file, val);
524 if (ret)
525 goto err_input;
526 break;
527 case HPRE_CLEAR_ENABLE:
528 ret = hpre_clear_enable_write(file, val);
529 if (ret)
530 goto err_input;
531 break;
532 case HPRE_CLUSTER_CTRL:
533 ret = hpre_cluster_inqry_write(file, val);
534 if (ret)
535 goto err_input;
536 break;
537 default:
538 ret = -EINVAL;
539 goto err_input;
541 spin_unlock_irq(&file->lock);
543 return count;
545 err_input:
546 spin_unlock_irq(&file->lock);
547 return ret;
550 static const struct file_operations hpre_ctrl_debug_fops = {
551 .owner = THIS_MODULE,
552 .open = simple_open,
553 .read = hpre_ctrl_debug_read,
554 .write = hpre_ctrl_debug_write,
557 static int hpre_create_debugfs_file(struct hpre_debug *dbg, struct dentry *dir,
558 enum hpre_ctrl_dbgfs_file type, int indx)
560 struct dentry *file_dir;
562 if (dir)
563 file_dir = dir;
564 else
565 file_dir = dbg->debug_root;
567 if (type >= HPRE_DEBUG_FILE_NUM)
568 return -EINVAL;
570 spin_lock_init(&dbg->files[indx].lock);
571 dbg->files[indx].debug = dbg;
572 dbg->files[indx].type = type;
573 dbg->files[indx].index = indx;
574 debugfs_create_file(hpre_debug_file_name[type], 0600, file_dir,
575 dbg->files + indx, &hpre_ctrl_debug_fops);
577 return 0;
580 static int hpre_pf_comm_regs_debugfs_init(struct hpre_debug *debug)
582 struct hpre *hpre = container_of(debug, struct hpre, debug);
583 struct hisi_qm *qm = &hpre->qm;
584 struct device *dev = &qm->pdev->dev;
585 struct debugfs_regset32 *regset;
587 regset = devm_kzalloc(dev, sizeof(*regset), GFP_KERNEL);
588 if (!regset)
589 return -ENOMEM;
591 regset->regs = hpre_com_dfx_regs;
592 regset->nregs = ARRAY_SIZE(hpre_com_dfx_regs);
593 regset->base = qm->io_base;
595 debugfs_create_regset32("regs", 0444, debug->debug_root, regset);
596 return 0;
599 static int hpre_cluster_debugfs_init(struct hpre_debug *debug)
601 struct hpre *hpre = container_of(debug, struct hpre, debug);
602 struct hisi_qm *qm = &hpre->qm;
603 struct device *dev = &qm->pdev->dev;
604 char buf[HPRE_DBGFS_VAL_MAX_LEN];
605 struct debugfs_regset32 *regset;
606 struct dentry *tmp_d;
607 int i, ret;
609 for (i = 0; i < HPRE_CLUSTERS_NUM; i++) {
610 ret = snprintf(buf, HPRE_DBGFS_VAL_MAX_LEN, "cluster%d", i);
611 if (ret < 0)
612 return -EINVAL;
613 tmp_d = debugfs_create_dir(buf, debug->debug_root);
615 regset = devm_kzalloc(dev, sizeof(*regset), GFP_KERNEL);
616 if (!regset)
617 return -ENOMEM;
619 regset->regs = hpre_cluster_dfx_regs;
620 regset->nregs = ARRAY_SIZE(hpre_cluster_dfx_regs);
621 regset->base = qm->io_base + hpre_cluster_offsets[i];
623 debugfs_create_regset32("regs", 0444, tmp_d, regset);
624 ret = hpre_create_debugfs_file(debug, tmp_d, HPRE_CLUSTER_CTRL,
625 i + HPRE_CLUSTER_CTRL);
626 if (ret)
627 return ret;
630 return 0;
633 static int hpre_ctrl_debug_init(struct hpre_debug *debug)
635 int ret;
637 ret = hpre_create_debugfs_file(debug, NULL, HPRE_CURRENT_QM,
638 HPRE_CURRENT_QM);
639 if (ret)
640 return ret;
642 ret = hpre_create_debugfs_file(debug, NULL, HPRE_CLEAR_ENABLE,
643 HPRE_CLEAR_ENABLE);
644 if (ret)
645 return ret;
647 ret = hpre_pf_comm_regs_debugfs_init(debug);
648 if (ret)
649 return ret;
651 return hpre_cluster_debugfs_init(debug);
654 static int hpre_debugfs_init(struct hpre *hpre)
656 struct hisi_qm *qm = &hpre->qm;
657 struct device *dev = &qm->pdev->dev;
658 struct dentry *dir;
659 int ret;
661 dir = debugfs_create_dir(dev_name(dev), hpre_debugfs_root);
662 qm->debug.debug_root = dir;
664 ret = hisi_qm_debug_init(qm);
665 if (ret)
666 goto failed_to_create;
668 if (qm->pdev->device == HPRE_PCI_DEVICE_ID) {
669 hpre->debug.debug_root = dir;
670 ret = hpre_ctrl_debug_init(&hpre->debug);
671 if (ret)
672 goto failed_to_create;
674 return 0;
676 failed_to_create:
677 debugfs_remove_recursive(qm->debug.debug_root);
678 return ret;
681 static void hpre_debugfs_exit(struct hpre *hpre)
683 struct hisi_qm *qm = &hpre->qm;
685 debugfs_remove_recursive(qm->debug.debug_root);
688 static int hpre_qm_pre_init(struct hisi_qm *qm, struct pci_dev *pdev)
690 enum qm_hw_ver rev_id;
692 rev_id = hisi_qm_get_hw_version(pdev);
693 if (rev_id < 0)
694 return -ENODEV;
696 if (rev_id == QM_HW_V1) {
697 pci_warn(pdev, "HPRE version 1 is not supported!\n");
698 return -EINVAL;
701 qm->pdev = pdev;
702 qm->ver = rev_id;
703 qm->sqe_size = HPRE_SQE_SIZE;
704 qm->dev_name = hpre_name;
705 qm->fun_type = (pdev->device == HPRE_PCI_DEVICE_ID) ?
706 QM_HW_PF : QM_HW_VF;
707 if (pdev->is_physfn) {
708 qm->qp_base = HPRE_PF_DEF_Q_BASE;
709 qm->qp_num = hpre_pf_q_num;
711 qm->use_dma_api = true;
713 return 0;
716 static void hpre_hw_err_init(struct hpre *hpre)
718 hisi_qm_hw_error_init(&hpre->qm, QM_BASE_CE, QM_BASE_NFE,
719 0, QM_DB_RANDOM_INVALID);
720 hpre_hw_error_enable(hpre);
723 static int hpre_pf_probe_init(struct hpre *hpre)
725 struct hisi_qm *qm = &hpre->qm;
726 int ret;
728 qm->ctrl_qp_num = HPRE_QUEUE_NUM_V2;
730 ret = hpre_set_user_domain_and_cache(hpre);
731 if (ret)
732 return ret;
734 hpre_hw_err_init(hpre);
736 return 0;
739 static int hpre_probe(struct pci_dev *pdev, const struct pci_device_id *id)
741 struct hisi_qm *qm;
742 struct hpre *hpre;
743 int ret;
745 hpre = devm_kzalloc(&pdev->dev, sizeof(*hpre), GFP_KERNEL);
746 if (!hpre)
747 return -ENOMEM;
749 pci_set_drvdata(pdev, hpre);
751 qm = &hpre->qm;
752 ret = hpre_qm_pre_init(qm, pdev);
753 if (ret)
754 return ret;
756 ret = hisi_qm_init(qm);
757 if (ret)
758 return ret;
760 if (pdev->is_physfn) {
761 ret = hpre_pf_probe_init(hpre);
762 if (ret)
763 goto err_with_qm_init;
764 } else if (qm->fun_type == QM_HW_VF && qm->ver == QM_HW_V2) {
765 /* v2 starts to support get vft by mailbox */
766 ret = hisi_qm_get_vft(qm, &qm->qp_base, &qm->qp_num);
767 if (ret)
768 goto err_with_qm_init;
771 ret = hisi_qm_start(qm);
772 if (ret)
773 goto err_with_err_init;
775 ret = hpre_debugfs_init(hpre);
776 if (ret)
777 dev_warn(&pdev->dev, "init debugfs fail!\n");
779 hpre_add_to_list(hpre);
781 ret = hpre_algs_register();
782 if (ret < 0) {
783 hpre_remove_from_list(hpre);
784 pci_err(pdev, "fail to register algs to crypto!\n");
785 goto err_with_qm_start;
787 return 0;
789 err_with_qm_start:
790 hisi_qm_stop(qm);
792 err_with_err_init:
793 if (pdev->is_physfn)
794 hpre_hw_error_disable(hpre);
796 err_with_qm_init:
797 hisi_qm_uninit(qm);
799 return ret;
802 static int hpre_vf_q_assign(struct hpre *hpre, int num_vfs)
804 struct hisi_qm *qm = &hpre->qm;
805 u32 qp_num = qm->qp_num;
806 int q_num, remain_q_num, i;
807 u32 q_base = qp_num;
808 int ret;
810 if (!num_vfs)
811 return -EINVAL;
813 remain_q_num = qm->ctrl_qp_num - qp_num;
815 /* If remaining queues are not enough, return error. */
816 if (remain_q_num < num_vfs)
817 return -EINVAL;
819 q_num = remain_q_num / num_vfs;
820 for (i = 1; i <= num_vfs; i++) {
821 if (i == num_vfs)
822 q_num += remain_q_num % num_vfs;
823 ret = hisi_qm_set_vft(qm, i, q_base, (u32)q_num);
824 if (ret)
825 return ret;
826 q_base += q_num;
829 return 0;
832 static int hpre_clear_vft_config(struct hpre *hpre)
834 struct hisi_qm *qm = &hpre->qm;
835 u32 num_vfs = hpre->num_vfs;
836 int ret;
837 u32 i;
839 for (i = 1; i <= num_vfs; i++) {
840 ret = hisi_qm_set_vft(qm, i, 0, 0);
841 if (ret)
842 return ret;
844 hpre->num_vfs = 0;
846 return 0;
849 static int hpre_sriov_enable(struct pci_dev *pdev, int max_vfs)
851 struct hpre *hpre = pci_get_drvdata(pdev);
852 int pre_existing_vfs, num_vfs, ret;
854 pre_existing_vfs = pci_num_vf(pdev);
855 if (pre_existing_vfs) {
856 pci_err(pdev,
857 "Can't enable VF. Please disable pre-enabled VFs!\n");
858 return 0;
861 num_vfs = min_t(int, max_vfs, HPRE_VF_NUM);
862 ret = hpre_vf_q_assign(hpre, num_vfs);
863 if (ret) {
864 pci_err(pdev, "Can't assign queues for VF!\n");
865 return ret;
868 hpre->num_vfs = num_vfs;
870 ret = pci_enable_sriov(pdev, num_vfs);
871 if (ret) {
872 pci_err(pdev, "Can't enable VF!\n");
873 hpre_clear_vft_config(hpre);
874 return ret;
877 return num_vfs;
880 static int hpre_sriov_disable(struct pci_dev *pdev)
882 struct hpre *hpre = pci_get_drvdata(pdev);
884 if (pci_vfs_assigned(pdev)) {
885 pci_err(pdev, "Failed to disable VFs while VFs are assigned!\n");
886 return -EPERM;
889 /* remove in hpre_pci_driver will be called to free VF resources */
890 pci_disable_sriov(pdev);
892 return hpre_clear_vft_config(hpre);
895 static int hpre_sriov_configure(struct pci_dev *pdev, int num_vfs)
897 if (num_vfs)
898 return hpre_sriov_enable(pdev, num_vfs);
899 else
900 return hpre_sriov_disable(pdev);
903 static void hpre_remove(struct pci_dev *pdev)
905 struct hpre *hpre = pci_get_drvdata(pdev);
906 struct hisi_qm *qm = &hpre->qm;
907 int ret;
909 hpre_algs_unregister();
910 hpre_remove_from_list(hpre);
911 if (qm->fun_type == QM_HW_PF && hpre->num_vfs != 0) {
912 ret = hpre_sriov_disable(pdev);
913 if (ret) {
914 pci_err(pdev, "Disable SRIOV fail!\n");
915 return;
918 if (qm->fun_type == QM_HW_PF) {
919 hpre_cnt_regs_clear(qm);
920 qm->debug.curr_qm_qp_num = 0;
923 hpre_debugfs_exit(hpre);
924 hisi_qm_stop(qm);
925 if (qm->fun_type == QM_HW_PF)
926 hpre_hw_error_disable(hpre);
927 hisi_qm_uninit(qm);
930 static void hpre_log_hw_error(struct hpre *hpre, u32 err_sts)
932 const struct hpre_hw_error *err = hpre_hw_errors;
933 struct device *dev = &hpre->qm.pdev->dev;
935 while (err->msg) {
936 if (err->int_msk & err_sts)
937 dev_warn(dev, "%s [error status=0x%x] found\n",
938 err->msg, err->int_msk);
939 err++;
943 static pci_ers_result_t hpre_hw_error_handle(struct hpre *hpre)
945 u32 err_sts;
947 /* read err sts */
948 err_sts = readl(hpre->qm.io_base + HPRE_HAC_INT_STATUS);
949 if (err_sts) {
950 hpre_log_hw_error(hpre, err_sts);
952 /* clear error interrupts */
953 writel(err_sts, hpre->qm.io_base + HPRE_HAC_SOURCE_INT);
954 return PCI_ERS_RESULT_NEED_RESET;
957 return PCI_ERS_RESULT_RECOVERED;
960 static pci_ers_result_t hpre_process_hw_error(struct pci_dev *pdev)
962 struct hpre *hpre = pci_get_drvdata(pdev);
963 pci_ers_result_t qm_ret, hpre_ret;
965 /* log qm error */
966 qm_ret = hisi_qm_hw_error_handle(&hpre->qm);
968 /* log hpre error */
969 hpre_ret = hpre_hw_error_handle(hpre);
971 return (qm_ret == PCI_ERS_RESULT_NEED_RESET ||
972 hpre_ret == PCI_ERS_RESULT_NEED_RESET) ?
973 PCI_ERS_RESULT_NEED_RESET : PCI_ERS_RESULT_RECOVERED;
976 static pci_ers_result_t hpre_error_detected(struct pci_dev *pdev,
977 pci_channel_state_t state)
979 pci_info(pdev, "PCI error detected, state(=%d)!!\n", state);
980 if (state == pci_channel_io_perm_failure)
981 return PCI_ERS_RESULT_DISCONNECT;
983 return hpre_process_hw_error(pdev);
986 static const struct pci_error_handlers hpre_err_handler = {
987 .error_detected = hpre_error_detected,
990 static struct pci_driver hpre_pci_driver = {
991 .name = hpre_name,
992 .id_table = hpre_dev_ids,
993 .probe = hpre_probe,
994 .remove = hpre_remove,
995 .sriov_configure = hpre_sriov_configure,
996 .err_handler = &hpre_err_handler,
999 static void hpre_register_debugfs(void)
1001 if (!debugfs_initialized())
1002 return;
1004 hpre_debugfs_root = debugfs_create_dir(hpre_name, NULL);
1007 static void hpre_unregister_debugfs(void)
1009 debugfs_remove_recursive(hpre_debugfs_root);
1012 static int __init hpre_init(void)
1014 int ret;
1016 hpre_register_debugfs();
1018 ret = pci_register_driver(&hpre_pci_driver);
1019 if (ret) {
1020 hpre_unregister_debugfs();
1021 pr_err("hpre: can't register hisi hpre driver.\n");
1024 return ret;
1027 static void __exit hpre_exit(void)
1029 pci_unregister_driver(&hpre_pci_driver);
1030 hpre_unregister_debugfs();
1033 module_init(hpre_init);
1034 module_exit(hpre_exit);
1036 MODULE_LICENSE("GPL v2");
1037 MODULE_AUTHOR("Zaibo Xu <xuzaibo@huawei.com>");
1038 MODULE_DESCRIPTION("Driver for HiSilicon HPRE accelerator");