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