treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / crypto / hisilicon / sec2 / sec_main.c
blob2bbaf1e2dae7fc29e612e0f4c39ef258885f1178
1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (c) 2019 HiSilicon Limited. */
4 #include <linux/acpi.h>
5 #include <linux/aer.h>
6 #include <linux/bitops.h>
7 #include <linux/debugfs.h>
8 #include <linux/init.h>
9 #include <linux/io.h>
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/pci.h>
13 #include <linux/seq_file.h>
14 #include <linux/topology.h>
16 #include "sec.h"
18 #define SEC_VF_NUM 63
19 #define SEC_QUEUE_NUM_V1 4096
20 #define SEC_QUEUE_NUM_V2 1024
21 #define SEC_PF_PCI_DEVICE_ID 0xa255
22 #define SEC_VF_PCI_DEVICE_ID 0xa256
24 #define SEC_XTS_MIV_ENABLE_REG 0x301384
25 #define SEC_XTS_MIV_ENABLE_MSK 0x7FFFFFFF
26 #define SEC_XTS_MIV_DISABLE_MSK 0xFFFFFFFF
27 #define SEC_BD_ERR_CHK_EN1 0xfffff7fd
28 #define SEC_BD_ERR_CHK_EN2 0xffffbfff
30 #define SEC_SQE_SIZE 128
31 #define SEC_SQ_SIZE (SEC_SQE_SIZE * QM_Q_DEPTH)
32 #define SEC_PF_DEF_Q_NUM 64
33 #define SEC_PF_DEF_Q_BASE 0
34 #define SEC_CTX_Q_NUM_DEF 24
35 #define SEC_CTX_Q_NUM_MAX 32
37 #define SEC_CTRL_CNT_CLR_CE 0x301120
38 #define SEC_CTRL_CNT_CLR_CE_BIT BIT(0)
39 #define SEC_ENGINE_PF_CFG_OFF 0x300000
40 #define SEC_ACC_COMMON_REG_OFF 0x1000
41 #define SEC_CORE_INT_SOURCE 0x301010
42 #define SEC_CORE_INT_MASK 0x301000
43 #define SEC_CORE_INT_STATUS 0x301008
44 #define SEC_CORE_SRAM_ECC_ERR_INFO 0x301C14
45 #define SEC_ECC_NUM(err) (((err) >> 16) & 0xFF)
46 #define SEC_ECC_ADDR(err) ((err) >> 0)
47 #define SEC_CORE_INT_DISABLE 0x0
48 #define SEC_CORE_INT_ENABLE 0x1ff
50 #define SEC_RAS_CE_REG 0x50
51 #define SEC_RAS_FE_REG 0x54
52 #define SEC_RAS_NFE_REG 0x58
53 #define SEC_RAS_CE_ENB_MSK 0x88
54 #define SEC_RAS_FE_ENB_MSK 0x0
55 #define SEC_RAS_NFE_ENB_MSK 0x177
56 #define SEC_RAS_DISABLE 0x0
57 #define SEC_MEM_START_INIT_REG 0x0100
58 #define SEC_MEM_INIT_DONE_REG 0x0104
59 #define SEC_QM_ABNORMAL_INT_MASK 0x100004
61 #define SEC_CONTROL_REG 0x0200
62 #define SEC_TRNG_EN_SHIFT 8
63 #define SEC_CLK_GATE_ENABLE BIT(3)
64 #define SEC_CLK_GATE_DISABLE (~BIT(3))
65 #define SEC_AXI_SHUTDOWN_ENABLE BIT(12)
66 #define SEC_AXI_SHUTDOWN_DISABLE 0xFFFFEFFF
68 #define SEC_INTERFACE_USER_CTRL0_REG 0x0220
69 #define SEC_INTERFACE_USER_CTRL1_REG 0x0224
70 #define SEC_BD_ERR_CHK_EN_REG1 0x0384
71 #define SEC_BD_ERR_CHK_EN_REG2 0x038c
73 #define SEC_USER0_SMMU_NORMAL (BIT(23) | BIT(15))
74 #define SEC_USER1_SMMU_NORMAL (BIT(31) | BIT(23) | BIT(15) | BIT(7))
75 #define SEC_CORE_INT_STATUS_M_ECC BIT(2)
77 #define SEC_DELAY_10_US 10
78 #define SEC_POLL_TIMEOUT_US 1000
79 #define SEC_VF_CNT_MASK 0xffffffc0
80 #define SEC_DBGFS_VAL_MAX_LEN 20
82 #define SEC_ADDR(qm, offset) ((qm)->io_base + (offset) + \
83 SEC_ENGINE_PF_CFG_OFF + SEC_ACC_COMMON_REG_OFF)
85 struct sec_hw_error {
86 u32 int_msk;
87 const char *msg;
90 static const char sec_name[] = "hisi_sec2";
91 static struct dentry *sec_debugfs_root;
92 static LIST_HEAD(sec_list);
93 static DEFINE_MUTEX(sec_list_lock);
95 static const struct sec_hw_error sec_hw_errors[] = {
96 {.int_msk = BIT(0), .msg = "sec_axi_rresp_err_rint"},
97 {.int_msk = BIT(1), .msg = "sec_axi_bresp_err_rint"},
98 {.int_msk = BIT(2), .msg = "sec_ecc_2bit_err_rint"},
99 {.int_msk = BIT(3), .msg = "sec_ecc_1bit_err_rint"},
100 {.int_msk = BIT(4), .msg = "sec_req_trng_timeout_rint"},
101 {.int_msk = BIT(5), .msg = "sec_fsm_hbeat_rint"},
102 {.int_msk = BIT(6), .msg = "sec_channel_req_rng_timeout_rint"},
103 {.int_msk = BIT(7), .msg = "sec_bd_err_rint"},
104 {.int_msk = BIT(8), .msg = "sec_chain_buff_err_rint"},
105 { /* sentinel */ }
108 struct sec_dev *sec_find_device(int node)
110 #define SEC_NUMA_MAX_DISTANCE 100
111 int min_distance = SEC_NUMA_MAX_DISTANCE;
112 int dev_node = 0, free_qp_num = 0;
113 struct sec_dev *sec, *ret = NULL;
114 struct hisi_qm *qm;
115 struct device *dev;
117 mutex_lock(&sec_list_lock);
118 list_for_each_entry(sec, &sec_list, list) {
119 qm = &sec->qm;
120 dev = &qm->pdev->dev;
121 #ifdef CONFIG_NUMA
122 dev_node = dev->numa_node;
123 if (dev_node < 0)
124 dev_node = 0;
125 #endif
126 if (node_distance(dev_node, node) < min_distance) {
127 free_qp_num = hisi_qm_get_free_qp_num(qm);
128 if (free_qp_num >= sec->ctx_q_num) {
129 ret = sec;
130 min_distance = node_distance(dev_node, node);
134 mutex_unlock(&sec_list_lock);
136 return ret;
139 static const char * const sec_dbg_file_name[] = {
140 [SEC_CURRENT_QM] = "current_qm",
141 [SEC_CLEAR_ENABLE] = "clear_enable",
144 static struct debugfs_reg32 sec_dfx_regs[] = {
145 {"SEC_PF_ABNORMAL_INT_SOURCE ", 0x301010},
146 {"SEC_SAA_EN ", 0x301270},
147 {"SEC_BD_LATENCY_MIN ", 0x301600},
148 {"SEC_BD_LATENCY_MAX ", 0x301608},
149 {"SEC_BD_LATENCY_AVG ", 0x30160C},
150 {"SEC_BD_NUM_IN_SAA0 ", 0x301670},
151 {"SEC_BD_NUM_IN_SAA1 ", 0x301674},
152 {"SEC_BD_NUM_IN_SEC ", 0x301680},
153 {"SEC_ECC_1BIT_CNT ", 0x301C00},
154 {"SEC_ECC_1BIT_INFO ", 0x301C04},
155 {"SEC_ECC_2BIT_CNT ", 0x301C10},
156 {"SEC_ECC_2BIT_INFO ", 0x301C14},
157 {"SEC_BD_SAA0 ", 0x301C20},
158 {"SEC_BD_SAA1 ", 0x301C24},
159 {"SEC_BD_SAA2 ", 0x301C28},
160 {"SEC_BD_SAA3 ", 0x301C2C},
161 {"SEC_BD_SAA4 ", 0x301C30},
162 {"SEC_BD_SAA5 ", 0x301C34},
163 {"SEC_BD_SAA6 ", 0x301C38},
164 {"SEC_BD_SAA7 ", 0x301C3C},
165 {"SEC_BD_SAA8 ", 0x301C40},
168 static int sec_pf_q_num_set(const char *val, const struct kernel_param *kp)
170 struct pci_dev *pdev;
171 u32 n, q_num;
172 u8 rev_id;
173 int ret;
175 if (!val)
176 return -EINVAL;
178 pdev = pci_get_device(PCI_VENDOR_ID_HUAWEI,
179 SEC_PF_PCI_DEVICE_ID, NULL);
180 if (!pdev) {
181 q_num = min_t(u32, SEC_QUEUE_NUM_V1, SEC_QUEUE_NUM_V2);
182 pr_info("No device, suppose queue number is %d!\n", q_num);
183 } else {
184 rev_id = pdev->revision;
186 switch (rev_id) {
187 case QM_HW_V1:
188 q_num = SEC_QUEUE_NUM_V1;
189 break;
190 case QM_HW_V2:
191 q_num = SEC_QUEUE_NUM_V2;
192 break;
193 default:
194 return -EINVAL;
198 ret = kstrtou32(val, 10, &n);
199 if (ret || !n || n > q_num)
200 return -EINVAL;
202 return param_set_int(val, kp);
205 static const struct kernel_param_ops sec_pf_q_num_ops = {
206 .set = sec_pf_q_num_set,
207 .get = param_get_int,
209 static u32 pf_q_num = SEC_PF_DEF_Q_NUM;
210 module_param_cb(pf_q_num, &sec_pf_q_num_ops, &pf_q_num, 0444);
211 MODULE_PARM_DESC(pf_q_num, "Number of queues in PF(v1 0-4096, v2 0-1024)");
213 static int sec_ctx_q_num_set(const char *val, const struct kernel_param *kp)
215 u32 ctx_q_num;
216 int ret;
218 if (!val)
219 return -EINVAL;
221 ret = kstrtou32(val, 10, &ctx_q_num);
222 if (ret)
223 return -EINVAL;
225 if (!ctx_q_num || ctx_q_num > SEC_CTX_Q_NUM_MAX || ctx_q_num & 0x1) {
226 pr_err("ctx queue num[%u] is invalid!\n", ctx_q_num);
227 return -EINVAL;
230 return param_set_int(val, kp);
233 static const struct kernel_param_ops sec_ctx_q_num_ops = {
234 .set = sec_ctx_q_num_set,
235 .get = param_get_int,
237 static u32 ctx_q_num = SEC_CTX_Q_NUM_DEF;
238 module_param_cb(ctx_q_num, &sec_ctx_q_num_ops, &ctx_q_num, 0444);
239 MODULE_PARM_DESC(ctx_q_num, "Queue num in ctx (24 default, 2, 4, ..., 32)");
241 static const struct pci_device_id sec_dev_ids[] = {
242 { PCI_DEVICE(PCI_VENDOR_ID_HUAWEI, SEC_PF_PCI_DEVICE_ID) },
243 { PCI_DEVICE(PCI_VENDOR_ID_HUAWEI, SEC_VF_PCI_DEVICE_ID) },
244 { 0, }
246 MODULE_DEVICE_TABLE(pci, sec_dev_ids);
248 static inline void sec_add_to_list(struct sec_dev *sec)
250 mutex_lock(&sec_list_lock);
251 list_add_tail(&sec->list, &sec_list);
252 mutex_unlock(&sec_list_lock);
255 static inline void sec_remove_from_list(struct sec_dev *sec)
257 mutex_lock(&sec_list_lock);
258 list_del(&sec->list);
259 mutex_unlock(&sec_list_lock);
262 static u8 sec_get_endian(struct sec_dev *sec)
264 struct hisi_qm *qm = &sec->qm;
265 u32 reg;
268 * As for VF, it is a wrong way to get endian setting by
269 * reading a register of the engine
271 if (qm->pdev->is_virtfn) {
272 dev_err_ratelimited(&qm->pdev->dev,
273 "cannot access a register in VF!\n");
274 return SEC_LE;
276 reg = readl_relaxed(qm->io_base + SEC_ENGINE_PF_CFG_OFF +
277 SEC_ACC_COMMON_REG_OFF + SEC_CONTROL_REG);
279 /* BD little endian mode */
280 if (!(reg & BIT(0)))
281 return SEC_LE;
283 /* BD 32-bits big endian mode */
284 else if (!(reg & BIT(1)))
285 return SEC_32BE;
287 /* BD 64-bits big endian mode */
288 else
289 return SEC_64BE;
292 static int sec_engine_init(struct sec_dev *sec)
294 struct hisi_qm *qm = &sec->qm;
295 int ret;
296 u32 reg;
298 /* disable clock gate control */
299 reg = readl_relaxed(SEC_ADDR(qm, SEC_CONTROL_REG));
300 reg &= SEC_CLK_GATE_DISABLE;
301 writel_relaxed(reg, SEC_ADDR(qm, SEC_CONTROL_REG));
303 writel_relaxed(0x1, SEC_ADDR(qm, SEC_MEM_START_INIT_REG));
305 ret = readl_relaxed_poll_timeout(SEC_ADDR(qm, SEC_MEM_INIT_DONE_REG),
306 reg, reg & 0x1, SEC_DELAY_10_US,
307 SEC_POLL_TIMEOUT_US);
308 if (ret) {
309 dev_err(&qm->pdev->dev, "fail to init sec mem\n");
310 return ret;
313 reg = readl_relaxed(SEC_ADDR(qm, SEC_CONTROL_REG));
314 reg |= (0x1 << SEC_TRNG_EN_SHIFT);
315 writel_relaxed(reg, SEC_ADDR(qm, SEC_CONTROL_REG));
317 reg = readl_relaxed(SEC_ADDR(qm, SEC_INTERFACE_USER_CTRL0_REG));
318 reg |= SEC_USER0_SMMU_NORMAL;
319 writel_relaxed(reg, SEC_ADDR(qm, SEC_INTERFACE_USER_CTRL0_REG));
321 reg = readl_relaxed(SEC_ADDR(qm, SEC_INTERFACE_USER_CTRL1_REG));
322 reg |= SEC_USER1_SMMU_NORMAL;
323 writel_relaxed(reg, SEC_ADDR(qm, SEC_INTERFACE_USER_CTRL1_REG));
325 writel_relaxed(SEC_BD_ERR_CHK_EN1,
326 SEC_ADDR(qm, SEC_BD_ERR_CHK_EN_REG1));
327 writel_relaxed(SEC_BD_ERR_CHK_EN2,
328 SEC_ADDR(qm, SEC_BD_ERR_CHK_EN_REG2));
330 /* enable clock gate control */
331 reg = readl_relaxed(SEC_ADDR(qm, SEC_CONTROL_REG));
332 reg |= SEC_CLK_GATE_ENABLE;
333 writel_relaxed(reg, SEC_ADDR(qm, SEC_CONTROL_REG));
335 /* config endian */
336 reg = readl_relaxed(SEC_ADDR(qm, SEC_CONTROL_REG));
337 reg |= sec_get_endian(sec);
338 writel_relaxed(reg, SEC_ADDR(qm, SEC_CONTROL_REG));
340 /* Enable sm4 xts mode multiple iv */
341 writel_relaxed(SEC_XTS_MIV_ENABLE_MSK,
342 qm->io_base + SEC_XTS_MIV_ENABLE_REG);
344 return 0;
347 static int sec_set_user_domain_and_cache(struct sec_dev *sec)
349 struct hisi_qm *qm = &sec->qm;
351 /* qm user domain */
352 writel(AXUSER_BASE, qm->io_base + QM_ARUSER_M_CFG_1);
353 writel(ARUSER_M_CFG_ENABLE, qm->io_base + QM_ARUSER_M_CFG_ENABLE);
354 writel(AXUSER_BASE, qm->io_base + QM_AWUSER_M_CFG_1);
355 writel(AWUSER_M_CFG_ENABLE, qm->io_base + QM_AWUSER_M_CFG_ENABLE);
356 writel(WUSER_M_CFG_ENABLE, qm->io_base + QM_WUSER_M_CFG_ENABLE);
358 /* qm cache */
359 writel(AXI_M_CFG, qm->io_base + QM_AXI_M_CFG);
360 writel(AXI_M_CFG_ENABLE, qm->io_base + QM_AXI_M_CFG_ENABLE);
362 /* disable FLR triggered by BME(bus master enable) */
363 writel(PEH_AXUSER_CFG, qm->io_base + QM_PEH_AXUSER_CFG);
364 writel(PEH_AXUSER_CFG_ENABLE, qm->io_base + QM_PEH_AXUSER_CFG_ENABLE);
366 /* enable sqc,cqc writeback */
367 writel(SQC_CACHE_ENABLE | CQC_CACHE_ENABLE | SQC_CACHE_WB_ENABLE |
368 CQC_CACHE_WB_ENABLE | FIELD_PREP(SQC_CACHE_WB_THRD, 1) |
369 FIELD_PREP(CQC_CACHE_WB_THRD, 1), qm->io_base + QM_CACHE_CTL);
371 return sec_engine_init(sec);
374 /* sec_debug_regs_clear() - clear the sec debug regs */
375 static void sec_debug_regs_clear(struct hisi_qm *qm)
377 /* clear current_qm */
378 writel(0x0, qm->io_base + QM_DFX_MB_CNT_VF);
379 writel(0x0, qm->io_base + QM_DFX_DB_CNT_VF);
381 /* clear rdclr_en */
382 writel(0x0, qm->io_base + SEC_CTRL_CNT_CLR_CE);
384 hisi_qm_debug_regs_clear(qm);
387 static void sec_hw_error_enable(struct sec_dev *sec)
389 struct hisi_qm *qm = &sec->qm;
390 u32 val;
392 if (qm->ver == QM_HW_V1) {
393 writel(SEC_CORE_INT_DISABLE, qm->io_base + SEC_CORE_INT_MASK);
394 dev_info(&qm->pdev->dev, "V1 not support hw error handle\n");
395 return;
398 val = readl(qm->io_base + SEC_CONTROL_REG);
400 /* clear SEC hw error source if having */
401 writel(SEC_CORE_INT_DISABLE, qm->io_base + SEC_CORE_INT_SOURCE);
403 /* enable SEC hw error interrupts */
404 writel(SEC_CORE_INT_ENABLE, qm->io_base + SEC_CORE_INT_MASK);
406 /* enable RAS int */
407 writel(SEC_RAS_CE_ENB_MSK, qm->io_base + SEC_RAS_CE_REG);
408 writel(SEC_RAS_FE_ENB_MSK, qm->io_base + SEC_RAS_FE_REG);
409 writel(SEC_RAS_NFE_ENB_MSK, qm->io_base + SEC_RAS_NFE_REG);
411 /* enable SEC block master OOO when m-bit error occur */
412 val = val | SEC_AXI_SHUTDOWN_ENABLE;
414 writel(val, qm->io_base + SEC_CONTROL_REG);
417 static void sec_hw_error_disable(struct sec_dev *sec)
419 struct hisi_qm *qm = &sec->qm;
420 u32 val;
422 val = readl(qm->io_base + SEC_CONTROL_REG);
424 /* disable RAS int */
425 writel(SEC_RAS_DISABLE, qm->io_base + SEC_RAS_CE_REG);
426 writel(SEC_RAS_DISABLE, qm->io_base + SEC_RAS_FE_REG);
427 writel(SEC_RAS_DISABLE, qm->io_base + SEC_RAS_NFE_REG);
429 /* disable SEC hw error interrupts */
430 writel(SEC_CORE_INT_DISABLE, qm->io_base + SEC_CORE_INT_MASK);
432 /* disable SEC block master OOO when m-bit error occur */
433 val = val & SEC_AXI_SHUTDOWN_DISABLE;
435 writel(val, qm->io_base + SEC_CONTROL_REG);
438 static void sec_hw_error_init(struct sec_dev *sec)
440 if (sec->qm.fun_type == QM_HW_VF)
441 return;
443 hisi_qm_hw_error_init(&sec->qm, QM_BASE_CE,
444 QM_BASE_NFE | QM_ACC_DO_TASK_TIMEOUT
445 | QM_ACC_WB_NOT_READY_TIMEOUT, 0,
446 QM_DB_RANDOM_INVALID);
447 sec_hw_error_enable(sec);
450 static void sec_hw_error_uninit(struct sec_dev *sec)
452 if (sec->qm.fun_type == QM_HW_VF)
453 return;
455 sec_hw_error_disable(sec);
456 writel(GENMASK(12, 0), sec->qm.io_base + SEC_QM_ABNORMAL_INT_MASK);
459 static u32 sec_current_qm_read(struct sec_debug_file *file)
461 struct hisi_qm *qm = file->qm;
463 return readl(qm->io_base + QM_DFX_MB_CNT_VF);
466 static int sec_current_qm_write(struct sec_debug_file *file, u32 val)
468 struct hisi_qm *qm = file->qm;
469 struct sec_dev *sec = container_of(qm, struct sec_dev, qm);
470 u32 vfq_num;
471 u32 tmp;
473 if (val > sec->num_vfs)
474 return -EINVAL;
476 /* According PF or VF Dev ID to calculation curr_qm_qp_num and store */
477 if (!val) {
478 qm->debug.curr_qm_qp_num = qm->qp_num;
479 } else {
480 vfq_num = (qm->ctrl_qp_num - qm->qp_num) / sec->num_vfs;
482 if (val == sec->num_vfs)
483 qm->debug.curr_qm_qp_num =
484 qm->ctrl_qp_num - qm->qp_num -
485 (sec->num_vfs - 1) * vfq_num;
486 else
487 qm->debug.curr_qm_qp_num = vfq_num;
490 writel(val, qm->io_base + QM_DFX_MB_CNT_VF);
491 writel(val, qm->io_base + QM_DFX_DB_CNT_VF);
493 tmp = val |
494 (readl(qm->io_base + QM_DFX_SQE_CNT_VF_SQN) & CURRENT_Q_MASK);
495 writel(tmp, qm->io_base + QM_DFX_SQE_CNT_VF_SQN);
497 tmp = val |
498 (readl(qm->io_base + QM_DFX_CQE_CNT_VF_CQN) & CURRENT_Q_MASK);
499 writel(tmp, qm->io_base + QM_DFX_CQE_CNT_VF_CQN);
501 return 0;
504 static u32 sec_clear_enable_read(struct sec_debug_file *file)
506 struct hisi_qm *qm = file->qm;
508 return readl(qm->io_base + SEC_CTRL_CNT_CLR_CE) &
509 SEC_CTRL_CNT_CLR_CE_BIT;
512 static int sec_clear_enable_write(struct sec_debug_file *file, u32 val)
514 struct hisi_qm *qm = file->qm;
515 u32 tmp;
517 if (val != 1 && val)
518 return -EINVAL;
520 tmp = (readl(qm->io_base + SEC_CTRL_CNT_CLR_CE) &
521 ~SEC_CTRL_CNT_CLR_CE_BIT) | val;
522 writel(tmp, qm->io_base + SEC_CTRL_CNT_CLR_CE);
524 return 0;
527 static ssize_t sec_debug_read(struct file *filp, char __user *buf,
528 size_t count, loff_t *pos)
530 struct sec_debug_file *file = filp->private_data;
531 char tbuf[SEC_DBGFS_VAL_MAX_LEN];
532 u32 val;
533 int ret;
535 spin_lock_irq(&file->lock);
537 switch (file->index) {
538 case SEC_CURRENT_QM:
539 val = sec_current_qm_read(file);
540 break;
541 case SEC_CLEAR_ENABLE:
542 val = sec_clear_enable_read(file);
543 break;
544 default:
545 spin_unlock_irq(&file->lock);
546 return -EINVAL;
549 spin_unlock_irq(&file->lock);
550 ret = snprintf(tbuf, SEC_DBGFS_VAL_MAX_LEN, "%u\n", val);
552 return simple_read_from_buffer(buf, count, pos, tbuf, ret);
555 static ssize_t sec_debug_write(struct file *filp, const char __user *buf,
556 size_t count, loff_t *pos)
558 struct sec_debug_file *file = filp->private_data;
559 char tbuf[SEC_DBGFS_VAL_MAX_LEN];
560 unsigned long val;
561 int len, ret;
563 if (*pos != 0)
564 return 0;
566 if (count >= SEC_DBGFS_VAL_MAX_LEN)
567 return -ENOSPC;
569 len = simple_write_to_buffer(tbuf, SEC_DBGFS_VAL_MAX_LEN - 1,
570 pos, buf, count);
571 if (len < 0)
572 return len;
574 tbuf[len] = '\0';
575 if (kstrtoul(tbuf, 0, &val))
576 return -EFAULT;
578 spin_lock_irq(&file->lock);
580 switch (file->index) {
581 case SEC_CURRENT_QM:
582 ret = sec_current_qm_write(file, val);
583 if (ret)
584 goto err_input;
585 break;
586 case SEC_CLEAR_ENABLE:
587 ret = sec_clear_enable_write(file, val);
588 if (ret)
589 goto err_input;
590 break;
591 default:
592 ret = -EINVAL;
593 goto err_input;
596 spin_unlock_irq(&file->lock);
598 return count;
600 err_input:
601 spin_unlock_irq(&file->lock);
602 return ret;
605 static const struct file_operations sec_dbg_fops = {
606 .owner = THIS_MODULE,
607 .open = simple_open,
608 .read = sec_debug_read,
609 .write = sec_debug_write,
612 static int sec_debugfs_atomic64_get(void *data, u64 *val)
614 *val = atomic64_read((atomic64_t *)data);
615 return 0;
617 DEFINE_DEBUGFS_ATTRIBUTE(sec_atomic64_ops, sec_debugfs_atomic64_get,
618 NULL, "%lld\n");
620 static int sec_core_debug_init(struct sec_dev *sec)
622 struct hisi_qm *qm = &sec->qm;
623 struct device *dev = &qm->pdev->dev;
624 struct sec_dfx *dfx = &sec->debug.dfx;
625 struct debugfs_regset32 *regset;
626 struct dentry *tmp_d;
628 tmp_d = debugfs_create_dir("sec_dfx", sec->qm.debug.debug_root);
630 regset = devm_kzalloc(dev, sizeof(*regset), GFP_KERNEL);
631 if (!regset)
632 return -ENOENT;
634 regset->regs = sec_dfx_regs;
635 regset->nregs = ARRAY_SIZE(sec_dfx_regs);
636 regset->base = qm->io_base;
638 debugfs_create_regset32("regs", 0444, tmp_d, regset);
640 debugfs_create_file("send_cnt", 0444, tmp_d,
641 &dfx->send_cnt, &sec_atomic64_ops);
643 debugfs_create_file("recv_cnt", 0444, tmp_d,
644 &dfx->recv_cnt, &sec_atomic64_ops);
646 return 0;
649 static int sec_debug_init(struct sec_dev *sec)
651 int i;
653 for (i = SEC_CURRENT_QM; i < SEC_DEBUG_FILE_NUM; i++) {
654 spin_lock_init(&sec->debug.files[i].lock);
655 sec->debug.files[i].index = i;
656 sec->debug.files[i].qm = &sec->qm;
658 debugfs_create_file(sec_dbg_file_name[i], 0600,
659 sec->qm.debug.debug_root,
660 sec->debug.files + i,
661 &sec_dbg_fops);
664 return sec_core_debug_init(sec);
667 static int sec_debugfs_init(struct sec_dev *sec)
669 struct hisi_qm *qm = &sec->qm;
670 struct device *dev = &qm->pdev->dev;
671 int ret;
673 qm->debug.debug_root = debugfs_create_dir(dev_name(dev),
674 sec_debugfs_root);
675 ret = hisi_qm_debug_init(qm);
676 if (ret)
677 goto failed_to_create;
679 if (qm->pdev->device == SEC_PF_PCI_DEVICE_ID) {
680 ret = sec_debug_init(sec);
681 if (ret)
682 goto failed_to_create;
685 return 0;
687 failed_to_create:
688 debugfs_remove_recursive(sec_debugfs_root);
690 return ret;
693 static void sec_debugfs_exit(struct sec_dev *sec)
695 debugfs_remove_recursive(sec->qm.debug.debug_root);
698 static int sec_pf_probe_init(struct sec_dev *sec)
700 struct hisi_qm *qm = &sec->qm;
701 int ret;
703 switch (qm->ver) {
704 case QM_HW_V1:
705 qm->ctrl_qp_num = SEC_QUEUE_NUM_V1;
706 break;
708 case QM_HW_V2:
709 qm->ctrl_qp_num = SEC_QUEUE_NUM_V2;
710 break;
712 default:
713 return -EINVAL;
716 ret = sec_set_user_domain_and_cache(sec);
717 if (ret)
718 return ret;
720 sec_hw_error_init(sec);
721 sec_debug_regs_clear(qm);
723 return 0;
726 static int sec_qm_init(struct hisi_qm *qm, struct pci_dev *pdev)
728 enum qm_hw_ver rev_id;
730 rev_id = hisi_qm_get_hw_version(pdev);
731 if (rev_id == QM_HW_UNKNOWN)
732 return -ENODEV;
734 qm->pdev = pdev;
735 qm->ver = rev_id;
737 qm->sqe_size = SEC_SQE_SIZE;
738 qm->dev_name = sec_name;
739 qm->fun_type = (pdev->device == SEC_PF_PCI_DEVICE_ID) ?
740 QM_HW_PF : QM_HW_VF;
741 qm->use_dma_api = true;
743 return hisi_qm_init(qm);
746 static void sec_qm_uninit(struct hisi_qm *qm)
748 hisi_qm_uninit(qm);
751 static int sec_probe_init(struct hisi_qm *qm, struct sec_dev *sec)
753 if (qm->fun_type == QM_HW_PF) {
754 qm->qp_base = SEC_PF_DEF_Q_BASE;
755 qm->qp_num = pf_q_num;
756 qm->debug.curr_qm_qp_num = pf_q_num;
758 return sec_pf_probe_init(sec);
759 } else if (qm->fun_type == QM_HW_VF) {
761 * have no way to get qm configure in VM in v1 hardware,
762 * so currently force PF to uses SEC_PF_DEF_Q_NUM, and force
763 * to trigger only one VF in v1 hardware.
764 * v2 hardware has no such problem.
766 if (qm->ver == QM_HW_V1) {
767 qm->qp_base = SEC_PF_DEF_Q_NUM;
768 qm->qp_num = SEC_QUEUE_NUM_V1 - SEC_PF_DEF_Q_NUM;
769 } else if (qm->ver == QM_HW_V2) {
770 /* v2 starts to support get vft by mailbox */
771 return hisi_qm_get_vft(qm, &qm->qp_base, &qm->qp_num);
773 } else {
774 return -ENODEV;
777 return 0;
780 static void sec_probe_uninit(struct sec_dev *sec)
782 sec_hw_error_uninit(sec);
785 static int sec_probe(struct pci_dev *pdev, const struct pci_device_id *id)
787 struct sec_dev *sec;
788 struct hisi_qm *qm;
789 int ret;
791 sec = devm_kzalloc(&pdev->dev, sizeof(*sec), GFP_KERNEL);
792 if (!sec)
793 return -ENOMEM;
795 pci_set_drvdata(pdev, sec);
797 sec->ctx_q_num = ctx_q_num;
799 qm = &sec->qm;
801 ret = sec_qm_init(qm, pdev);
802 if (ret) {
803 pci_err(pdev, "Failed to pre init qm!\n");
804 return ret;
807 ret = sec_probe_init(qm, sec);
808 if (ret) {
809 pci_err(pdev, "Failed to probe!\n");
810 goto err_qm_uninit;
813 ret = hisi_qm_start(qm);
814 if (ret) {
815 pci_err(pdev, "Failed to start sec qm!\n");
816 goto err_probe_uninit;
819 ret = sec_debugfs_init(sec);
820 if (ret)
821 pci_warn(pdev, "Failed to init debugfs!\n");
823 sec_add_to_list(sec);
825 ret = sec_register_to_crypto();
826 if (ret < 0) {
827 pr_err("Failed to register driver to crypto.\n");
828 goto err_remove_from_list;
831 return 0;
833 err_remove_from_list:
834 sec_remove_from_list(sec);
835 sec_debugfs_exit(sec);
836 hisi_qm_stop(qm);
838 err_probe_uninit:
839 sec_probe_uninit(sec);
841 err_qm_uninit:
842 sec_qm_uninit(qm);
844 return ret;
847 /* now we only support equal assignment */
848 static int sec_vf_q_assign(struct sec_dev *sec, u32 num_vfs)
850 struct hisi_qm *qm = &sec->qm;
851 u32 qp_num = qm->qp_num;
852 u32 q_base = qp_num;
853 u32 q_num, remain_q_num;
854 int i, j, ret;
856 if (!num_vfs)
857 return -EINVAL;
859 remain_q_num = qm->ctrl_qp_num - qp_num;
860 q_num = remain_q_num / num_vfs;
862 for (i = 1; i <= num_vfs; i++) {
863 if (i == num_vfs)
864 q_num += remain_q_num % num_vfs;
865 ret = hisi_qm_set_vft(qm, i, q_base, q_num);
866 if (ret) {
867 for (j = i; j > 0; j--)
868 hisi_qm_set_vft(qm, j, 0, 0);
869 return ret;
871 q_base += q_num;
874 return 0;
877 static int sec_clear_vft_config(struct sec_dev *sec)
879 struct hisi_qm *qm = &sec->qm;
880 u32 num_vfs = sec->num_vfs;
881 int ret;
882 u32 i;
884 for (i = 1; i <= num_vfs; i++) {
885 ret = hisi_qm_set_vft(qm, i, 0, 0);
886 if (ret)
887 return ret;
890 sec->num_vfs = 0;
892 return 0;
895 static int sec_sriov_enable(struct pci_dev *pdev, int max_vfs)
897 struct sec_dev *sec = pci_get_drvdata(pdev);
898 int pre_existing_vfs, ret;
899 u32 num_vfs;
901 pre_existing_vfs = pci_num_vf(pdev);
903 if (pre_existing_vfs) {
904 pci_err(pdev, "Can't enable VF. Please disable at first!\n");
905 return 0;
908 num_vfs = min_t(u32, max_vfs, SEC_VF_NUM);
910 ret = sec_vf_q_assign(sec, num_vfs);
911 if (ret) {
912 pci_err(pdev, "Can't assign queues for VF!\n");
913 return ret;
916 sec->num_vfs = num_vfs;
918 ret = pci_enable_sriov(pdev, num_vfs);
919 if (ret) {
920 pci_err(pdev, "Can't enable VF!\n");
921 sec_clear_vft_config(sec);
922 return ret;
925 return num_vfs;
928 static int sec_sriov_disable(struct pci_dev *pdev)
930 struct sec_dev *sec = pci_get_drvdata(pdev);
932 if (pci_vfs_assigned(pdev)) {
933 pci_err(pdev, "Can't disable VFs while VFs are assigned!\n");
934 return -EPERM;
937 /* remove in sec_pci_driver will be called to free VF resources */
938 pci_disable_sriov(pdev);
940 return sec_clear_vft_config(sec);
943 static int sec_sriov_configure(struct pci_dev *pdev, int num_vfs)
945 if (num_vfs)
946 return sec_sriov_enable(pdev, num_vfs);
947 else
948 return sec_sriov_disable(pdev);
951 static void sec_remove(struct pci_dev *pdev)
953 struct sec_dev *sec = pci_get_drvdata(pdev);
954 struct hisi_qm *qm = &sec->qm;
956 sec_unregister_from_crypto();
958 sec_remove_from_list(sec);
960 if (qm->fun_type == QM_HW_PF && sec->num_vfs)
961 (void)sec_sriov_disable(pdev);
963 sec_debugfs_exit(sec);
965 (void)hisi_qm_stop(qm);
967 if (qm->fun_type == QM_HW_PF)
968 sec_debug_regs_clear(qm);
970 sec_probe_uninit(sec);
972 sec_qm_uninit(qm);
975 static void sec_log_hw_error(struct sec_dev *sec, u32 err_sts)
977 const struct sec_hw_error *errs = sec_hw_errors;
978 struct device *dev = &sec->qm.pdev->dev;
979 u32 err_val;
981 while (errs->msg) {
982 if (errs->int_msk & err_sts) {
983 dev_err(dev, "%s [error status=0x%x] found\n",
984 errs->msg, errs->int_msk);
986 if (SEC_CORE_INT_STATUS_M_ECC & err_sts) {
987 err_val = readl(sec->qm.io_base +
988 SEC_CORE_SRAM_ECC_ERR_INFO);
989 dev_err(dev, "multi ecc sram num=0x%x\n",
990 SEC_ECC_NUM(err_val));
991 dev_err(dev, "multi ecc sram addr=0x%x\n",
992 SEC_ECC_ADDR(err_val));
995 errs++;
999 static pci_ers_result_t sec_hw_error_handle(struct sec_dev *sec)
1001 u32 err_sts;
1003 /* read err sts */
1004 err_sts = readl(sec->qm.io_base + SEC_CORE_INT_STATUS);
1005 if (err_sts) {
1006 sec_log_hw_error(sec, err_sts);
1008 /* clear error interrupts */
1009 writel(err_sts, sec->qm.io_base + SEC_CORE_INT_SOURCE);
1011 return PCI_ERS_RESULT_NEED_RESET;
1014 return PCI_ERS_RESULT_RECOVERED;
1017 static pci_ers_result_t sec_process_hw_error(struct pci_dev *pdev)
1019 struct sec_dev *sec = pci_get_drvdata(pdev);
1020 pci_ers_result_t qm_ret, sec_ret;
1022 if (!sec) {
1023 pci_err(pdev, "Can't recover error during device init\n");
1024 return PCI_ERS_RESULT_NONE;
1027 /* log qm error */
1028 qm_ret = hisi_qm_hw_error_handle(&sec->qm);
1030 /* log sec error */
1031 sec_ret = sec_hw_error_handle(sec);
1033 return (qm_ret == PCI_ERS_RESULT_NEED_RESET ||
1034 sec_ret == PCI_ERS_RESULT_NEED_RESET) ?
1035 PCI_ERS_RESULT_NEED_RESET : PCI_ERS_RESULT_RECOVERED;
1038 static pci_ers_result_t sec_error_detected(struct pci_dev *pdev,
1039 pci_channel_state_t state)
1041 if (pdev->is_virtfn)
1042 return PCI_ERS_RESULT_NONE;
1044 pci_info(pdev, "PCI error detected, state(=%d)!!\n", state);
1045 if (state == pci_channel_io_perm_failure)
1046 return PCI_ERS_RESULT_DISCONNECT;
1048 return sec_process_hw_error(pdev);
1051 static const struct pci_error_handlers sec_err_handler = {
1052 .error_detected = sec_error_detected,
1055 static struct pci_driver sec_pci_driver = {
1056 .name = "hisi_sec2",
1057 .id_table = sec_dev_ids,
1058 .probe = sec_probe,
1059 .remove = sec_remove,
1060 .err_handler = &sec_err_handler,
1061 .sriov_configure = sec_sriov_configure,
1064 static void sec_register_debugfs(void)
1066 if (!debugfs_initialized())
1067 return;
1069 sec_debugfs_root = debugfs_create_dir("hisi_sec2", NULL);
1072 static void sec_unregister_debugfs(void)
1074 debugfs_remove_recursive(sec_debugfs_root);
1077 static int __init sec_init(void)
1079 int ret;
1081 sec_register_debugfs();
1083 ret = pci_register_driver(&sec_pci_driver);
1084 if (ret < 0) {
1085 sec_unregister_debugfs();
1086 pr_err("Failed to register pci driver.\n");
1087 return ret;
1090 return 0;
1093 static void __exit sec_exit(void)
1095 pci_unregister_driver(&sec_pci_driver);
1096 sec_unregister_debugfs();
1099 module_init(sec_init);
1100 module_exit(sec_exit);
1102 MODULE_LICENSE("GPL v2");
1103 MODULE_AUTHOR("Zaibo Xu <xuzaibo@huawei.com>");
1104 MODULE_AUTHOR("Longfang Liu <liulongfang@huawei.com>");
1105 MODULE_AUTHOR("Wei Zhang <zhangwei375@huawei.com>");
1106 MODULE_DESCRIPTION("Driver for HiSilicon SEC accelerator");