Branch data Line data Source code
1 : : /* SPDX-License-Identifier: BSD-3-Clause
2 : : * Copyright(C) 2021 Marvell.
3 : : */
4 : :
5 : : #include "roc_api.h"
6 : : #include "roc_priv.h"
7 : :
8 : : static void
9 : 0 : sso_hwgrp_irq(void *param)
10 : : {
11 : : struct sso_rsrc *rsrc = param;
12 : : uint64_t intr;
13 : :
14 [ # # ]: 0 : intr = plt_read64(rsrc->base + SSO_LF_GGRP_INT);
15 [ # # ]: 0 : if (intr == 0)
16 : : return;
17 : :
18 : 0 : plt_err("GGRP %d GGRP_INT=0x%" PRIx64 "", rsrc->rsrc_id, intr);
19 : :
20 : : /* Clear interrupt */
21 : 0 : plt_write64(intr, rsrc->base + SSO_LF_GGRP_INT);
22 : : }
23 : :
24 : : static int
25 : : sso_hwgrp_register_irq(struct plt_intr_handle *handle, uint16_t ggrp_msixoff,
26 : : struct sso_rsrc *rsrc)
27 : : {
28 : : int rc, vec;
29 : :
30 : : vec = ggrp_msixoff + SSO_LF_INT_VEC_GRP;
31 : :
32 : : /* Clear err interrupt */
33 : 0 : plt_write64(~0ull, rsrc->base + SSO_LF_GGRP_INT_ENA_W1C);
34 : : /* Set used interrupt vectors */
35 : 0 : rc = dev_irq_register(handle, sso_hwgrp_irq, (void *)rsrc, vec);
36 : : /* Enable hw interrupt */
37 : 0 : plt_write64(~0ull, rsrc->base + SSO_LF_GGRP_INT_ENA_W1S);
38 : :
39 : : return rc;
40 : : }
41 : :
42 : : static void
43 : 0 : sso_hws_irq(void *param)
44 : : {
45 : : struct sso_rsrc *rsrc = param;
46 : : uint64_t intr;
47 : :
48 [ # # ]: 0 : intr = plt_read64(rsrc->base + SSOW_LF_GWS_INT);
49 [ # # ]: 0 : if (intr == 0)
50 : : return;
51 : :
52 : 0 : plt_err("GWS %d GWS_INT=0x%" PRIx64 "", rsrc->rsrc_id, intr);
53 : :
54 : : /* Clear interrupt */
55 : 0 : plt_write64(intr, rsrc->base + SSOW_LF_GWS_INT);
56 : : }
57 : :
58 : : static int
59 : : sso_hws_register_irq(struct plt_intr_handle *handle, uint16_t hws_msixoff,
60 : : struct sso_rsrc *rsrc)
61 : : {
62 : : int rc, vec;
63 : :
64 : : vec = hws_msixoff + SSOW_LF_INT_VEC_IOP;
65 : :
66 : : /* Clear err interrupt */
67 : 0 : plt_write64(~0ull, rsrc->base + SSOW_LF_GWS_INT_ENA_W1C);
68 : : /* Set used interrupt vectors */
69 : 0 : rc = dev_irq_register(handle, sso_hws_irq, (void *)rsrc, vec);
70 : : /* Enable hw interrupt */
71 : 0 : plt_write64(~0ull, rsrc->base + SSOW_LF_GWS_INT_ENA_W1S);
72 : :
73 : : return rc;
74 : : }
75 : :
76 : : int
77 : 0 : sso_register_irqs_priv(struct roc_sso *roc_sso, struct plt_intr_handle *handle,
78 : : uint16_t nb_hws, uint16_t nb_hwgrp)
79 : : {
80 : : struct sso *sso = roc_sso_to_sso_priv(roc_sso);
81 : : struct dev *dev = &sso->dev;
82 : : int i, rc = SSO_ERR_PARAM;
83 : :
84 [ # # ]: 0 : for (i = 0; i < nb_hws; i++) {
85 [ # # ]: 0 : if (sso->hws_msix_offset[i] == MSIX_VECTOR_INVALID) {
86 : 0 : plt_err("Invalid SSO HWS MSIX offset[%d] vector 0x%x",
87 : : i, sso->hws_msix_offset[i]);
88 : 0 : goto fail;
89 : : }
90 : : }
91 : :
92 [ # # ]: 0 : for (i = 0; i < nb_hwgrp; i++) {
93 [ # # ]: 0 : if (sso->hwgrp_msix_offset[i] == MSIX_VECTOR_INVALID) {
94 : 0 : plt_err("Invalid SSO HWGRP MSIX offset[%d] vector 0x%x",
95 : : i, sso->hwgrp_msix_offset[i]);
96 : 0 : goto fail;
97 : : }
98 : : }
99 : :
100 [ # # ]: 0 : for (i = 0; i < nb_hws; i++) {
101 : 0 : uintptr_t base =
102 : 0 : dev->bar2 + (RVU_BLOCK_ADDR_SSOW << 20 | i << 12);
103 : :
104 : 0 : sso->hws_rsrc[i].rsrc_id = i;
105 : 0 : sso->hws_rsrc[i].base = base;
106 : 0 : rc = sso_hws_register_irq(handle, sso->hws_msix_offset[i],
107 : : &sso->hws_rsrc[i]);
108 : : }
109 : :
110 [ # # ]: 0 : for (i = 0; i < nb_hwgrp; i++) {
111 : 0 : uintptr_t base =
112 : 0 : dev->bar2 + (RVU_BLOCK_ADDR_SSO << 20 | i << 12);
113 : :
114 : 0 : sso->hwgrp_rsrc[i].rsrc_id = i;
115 : 0 : sso->hwgrp_rsrc[i].base = base;
116 : 0 : rc = sso_hwgrp_register_irq(handle, sso->hwgrp_msix_offset[i],
117 : : &sso->hwgrp_rsrc[i]);
118 : : }
119 : 0 : fail:
120 : 0 : return rc;
121 : : }
122 : :
123 : : static void
124 : : sso_hwgrp_unregister_irq(struct plt_intr_handle *handle, uint16_t ggrp_msixoff,
125 : : struct sso_rsrc *rsrc)
126 : : {
127 : : int vec;
128 : :
129 : : vec = ggrp_msixoff + SSO_LF_INT_VEC_GRP;
130 : :
131 : : /* Clear err interrupt */
132 : 0 : plt_write64(~0ull, rsrc->base + SSO_LF_GGRP_INT_ENA_W1C);
133 : 0 : dev_irq_unregister(handle, sso_hwgrp_irq, (void *)rsrc, vec);
134 : : }
135 : :
136 : : static void
137 : : sso_hws_unregister_irq(struct plt_intr_handle *handle, uint16_t gws_msixoff,
138 : : struct sso_rsrc *rsrc)
139 : : {
140 : : int vec;
141 : :
142 : : vec = gws_msixoff + SSOW_LF_INT_VEC_IOP;
143 : :
144 : : /* Clear err interrupt */
145 : 0 : plt_write64(~0ull, rsrc->base + SSOW_LF_GWS_INT_ENA_W1C);
146 : 0 : dev_irq_unregister(handle, sso_hws_irq, (void *)rsrc, vec);
147 : : }
148 : :
149 : : void
150 : 0 : sso_unregister_irqs_priv(struct roc_sso *roc_sso,
151 : : struct plt_intr_handle *handle, uint16_t nb_hws,
152 : : uint16_t nb_hwgrp)
153 : : {
154 : : struct sso *sso = roc_sso_to_sso_priv(roc_sso);
155 : : int i;
156 : :
157 [ # # ]: 0 : for (i = 0; i < nb_hwgrp; i++)
158 : 0 : sso_hwgrp_unregister_irq(handle, sso->hwgrp_msix_offset[i],
159 : : &sso->hwgrp_rsrc[i]);
160 : :
161 [ # # ]: 0 : for (i = 0; i < nb_hws; i++)
162 : 0 : sso_hws_unregister_irq(handle, sso->hws_msix_offset[i],
163 : : &sso->hws_rsrc[i]);
164 : 0 : }
|
