1 // SPDX-License-Identifier: GPL-2.0-only
2 /* Copyright (C) 2021 Marvell. */
3
4 #include <linux/soc/marvell/octeontx2/asm.h>
5 #include "otx2_cptpf.h"
6 #include "otx2_cptvf.h"
7 #include "otx2_cptlf.h"
8 #include "cn10k_cpt.h"
9
10 static struct cpt_hw_ops otx2_hw_ops = {
11 .send_cmd = otx2_cpt_send_cmd,
12 .cpt_get_compcode = otx2_cpt_get_compcode,
13 .cpt_get_uc_compcode = otx2_cpt_get_uc_compcode,
14 };
15
16 static struct cpt_hw_ops cn10k_hw_ops = {
17 .send_cmd = cn10k_cpt_send_cmd,
18 .cpt_get_compcode = cn10k_cpt_get_compcode,
19 .cpt_get_uc_compcode = cn10k_cpt_get_uc_compcode,
20 };
21
cn10k_cpt_send_cmd(union otx2_cpt_inst_s * cptinst,u32 insts_num,struct otx2_cptlf_info * lf)22 void cn10k_cpt_send_cmd(union otx2_cpt_inst_s *cptinst, u32 insts_num,
23 struct otx2_cptlf_info *lf)
24 {
25 void __iomem *lmtline = lf->lmtline;
26 u64 val = (lf->slot & 0x7FF);
27 u64 tar_addr = 0;
28
29 /* tar_addr<6:4> = Size of first LMTST - 1 in units of 128b. */
30 tar_addr |= (__force u64)lf->ioreg |
31 (((OTX2_CPT_INST_SIZE/16) - 1) & 0x7) << 4;
32 /*
33 * Make sure memory areas pointed in CPT_INST_S
34 * are flushed before the instruction is sent to CPT
35 */
36 dma_wmb();
37
38 /* Copy CPT command to LMTLINE */
39 memcpy_toio(lmtline, cptinst, insts_num * OTX2_CPT_INST_SIZE);
40 cn10k_lmt_flush(val, tar_addr);
41 }
42
cn10k_cptpf_lmtst_init(struct otx2_cptpf_dev * cptpf)43 int cn10k_cptpf_lmtst_init(struct otx2_cptpf_dev *cptpf)
44 {
45 struct pci_dev *pdev = cptpf->pdev;
46 resource_size_t size;
47 u64 lmt_base;
48
49 if (!test_bit(CN10K_LMTST, &cptpf->cap_flag)) {
50 cptpf->lfs.ops = &otx2_hw_ops;
51 return 0;
52 }
53
54 cptpf->lfs.ops = &cn10k_hw_ops;
55 lmt_base = readq(cptpf->reg_base + RVU_PF_LMTLINE_ADDR);
56 if (!lmt_base) {
57 dev_err(&pdev->dev, "PF LMTLINE address not configured\n");
58 return -ENOMEM;
59 }
60 size = pci_resource_len(pdev, PCI_MBOX_BAR_NUM);
61 size -= ((1 + cptpf->max_vfs) * MBOX_SIZE);
62 cptpf->lfs.lmt_base = devm_ioremap_wc(&pdev->dev, lmt_base, size);
63 if (!cptpf->lfs.lmt_base) {
64 dev_err(&pdev->dev,
65 "Mapping of PF LMTLINE address failed\n");
66 return -ENOMEM;
67 }
68
69 return 0;
70 }
71
cn10k_cptvf_lmtst_init(struct otx2_cptvf_dev * cptvf)72 int cn10k_cptvf_lmtst_init(struct otx2_cptvf_dev *cptvf)
73 {
74 struct pci_dev *pdev = cptvf->pdev;
75 resource_size_t offset, size;
76
77 if (!test_bit(CN10K_LMTST, &cptvf->cap_flag)) {
78 cptvf->lfs.ops = &otx2_hw_ops;
79 return 0;
80 }
81
82 cptvf->lfs.ops = &cn10k_hw_ops;
83 offset = pci_resource_start(pdev, PCI_MBOX_BAR_NUM);
84 size = pci_resource_len(pdev, PCI_MBOX_BAR_NUM);
85 /* Map VF LMILINE region */
86 cptvf->lfs.lmt_base = devm_ioremap_wc(&pdev->dev, offset, size);
87 if (!cptvf->lfs.lmt_base) {
88 dev_err(&pdev->dev, "Unable to map BAR4\n");
89 return -ENOMEM;
90 }
91
92 return 0;
93 }
94