octeon_pow.c revision 1.8 1 1.8 simonb /* $NetBSD: octeon_pow.c,v 1.8 2020/06/19 02:23:43 simonb Exp $ */
2 1.1 hikaru
3 1.1 hikaru /*
4 1.1 hikaru * Copyright (c) 2007 Internet Initiative Japan, Inc.
5 1.1 hikaru * All rights reserved.
6 1.1 hikaru *
7 1.1 hikaru * Redistribution and use in source and binary forms, with or without
8 1.1 hikaru * modification, are permitted provided that the following conditions
9 1.1 hikaru * are met:
10 1.1 hikaru * 1. Redistributions of source code must retain the above copyright
11 1.1 hikaru * notice, this list of conditions and the following disclaimer.
12 1.1 hikaru * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 hikaru * notice, this list of conditions and the following disclaimer in the
14 1.1 hikaru * documentation and/or other materials provided with the distribution.
15 1.1 hikaru *
16 1.1 hikaru * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
17 1.1 hikaru * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 1.1 hikaru * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 1.1 hikaru * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
20 1.1 hikaru * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 1.1 hikaru * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 1.1 hikaru * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 1.1 hikaru * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 1.1 hikaru * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 hikaru * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 hikaru * SUCH DAMAGE.
27 1.1 hikaru */
28 1.1 hikaru
29 1.1 hikaru #include <sys/cdefs.h>
30 1.8 simonb __KERNEL_RCSID(0, "$NetBSD: octeon_pow.c,v 1.8 2020/06/19 02:23:43 simonb Exp $");
31 1.1 hikaru
32 1.6 simonb #include "opt_octeon.h" /* CNMAC_DEBUG */
33 1.1 hikaru
34 1.1 hikaru #include <sys/param.h>
35 1.1 hikaru #include <sys/systm.h>
36 1.1 hikaru #include <sys/types.h>
37 1.1 hikaru #include <sys/kernel.h> /* hz */
38 1.1 hikaru #include <sys/malloc.h>
39 1.1 hikaru #include <sys/device.h> /* evcnt */
40 1.1 hikaru #include <sys/syslog.h> /* evcnt */
41 1.1 hikaru
42 1.1 hikaru #include <sys/bus.h>
43 1.1 hikaru
44 1.1 hikaru #include <mips/include/locore.h>
45 1.1 hikaru #include <mips/cavium/octeonvar.h>
46 1.1 hikaru #include <mips/cavium/include/iobusvar.h>
47 1.1 hikaru #include <mips/cavium/dev/octeon_ciureg.h> /* XXX */
48 1.1 hikaru #include <mips/cavium/dev/octeon_powreg.h>
49 1.1 hikaru #include <mips/cavium/dev/octeon_powvar.h>
50 1.1 hikaru
51 1.1 hikaru /* XXX ensure assertion */
52 1.1 hikaru #if !defined(DIAGNOSTIC)
53 1.1 hikaru #define DIAGNOSTIC
54 1.1 hikaru #endif
55 1.1 hikaru
56 1.1 hikaru extern int ipflow_fastforward_disable_flags;
57 1.1 hikaru
58 1.6 simonb struct octpow_intr_handle {
59 1.1 hikaru void *pi_ih;
60 1.6 simonb struct octpow_softc *pi_sc;
61 1.1 hikaru int pi_group;
62 1.1 hikaru void (*pi_cb)(void *, uint64_t *);
63 1.1 hikaru void *pi_data;
64 1.1 hikaru
65 1.6 simonb #ifdef CNMAC_DEBUG
66 1.1 hikaru #define _EV_PER_N 32 /* XXX */
67 1.1 hikaru #define _EV_IVAL_N 32 /* XXX */
68 1.1 hikaru int pi_first;
69 1.1 hikaru struct timeval pi_last;
70 1.1 hikaru struct evcnt pi_ev_per[_EV_PER_N];
71 1.1 hikaru struct evcnt pi_ev_ival[_EV_IVAL_N];
72 1.1 hikaru struct evcnt pi_ev_stray_tc;
73 1.1 hikaru struct evcnt pi_ev_stray_ds;
74 1.1 hikaru struct evcnt pi_ev_stray_iq;
75 1.1 hikaru #endif
76 1.1 hikaru };
77 1.1 hikaru
78 1.6 simonb void octpow_bootstrap(struct octeon_config *);
79 1.1 hikaru
80 1.6 simonb #ifdef CNMAC_DEBUG
81 1.6 simonb void octpow_intr_evcnt_attach(struct octpow_softc *);
82 1.6 simonb void octpow_intr_rml(void *);
83 1.6 simonb
84 1.6 simonb static void octpow_intr_debug_init(
85 1.6 simonb struct octpow_intr_handle *, int);
86 1.6 simonb static inline void octpow_intr_work_debug_ival(struct octpow_softc *,
87 1.6 simonb struct octpow_intr_handle *);
88 1.6 simonb static inline void octpow_intr_work_debug_per(struct octpow_softc *,
89 1.6 simonb struct octpow_intr_handle *, int);
90 1.6 simonb #endif
91 1.6 simonb static void octpow_init(struct octpow_softc *);
92 1.6 simonb static void octpow_init_regs(struct octpow_softc *);
93 1.6 simonb static inline int octpow_tag_sw_poll(void) __unused;
94 1.6 simonb static inline void octpow_tag_sw_wait(void);
95 1.6 simonb static inline void octpow_config_int_pc(struct octpow_softc *, int);
96 1.6 simonb static inline void octpow_config_int(struct octpow_softc *, int, uint64_t,
97 1.6 simonb uint64_t, uint64_t);
98 1.6 simonb static inline void octpow_intr_work(struct octpow_softc *,
99 1.6 simonb struct octpow_intr_handle *, int);
100 1.6 simonb static int octpow_intr(void *);
101 1.1 hikaru
102 1.6 simonb #ifdef CNMAC_DEBUG
103 1.6 simonb void octpow_dump(void);
104 1.1 hikaru #endif
105 1.1 hikaru
106 1.1 hikaru /* XXX */
107 1.6 simonb struct octpow_softc octpow_softc;
108 1.1 hikaru
109 1.6 simonb #ifdef CNMAC_DEBUG
110 1.6 simonb struct octpow_softc *__octpow_softc;
111 1.1 hikaru #endif
112 1.1 hikaru
113 1.1 hikaru /*
114 1.1 hikaru * XXX: parameter tuning is needed: see files.octeon
115 1.1 hikaru */
116 1.6 simonb #ifndef CNMAC_RING_MAX
117 1.6 simonb #define CNMAC_RING_MAX 512
118 1.1 hikaru #endif
119 1.6 simonb #ifndef CNMAC_RING_MIN
120 1.6 simonb #define CNMAC_RING_MIN 1
121 1.1 hikaru #endif
122 1.1 hikaru
123 1.6 simonb #ifdef CNMAC_INTR_FEEDBACK_RING
124 1.6 simonb int max_recv_cnt = CNMAC_RING_MAX;
125 1.6 simonb int min_recv_cnt = CNMAC_RING_MIN;
126 1.6 simonb int recv_cnt = CNMAC_RING_MIN;
127 1.1 hikaru int int_rate = 1;
128 1.1 hikaru #endif
129 1.1 hikaru
130 1.1 hikaru /* -------------------------------------------------------------------------- */
131 1.1 hikaru
132 1.1 hikaru /* ---- utility functions */
133 1.1 hikaru
134 1.1 hikaru
135 1.1 hikaru /* ---- status by coreid */
136 1.1 hikaru
137 1.1 hikaru static inline uint64_t
138 1.6 simonb octpow_status_by_coreid_pend_tag(int coreid)
139 1.1 hikaru {
140 1.6 simonb return octpow_ops_pow_status(coreid, 0, 0, 0);
141 1.1 hikaru }
142 1.1 hikaru
143 1.1 hikaru static inline uint64_t
144 1.6 simonb octpow_status_by_coreid_pend_wqp(int coreid)
145 1.1 hikaru {
146 1.6 simonb return octpow_ops_pow_status(coreid, 0, 0, 1);
147 1.1 hikaru }
148 1.1 hikaru
149 1.1 hikaru static inline uint64_t
150 1.6 simonb octpow_status_by_coreid_cur_tag_next(int coreid)
151 1.1 hikaru {
152 1.6 simonb return octpow_ops_pow_status(coreid, 0, 1, 0);
153 1.1 hikaru }
154 1.1 hikaru
155 1.1 hikaru static inline uint64_t
156 1.6 simonb octpow_status_by_coreid_cur_tag_prev(int coreid)
157 1.1 hikaru {
158 1.6 simonb return octpow_ops_pow_status(coreid, 1, 1, 0);
159 1.1 hikaru }
160 1.1 hikaru
161 1.1 hikaru static inline uint64_t
162 1.6 simonb octpow_status_by_coreid_cur_wqp_next(int coreid)
163 1.1 hikaru {
164 1.6 simonb return octpow_ops_pow_status(coreid, 0, 1, 1);
165 1.1 hikaru }
166 1.1 hikaru
167 1.1 hikaru static inline uint64_t
168 1.6 simonb octpow_status_by_coreid_cur_wqp_prev(int coreid)
169 1.1 hikaru {
170 1.6 simonb return octpow_ops_pow_status(coreid, 1, 1, 1);
171 1.1 hikaru }
172 1.1 hikaru
173 1.1 hikaru /* ---- status by index */
174 1.1 hikaru
175 1.1 hikaru static inline uint64_t
176 1.6 simonb octpow_status_by_index_tag(int index)
177 1.1 hikaru {
178 1.6 simonb return octpow_ops_pow_memory(index, 0, 0);
179 1.1 hikaru }
180 1.1 hikaru
181 1.1 hikaru static inline uint64_t
182 1.6 simonb octpow_status_by_index_wqp(int index)
183 1.1 hikaru {
184 1.6 simonb return octpow_ops_pow_memory(index, 0, 1);
185 1.1 hikaru }
186 1.1 hikaru
187 1.1 hikaru static inline uint64_t
188 1.6 simonb octpow_status_by_index_desched(int index)
189 1.1 hikaru {
190 1.6 simonb return octpow_ops_pow_memory(index, 1, 0);
191 1.1 hikaru }
192 1.1 hikaru
193 1.1 hikaru /* ---- status by qos level */
194 1.1 hikaru
195 1.1 hikaru static inline uint64_t
196 1.6 simonb octpow_status_by_qos_free_loc(int qos)
197 1.1 hikaru {
198 1.6 simonb return octpow_ops_pow_idxptr(qos, 0, 0);
199 1.1 hikaru }
200 1.1 hikaru
201 1.1 hikaru /* ---- status by desched group */
202 1.1 hikaru
203 1.1 hikaru static inline uint64_t
204 1.6 simonb octpow_status_by_grp_nosched_des(int grp)
205 1.1 hikaru {
206 1.6 simonb return octpow_ops_pow_idxptr(grp, 0, 1);
207 1.1 hikaru }
208 1.1 hikaru
209 1.1 hikaru /* ---- status by memory input queue */
210 1.1 hikaru
211 1.1 hikaru static inline uint64_t
212 1.6 simonb octpow_status_by_queue_remote_head(int queue)
213 1.1 hikaru {
214 1.6 simonb return octpow_ops_pow_idxptr(queue, 1, 0);
215 1.1 hikaru }
216 1.1 hikaru
217 1.1 hikaru static inline uint64_t
218 1.6 simonb octpow_status_by_queue_remote_tail(int queue)
219 1.1 hikaru {
220 1.6 simonb return octpow_ops_pow_idxptr(queue, 1, 0);
221 1.1 hikaru }
222 1.1 hikaru
223 1.1 hikaru /* ---- tag switch */
224 1.1 hikaru
225 1.1 hikaru /*
226 1.1 hikaru * "RDHWR rt, $30" returns:
227 1.1 hikaru * 0 => pending bit is set
228 1.1 hikaru * 1 => pending bit is clear
229 1.1 hikaru */
230 1.1 hikaru
231 1.1 hikaru /* return 1 if pending bit is clear (ready) */
232 1.1 hikaru static inline int
233 1.6 simonb octpow_tag_sw_poll(void)
234 1.1 hikaru {
235 1.1 hikaru uint64_t result;
236 1.1 hikaru
237 1.1 hikaru /* XXX O32 */
238 1.1 hikaru __asm __volatile (
239 1.1 hikaru " .set push \n"
240 1.1 hikaru " .set noreorder \n"
241 1.1 hikaru " .set arch=octeon \n"
242 1.1 hikaru " rdhwr %[result], $30 \n"
243 1.1 hikaru " .set pop \n"
244 1.1 hikaru : [result]"=r"(result)
245 1.1 hikaru );
246 1.1 hikaru /* XXX O32 */
247 1.1 hikaru return (int)result;
248 1.1 hikaru }
249 1.1 hikaru
250 1.1 hikaru /* -------------------------------------------------------------------------- */
251 1.1 hikaru
252 1.1 hikaru /* ---- initialization and configuration */
253 1.1 hikaru
254 1.1 hikaru void
255 1.6 simonb octpow_bootstrap(struct octeon_config *mcp)
256 1.1 hikaru {
257 1.6 simonb struct octpow_softc *sc = &octpow_softc;
258 1.1 hikaru
259 1.1 hikaru sc->sc_regt = &mcp->mc_iobus_bust;
260 1.1 hikaru /* XXX */
261 1.1 hikaru
262 1.6 simonb octpow_init(sc);
263 1.1 hikaru
264 1.6 simonb #ifdef CNMAC_DEBUG
265 1.6 simonb __octpow_softc = sc;
266 1.1 hikaru #endif
267 1.1 hikaru
268 1.1 hikaru }
269 1.1 hikaru
270 1.1 hikaru static inline void
271 1.6 simonb octpow_config_int(struct octpow_softc *sc, int group, uint64_t tc_thr,
272 1.6 simonb uint64_t ds_thr, uint64_t iq_thr)
273 1.1 hikaru {
274 1.7 simonb uint64_t wq_int_thr =
275 1.7 simonb POW_WQ_INT_THRX_TC_EN |
276 1.7 simonb __SHIFTIN(tc_thr, POW_WQ_INT_THRX_TC_THR) |
277 1.7 simonb __SHIFTIN(ds_thr, POW_WQ_INT_THRX_DS_THR) |
278 1.7 simonb __SHIFTIN(iq_thr, POW_WQ_INT_THRX_IQ_THR);
279 1.1 hikaru
280 1.1 hikaru _POW_WR8(sc, POW_WQ_INT_THR0_OFFSET + (group * 8), wq_int_thr);
281 1.1 hikaru }
282 1.1 hikaru
283 1.1 hikaru /*
284 1.1 hikaru * interrupt threshold configuration
285 1.1 hikaru *
286 1.1 hikaru * => DS / IQ
287 1.1 hikaru * => ...
288 1.1 hikaru * => time counter threshold
289 1.1 hikaru * => unit is 1msec
290 1.1 hikaru * => each group can set timeout
291 1.1 hikaru * => temporary disable bit
292 1.1 hikaru * => use CIU generic timer
293 1.1 hikaru */
294 1.1 hikaru
295 1.1 hikaru void
296 1.6 simonb octpow_config(struct octpow_softc *sc, int group)
297 1.1 hikaru {
298 1.1 hikaru
299 1.6 simonb octpow_config_int(sc, group,
300 1.1 hikaru 0x0f, /* TC */
301 1.1 hikaru 0x00, /* DS */
302 1.1 hikaru 0x00); /* IQ */
303 1.1 hikaru }
304 1.1 hikaru
305 1.1 hikaru void *
306 1.6 simonb octpow_intr_establish(int group, int level, void (*cb)(void *, uint64_t *),
307 1.6 simonb void (*fcb)(int*, int *, uint64_t, void *), void *data)
308 1.1 hikaru {
309 1.6 simonb struct octpow_intr_handle *pow_ih;
310 1.1 hikaru
311 1.1 hikaru KASSERT(group >= 0);
312 1.1 hikaru KASSERT(group < 16);
313 1.1 hikaru
314 1.5 chs pow_ih = malloc(sizeof(*pow_ih), M_DEVBUF, M_WAITOK);
315 1.1 hikaru pow_ih->pi_ih = octeon_intr_establish(
316 1.8 simonb CIU_INT_WORKQ_0 + group,
317 1.1 hikaru level,
318 1.6 simonb octpow_intr, pow_ih);
319 1.1 hikaru KASSERT(pow_ih->pi_ih != NULL);
320 1.1 hikaru
321 1.6 simonb pow_ih->pi_sc = &octpow_softc; /* XXX */
322 1.1 hikaru pow_ih->pi_group = group;
323 1.1 hikaru pow_ih->pi_cb = cb;
324 1.1 hikaru pow_ih->pi_data = data;
325 1.1 hikaru
326 1.6 simonb #ifdef CNMAC_DEBUG
327 1.6 simonb octpow_intr_debug_init(pow_ih, group);
328 1.1 hikaru #endif
329 1.1 hikaru return pow_ih;
330 1.1 hikaru }
331 1.1 hikaru
332 1.6 simonb #ifdef CNMAC_DEBUG
333 1.1 hikaru #define _NAMELEN 8
334 1.1 hikaru #define _DESCRLEN 40
335 1.1 hikaru
336 1.1 hikaru static void
337 1.6 simonb octpow_intr_debug_init(struct octpow_intr_handle *pow_ih, int group)
338 1.1 hikaru {
339 1.1 hikaru pow_ih->pi_first = 1;
340 1.1 hikaru char *name, *descr;
341 1.1 hikaru int i;
342 1.1 hikaru
343 1.1 hikaru name = malloc(_NAMELEN +
344 1.1 hikaru _DESCRLEN * __arraycount(pow_ih->pi_ev_per) +
345 1.1 hikaru _DESCRLEN * __arraycount(pow_ih->pi_ev_ival),
346 1.5 chs M_DEVBUF, M_WAITOK);
347 1.1 hikaru descr = name + _NAMELEN;
348 1.1 hikaru snprintf(name, _NAMELEN, "pow%d", group);
349 1.1 hikaru for (i = 0; i < (int)__arraycount(pow_ih->pi_ev_per); i++) {
350 1.1 hikaru int n = 1 << (i - 1);
351 1.1 hikaru
352 1.1 hikaru (void)snprintf(descr, _DESCRLEN,
353 1.1 hikaru "# of works per intr (%d-%d)",
354 1.1 hikaru (i == 0) ? 0 : n,
355 1.1 hikaru (i == 0) ? 0 : ((n << 1) - 1));
356 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_per[i],
357 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, descr);
358 1.1 hikaru descr += _DESCRLEN;
359 1.1 hikaru }
360 1.1 hikaru for (i = 0; i < (int)__arraycount(pow_ih->pi_ev_ival); i++) {
361 1.1 hikaru int n = 1 << (i - 1);
362 1.1 hikaru int p, q;
363 1.1 hikaru char unit;
364 1.1 hikaru
365 1.1 hikaru p = n;
366 1.1 hikaru q = (n << 1) - 1;
367 1.1 hikaru unit = 'u';
368 1.1 hikaru /*
369 1.1 hikaru * 0 is exceptional
370 1.1 hikaru */
371 1.1 hikaru if (i == 0)
372 1.1 hikaru p = q = 0;
373 1.1 hikaru /*
374 1.1 hikaru * count 1024usec as 1msec
375 1.1 hikaru *
376 1.1 hikaru * XXX this is not exact
377 1.1 hikaru */
378 1.1 hikaru if ((i - 1) >= 10) {
379 1.1 hikaru p /= 1000;
380 1.1 hikaru q /= 1000;
381 1.1 hikaru unit = 'm';
382 1.1 hikaru }
383 1.1 hikaru (void)snprintf(descr, _DESCRLEN, "intr interval (%d-%d%csec)",
384 1.1 hikaru p, q, unit);
385 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_ival[i],
386 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, descr);
387 1.1 hikaru descr += _DESCRLEN;
388 1.1 hikaru }
389 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_stray_tc,
390 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, "stray intr (TC)");
391 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_stray_ds,
392 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, "stray intr (DS)");
393 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_stray_iq,
394 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, "stray intr (IQ)");
395 1.1 hikaru }
396 1.1 hikaru #endif
397 1.1 hikaru
398 1.1 hikaru void
399 1.6 simonb octpow_init(struct octpow_softc *sc)
400 1.1 hikaru {
401 1.6 simonb octpow_init_regs(sc);
402 1.1 hikaru
403 1.1 hikaru sc->sc_int_pc_base = 10000;
404 1.6 simonb octpow_config_int_pc(sc, sc->sc_int_pc_base);
405 1.1 hikaru
406 1.6 simonb #ifdef CNMAC_DEBUG
407 1.6 simonb octpow_error_int_enable(sc, 1);
408 1.1 hikaru #endif
409 1.1 hikaru }
410 1.1 hikaru
411 1.1 hikaru void
412 1.6 simonb octpow_init_regs(struct octpow_softc *sc)
413 1.1 hikaru {
414 1.1 hikaru int status;
415 1.1 hikaru
416 1.1 hikaru status = bus_space_map(sc->sc_regt, POW_BASE, POW_SIZE, 0,
417 1.1 hikaru &sc->sc_regh);
418 1.1 hikaru if (status != 0)
419 1.1 hikaru panic("can't map %s space", "pow register");
420 1.1 hikaru
421 1.6 simonb #ifdef CNMAC_DEBUG
422 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET,
423 1.1 hikaru POW_ECC_ERR_IOP_IE | POW_ECC_ERR_RPE_IE |
424 1.1 hikaru POW_ECC_ERR_DBE_IE | POW_ECC_ERR_SBE_IE);
425 1.1 hikaru #endif
426 1.1 hikaru }
427 1.1 hikaru
428 1.1 hikaru /* -------------------------------------------------------------------------- */
429 1.1 hikaru
430 1.1 hikaru /* ---- interrupt handling */
431 1.1 hikaru
432 1.6 simonb #ifdef CNMAC_DEBUG
433 1.1 hikaru static inline void
434 1.6 simonb octpow_intr_work_debug_ival(struct octpow_softc *sc,
435 1.6 simonb struct octpow_intr_handle *pow_ih)
436 1.1 hikaru {
437 1.1 hikaru struct timeval now;
438 1.1 hikaru struct timeval ival;
439 1.1 hikaru int n;
440 1.1 hikaru
441 1.1 hikaru microtime(&now);
442 1.1 hikaru if (__predict_false(pow_ih->pi_first == 1)) {
443 1.1 hikaru pow_ih->pi_first = 0;
444 1.1 hikaru goto stat_done;
445 1.1 hikaru }
446 1.1 hikaru timersub(&now, &pow_ih->pi_last, &ival);
447 1.1 hikaru if (ival.tv_sec != 0)
448 1.1 hikaru goto stat_done; /* XXX */
449 1.1 hikaru n = ffs64((uint64_t)ival.tv_usec);
450 1.1 hikaru if (n > (int)__arraycount(pow_ih->pi_ev_ival) - 1)
451 1.1 hikaru n = (int)__arraycount(pow_ih->pi_ev_ival) - 1;
452 1.1 hikaru pow_ih->pi_ev_ival[n].ev_count++;
453 1.1 hikaru
454 1.1 hikaru stat_done:
455 1.1 hikaru pow_ih->pi_last = now; /* struct copy */
456 1.1 hikaru }
457 1.1 hikaru
458 1.1 hikaru static inline void
459 1.6 simonb octpow_intr_work_debug_per(struct octpow_softc *sc,
460 1.6 simonb struct octpow_intr_handle *pow_ih, int count)
461 1.1 hikaru {
462 1.1 hikaru int n;
463 1.1 hikaru
464 1.1 hikaru n = ffs64(count);
465 1.1 hikaru if (n > (int)__arraycount(pow_ih->pi_ev_per) - 1)
466 1.1 hikaru n = (int)__arraycount(pow_ih->pi_ev_per) - 1;
467 1.1 hikaru pow_ih->pi_ev_per[n].ev_count++;
468 1.1 hikaru #if 1
469 1.1 hikaru if (count == 0) {
470 1.1 hikaru uint64_t wq_int_cnt;
471 1.1 hikaru
472 1.1 hikaru wq_int_cnt = _POW_GROUP_RD8(sc, pow_ih, POW_WQ_INT_CNT0_OFFSET);
473 1.1 hikaru if (wq_int_cnt & POW_WQ_INT_CNTX_TC_CNT)
474 1.1 hikaru pow_ih->pi_ev_stray_tc.ev_count++;
475 1.1 hikaru if (wq_int_cnt & POW_WQ_INT_CNTX_DS_CNT)
476 1.1 hikaru pow_ih->pi_ev_stray_ds.ev_count++;
477 1.1 hikaru if (wq_int_cnt & POW_WQ_INT_CNTX_IQ_CNT)
478 1.1 hikaru pow_ih->pi_ev_stray_iq.ev_count++;
479 1.1 hikaru }
480 1.1 hikaru #endif
481 1.1 hikaru }
482 1.1 hikaru #endif
483 1.1 hikaru
484 1.6 simonb #ifdef CNMAC_DEBUG
485 1.1 hikaru #define _POW_INTR_WORK_DEBUG_IVAL(sc, ih) \
486 1.6 simonb octpow_intr_work_debug_ival((sc), (ih))
487 1.1 hikaru #define _POW_INTR_WORK_DEBUG_PER(sc, ih, count) \
488 1.6 simonb octpow_intr_work_debug_per((sc), (ih), (count))
489 1.1 hikaru #else
490 1.1 hikaru #define _POW_INTR_WORK_DEBUG_IVAL(sc, ih) \
491 1.1 hikaru do {} while (0)
492 1.1 hikaru #define _POW_INTR_WORK_DEBUG_PER(sc, ih, count) \
493 1.1 hikaru do {} while (0)
494 1.1 hikaru #endif
495 1.1 hikaru
496 1.1 hikaru /*
497 1.1 hikaru * Interrupt handling by fixed count, following Cavium's SDK code.
498 1.1 hikaru *
499 1.1 hikaru * XXX the fixed count (MAX_RX_CNT) could be changed dynamically?
500 1.1 hikaru *
501 1.1 hikaru * XXX this does not utilize "tag switch" very well
502 1.1 hikaru */
503 1.1 hikaru /*
504 1.4 msaitoh * usually all packet receive
505 1.1 hikaru */
506 1.1 hikaru #define MAX_RX_CNT 0x7fffffff
507 1.1 hikaru
508 1.1 hikaru static inline void
509 1.6 simonb octpow_intr_work(struct octpow_softc *sc, struct octpow_intr_handle *pow_ih,
510 1.6 simonb int recv_limit)
511 1.1 hikaru {
512 1.1 hikaru uint64_t *work;
513 1.1 hikaru uint64_t count = 0;
514 1.1 hikaru
515 1.7 simonb _POW_WR8(sc, POW_PP_GRP_MSK0_OFFSET, __BIT(pow_ih->pi_group));
516 1.1 hikaru
517 1.1 hikaru _POW_INTR_WORK_DEBUG_IVAL(sc, pow_ih);
518 1.1 hikaru
519 1.1 hikaru for (count = 0; count < recv_limit; count++) {
520 1.6 simonb octpow_tag_sw_wait();
521 1.6 simonb octpow_work_request_async(
522 1.1 hikaru OCTEON_CVMSEG_OFFSET(csm_pow_intr), POW_NO_WAIT);
523 1.6 simonb work = (uint64_t *)octpow_work_response_async(
524 1.1 hikaru OCTEON_CVMSEG_OFFSET(csm_pow_intr));
525 1.1 hikaru if (work == NULL)
526 1.1 hikaru break;
527 1.1 hikaru (*pow_ih->pi_cb)(pow_ih->pi_data, work);
528 1.1 hikaru }
529 1.1 hikaru
530 1.1 hikaru _POW_INTR_WORK_DEBUG_PER(sc, pow_ih, count);
531 1.1 hikaru }
532 1.1 hikaru
533 1.1 hikaru static int
534 1.6 simonb octpow_intr(void *data)
535 1.1 hikaru {
536 1.6 simonb struct octpow_intr_handle *pow_ih = data;
537 1.6 simonb struct octpow_softc *sc = pow_ih->pi_sc;
538 1.7 simonb uint64_t wq_int_mask = __BIT(pow_ih->pi_group);
539 1.1 hikaru
540 1.6 simonb #ifdef CNMAC_INTR_FEEDBACK_RING
541 1.6 simonb octpow_intr_work(sc, pow_ih, recv_cnt);
542 1.1 hikaru #else
543 1.6 simonb octpow_intr_work(sc, pow_ih, INT_MAX);
544 1.6 simonb #endif /* CNMAC_INTR_FEEDBACK_RING */
545 1.1 hikaru
546 1.7 simonb _POW_WR8(sc, POW_WQ_INT_OFFSET,
547 1.7 simonb __SHIFTIN(wq_int_mask, POW_WQ_INT_WQ_INT));
548 1.1 hikaru return 1;
549 1.1 hikaru }
550 1.1 hikaru
551 1.6 simonb #ifdef CNMAC_INTR_FEEDBACK_RING
552 1.1 hikaru int
553 1.6 simonb octpow_ring_reduce(void *arg)
554 1.1 hikaru {
555 1.6 simonb struct octpow_softc *sc = arg;
556 1.1 hikaru int new, newi;
557 1.1 hikaru int s;
558 1.1 hikaru
559 1.1 hikaru #if 0
560 1.1 hikaru if (ipflow_fastforward_disable_flags == 0) {
561 1.1 hikaru newi = int_rate = 1;
562 1.6 simonb octpow_config_int_pc_rate(sc, int_rate);
563 1.1 hikaru return recv_cnt;
564 1.1 hikaru }
565 1.1 hikaru #endif
566 1.1 hikaru
567 1.1 hikaru new = recv_cnt / 2;
568 1.1 hikaru if (new < min_recv_cnt) {
569 1.1 hikaru newi = int_rate << 1;
570 1.1 hikaru if (newi > 128) {
571 1.1 hikaru newi = 128;
572 1.1 hikaru #ifdef POW_DEBUG
573 1.1 hikaru log(LOG_DEBUG,
574 1.1 hikaru "Min intr rate.\n");
575 1.1 hikaru #endif
576 1.1 hikaru new = min_recv_cnt;
577 1.1 hikaru }
578 1.1 hikaru else {
579 1.1 hikaru log(LOG_DEBUG,
580 1.1 hikaru "pow interrupt rate optimized %d->%d.\n",
581 1.1 hikaru int_rate, newi);
582 1.1 hikaru int_rate = newi;
583 1.6 simonb octpow_config_int_pc_rate(sc, int_rate);
584 1.1 hikaru new = max_recv_cnt;
585 1.1 hikaru }
586 1.1 hikaru }
587 1.1 hikaru
588 1.1 hikaru s = splhigh(); /* XXX */
589 1.1 hikaru recv_cnt = new;
590 1.1 hikaru splx(s);
591 1.1 hikaru
592 1.1 hikaru return new;
593 1.1 hikaru }
594 1.1 hikaru
595 1.1 hikaru int
596 1.6 simonb octpow_ring_grow(void *arg)
597 1.1 hikaru {
598 1.6 simonb struct octpow_softc *sc = arg;
599 1.1 hikaru int new, newi;
600 1.1 hikaru int s;
601 1.1 hikaru
602 1.1 hikaru #if 0
603 1.1 hikaru if (ipflow_fastforward_disable_flags == 0) {
604 1.1 hikaru newi = int_rate = 1;
605 1.6 simonb octpow_config_int_pc_rate(sc, int_rate);
606 1.1 hikaru return recv_cnt;
607 1.1 hikaru }
608 1.1 hikaru #endif
609 1.1 hikaru
610 1.1 hikaru new = recv_cnt + 1;
611 1.1 hikaru if (new > max_recv_cnt) {
612 1.1 hikaru newi = int_rate >> 1;
613 1.1 hikaru if (newi <= 0) {
614 1.1 hikaru newi = 1;
615 1.1 hikaru #ifdef POW_DEBUG
616 1.1 hikaru log(LOG_DEBUG,
617 1.1 hikaru "Max intr rate.\n");
618 1.1 hikaru #endif
619 1.1 hikaru new = max_recv_cnt;
620 1.1 hikaru }
621 1.1 hikaru else {
622 1.1 hikaru log(LOG_DEBUG,
623 1.1 hikaru "pow interrupt rate optimized %d->%d.\n",
624 1.1 hikaru int_rate, newi);
625 1.1 hikaru int_rate = newi;
626 1.6 simonb octpow_config_int_pc_rate(sc, int_rate);
627 1.1 hikaru new = min_recv_cnt;
628 1.1 hikaru }
629 1.1 hikaru }
630 1.1 hikaru
631 1.1 hikaru s = splhigh(); /* XXX */
632 1.1 hikaru recv_cnt = new;
633 1.1 hikaru splx(s);
634 1.1 hikaru
635 1.1 hikaru return new;
636 1.1 hikaru }
637 1.1 hikaru
638 1.1 hikaru int
639 1.6 simonb octpow_ring_size(void)
640 1.1 hikaru {
641 1.1 hikaru return recv_cnt;
642 1.1 hikaru }
643 1.1 hikaru
644 1.1 hikaru int
645 1.6 simonb octpow_ring_intr(void)
646 1.1 hikaru {
647 1.1 hikaru return int_rate;
648 1.1 hikaru }
649 1.6 simonb #endif /* CNMAC_INTR_FEEDBACK_RING */
650 1.1 hikaru
651 1.1 hikaru /* -------------------------------------------------------------------------- */
652 1.1 hikaru
653 1.1 hikaru /* ---- debug configuration */
654 1.1 hikaru
655 1.6 simonb #ifdef CNMAC_DEBUG
656 1.1 hikaru
657 1.1 hikaru void
658 1.6 simonb octpow_error_int_enable(void *data, int enable)
659 1.1 hikaru {
660 1.6 simonb struct octpow_softc *sc = data;
661 1.1 hikaru uint64_t pow_error_int_xxx;
662 1.1 hikaru
663 1.1 hikaru pow_error_int_xxx =
664 1.1 hikaru POW_ECC_ERR_IOP | POW_ECC_ERR_RPE |
665 1.1 hikaru POW_ECC_ERR_DBE | POW_ECC_ERR_SBE;
666 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET, pow_error_int_xxx);
667 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET, enable ? pow_error_int_xxx : 0);
668 1.1 hikaru }
669 1.1 hikaru
670 1.1 hikaru uint64_t
671 1.6 simonb octpow_error_int_summary(void *data)
672 1.1 hikaru {
673 1.6 simonb struct octpow_softc *sc = data;
674 1.1 hikaru uint64_t summary;
675 1.1 hikaru
676 1.1 hikaru summary = _POW_RD8(sc, POW_ECC_ERR_OFFSET);
677 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET, summary);
678 1.1 hikaru return summary;
679 1.1 hikaru }
680 1.1 hikaru
681 1.1 hikaru #endif
682 1.1 hikaru
683 1.1 hikaru /* -------------------------------------------------------------------------- */
684 1.1 hikaru
685 1.1 hikaru /* ---- debug counter */
686 1.1 hikaru
687 1.6 simonb #ifdef CNMAC_DEBUG
688 1.6 simonb int octpow_intr_rml_verbose;
689 1.6 simonb struct evcnt octpow_intr_evcnt;
690 1.1 hikaru
691 1.6 simonb static const struct octeon_evcnt_entry octpow_intr_evcnt_entries[] = {
692 1.1 hikaru #define _ENTRY(name, type, parent, descr) \
693 1.6 simonb OCTEON_EVCNT_ENTRY(struct octpow_softc, name, type, parent, descr)
694 1.1 hikaru _ENTRY(powecciopcsrpend, MISC, NULL, "pow csr load"),
695 1.1 hikaru _ENTRY(powecciopdbgpend, MISC, NULL, "pow dbg load"),
696 1.1 hikaru _ENTRY(powecciopaddwork, MISC, NULL, "pow addwork"),
697 1.1 hikaru _ENTRY(powecciopillop, MISC, NULL, "pow ill op"),
698 1.1 hikaru _ENTRY(poweccioppend24, MISC, NULL, "pow pend24"),
699 1.1 hikaru _ENTRY(poweccioppend23, MISC, NULL, "pow pend23"),
700 1.1 hikaru _ENTRY(poweccioppend22, MISC, NULL, "pow pend22"),
701 1.1 hikaru _ENTRY(poweccioppend21, MISC, NULL, "pow pend21"),
702 1.1 hikaru _ENTRY(poweccioptagnull, MISC, NULL, "pow tag null"),
703 1.1 hikaru _ENTRY(poweccioptagnullnull, MISC, NULL, "pow tag nullnull"),
704 1.1 hikaru _ENTRY(powecciopordatom, MISC, NULL, "pow ordered atomic"),
705 1.1 hikaru _ENTRY(powecciopnull, MISC, NULL, "pow core null"),
706 1.1 hikaru _ENTRY(powecciopnullnull, MISC, NULL, "pow core nullnull"),
707 1.1 hikaru _ENTRY(poweccrpe, MISC, NULL, "pow remote-pointer error"),
708 1.1 hikaru _ENTRY(poweccsyn, MISC, NULL, "pow syndrome value"),
709 1.1 hikaru _ENTRY(poweccdbe, MISC, NULL, "pow double bit"),
710 1.1 hikaru _ENTRY(poweccsbe, MISC, NULL, "pow single bit"),
711 1.1 hikaru #undef _ENTRY
712 1.1 hikaru };
713 1.1 hikaru
714 1.1 hikaru void
715 1.6 simonb octpow_intr_evcnt_attach(struct octpow_softc *sc)
716 1.1 hikaru {
717 1.6 simonb OCTEON_EVCNT_ATTACH_EVCNTS(sc, octpow_intr_evcnt_entries, "pow0");
718 1.1 hikaru }
719 1.1 hikaru
720 1.1 hikaru void
721 1.6 simonb octpow_intr_rml(void *arg)
722 1.1 hikaru {
723 1.6 simonb struct octpow_softc *sc;
724 1.1 hikaru uint64_t reg;
725 1.1 hikaru
726 1.6 simonb octpow_intr_evcnt.ev_count++;
727 1.6 simonb sc = __octpow_softc;
728 1.1 hikaru KASSERT(sc != NULL);
729 1.6 simonb reg = octpow_error_int_summary(sc);
730 1.6 simonb if (octpow_intr_rml_verbose)
731 1.1 hikaru printf("%s: POW_ECC_ERR=0x%016" PRIx64 "\n", __func__, reg);
732 1.1 hikaru switch (reg & POW_ECC_ERR_IOP) {
733 1.1 hikaru case POW_ECC_ERR_IOP_CSRPEND:
734 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopcsrpend);
735 1.1 hikaru break;
736 1.1 hikaru case POW_ECC_ERR_IOP_DBGPEND:
737 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopdbgpend);
738 1.1 hikaru break;
739 1.1 hikaru case POW_ECC_ERR_IOP_ADDWORK:
740 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopaddwork);
741 1.1 hikaru break;
742 1.1 hikaru case POW_ECC_ERR_IOP_ILLOP:
743 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopillop);
744 1.1 hikaru break;
745 1.1 hikaru case POW_ECC_ERR_IOP_PEND24:
746 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend24);
747 1.1 hikaru break;
748 1.1 hikaru case POW_ECC_ERR_IOP_PEND23:
749 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend23);
750 1.1 hikaru break;
751 1.1 hikaru case POW_ECC_ERR_IOP_PEND22:
752 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend22);
753 1.1 hikaru break;
754 1.1 hikaru case POW_ECC_ERR_IOP_PEND21:
755 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend21);
756 1.1 hikaru break;
757 1.1 hikaru case POW_ECC_ERR_IOP_TAGNULL:
758 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioptagnull);
759 1.1 hikaru break;
760 1.1 hikaru case POW_ECC_ERR_IOP_TAGNULLNULL:
761 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioptagnullnull);
762 1.1 hikaru break;
763 1.1 hikaru case POW_ECC_ERR_IOP_ORDATOM:
764 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopordatom);
765 1.1 hikaru break;
766 1.1 hikaru case POW_ECC_ERR_IOP_NULL:
767 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopnull);
768 1.1 hikaru break;
769 1.1 hikaru case POW_ECC_ERR_IOP_NULLNULL:
770 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopnullnull);
771 1.1 hikaru break;
772 1.1 hikaru default:
773 1.1 hikaru break;
774 1.1 hikaru }
775 1.1 hikaru if (reg & POW_ECC_ERR_RPE)
776 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccrpe);
777 1.1 hikaru if (reg & POW_ECC_ERR_SYN)
778 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccsyn);
779 1.1 hikaru if (reg & POW_ECC_ERR_DBE)
780 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccdbe);
781 1.1 hikaru if (reg & POW_ECC_ERR_SBE)
782 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccsbe);
783 1.1 hikaru }
784 1.1 hikaru #endif
785 1.1 hikaru
786 1.1 hikaru /* -------------------------------------------------------------------------- */
787 1.1 hikaru
788 1.1 hikaru /* ---- debug dump */
789 1.1 hikaru
790 1.6 simonb #ifdef CNMAC_DEBUG
791 1.1 hikaru
792 1.6 simonb void octpow_dump_reg(void);
793 1.6 simonb void octpow_dump_ops(void);
794 1.1 hikaru
795 1.1 hikaru void
796 1.6 simonb octpow_dump(void)
797 1.1 hikaru {
798 1.6 simonb octpow_dump_reg();
799 1.6 simonb octpow_dump_ops();
800 1.1 hikaru }
801 1.1 hikaru
802 1.1 hikaru /* ---- register dump */
803 1.1 hikaru
804 1.6 simonb struct octpow_dump_reg_entry {
805 1.1 hikaru const char *name;
806 1.1 hikaru const char *format;
807 1.1 hikaru size_t offset;
808 1.1 hikaru };
809 1.1 hikaru
810 1.1 hikaru #define _ENTRY(x) { #x, x##_BITS, x##_OFFSET }
811 1.1 hikaru #define _ENTRY_0_7(x) \
812 1.1 hikaru _ENTRY(x## 0), _ENTRY(x## 1), _ENTRY(x## 2), _ENTRY(x## 3), \
813 1.1 hikaru _ENTRY(x## 4), _ENTRY(x## 5), _ENTRY(x## 6), _ENTRY(x## 7)
814 1.1 hikaru #define _ENTRY_0_15(x) \
815 1.1 hikaru _ENTRY(x## 0), _ENTRY(x## 1), _ENTRY(x## 2), _ENTRY(x## 3), \
816 1.1 hikaru _ENTRY(x## 4), _ENTRY(x## 5), _ENTRY(x## 6), _ENTRY(x## 7), \
817 1.1 hikaru _ENTRY(x## 8), _ENTRY(x## 9), _ENTRY(x##10), _ENTRY(x##11), \
818 1.1 hikaru _ENTRY(x##12), _ENTRY(x##13), _ENTRY(x##14), _ENTRY(x##15)
819 1.1 hikaru
820 1.6 simonb static const struct octpow_dump_reg_entry octpow_dump_reg_entries[] = {
821 1.1 hikaru _ENTRY (POW_PP_GRP_MSK0),
822 1.1 hikaru _ENTRY (POW_PP_GRP_MSK1),
823 1.1 hikaru _ENTRY_0_15 (POW_WQ_INT_THR),
824 1.1 hikaru _ENTRY_0_15 (POW_WQ_INT_CNT),
825 1.1 hikaru _ENTRY_0_7 (POW_QOS_THR),
826 1.1 hikaru _ENTRY_0_7 (POW_QOS_RND),
827 1.1 hikaru _ENTRY (POW_WQ_INT),
828 1.1 hikaru _ENTRY (POW_WQ_INT_PC),
829 1.1 hikaru _ENTRY (POW_NW_TIM),
830 1.1 hikaru _ENTRY (POW_ECC_ERR),
831 1.1 hikaru _ENTRY (POW_NOS_CNT),
832 1.1 hikaru _ENTRY_0_15 (POW_WS_PC),
833 1.1 hikaru _ENTRY_0_7 (POW_WA_PC),
834 1.1 hikaru _ENTRY_0_7 (POW_IQ_CNT),
835 1.1 hikaru _ENTRY (POW_WA_COM_PC),
836 1.1 hikaru _ENTRY (POW_IQ_COM_CNT),
837 1.1 hikaru _ENTRY (POW_TS_PC),
838 1.1 hikaru _ENTRY (POW_DS_PC),
839 1.1 hikaru _ENTRY (POW_BIST_STAT)
840 1.1 hikaru };
841 1.1 hikaru
842 1.1 hikaru #undef _ENTRY
843 1.1 hikaru
844 1.1 hikaru void
845 1.6 simonb octpow_dump_reg(void)
846 1.1 hikaru {
847 1.6 simonb struct octpow_softc *sc = __octpow_softc;
848 1.6 simonb const struct octpow_dump_reg_entry *entry;
849 1.1 hikaru uint64_t tmp;
850 1.1 hikaru char buf[512];
851 1.1 hikaru int i;
852 1.1 hikaru
853 1.6 simonb for (i = 0; i < (int)__arraycount(octpow_dump_reg_entries); i++) {
854 1.6 simonb entry = &octpow_dump_reg_entries[i];
855 1.1 hikaru tmp = _POW_RD8(sc, entry->offset);
856 1.1 hikaru if (entry->format == NULL)
857 1.1 hikaru snprintf(buf, sizeof(buf), "%16" PRIx64, tmp);
858 1.1 hikaru else
859 1.1 hikaru snprintb(buf, sizeof(buf), entry->format, tmp);
860 1.1 hikaru printf("\t%-24s: %s\n", entry->name, buf);
861 1.1 hikaru }
862 1.1 hikaru }
863 1.1 hikaru
864 1.1 hikaru /* ---- operations dump */
865 1.1 hikaru
866 1.6 simonb struct octpow_dump_ops_entry {
867 1.1 hikaru const char *name;
868 1.1 hikaru const char *format;
869 1.1 hikaru uint64_t (*func)(int);
870 1.1 hikaru };
871 1.1 hikaru
872 1.6 simonb void octpow_dump_ops_coreid(int);
873 1.6 simonb void octpow_dump_ops_index(int);
874 1.6 simonb void octpow_dump_ops_qos(int);
875 1.6 simonb void octpow_dump_ops_grp(int);
876 1.6 simonb void octpow_dump_ops_queue(int);
877 1.6 simonb void octpow_dump_ops_common(const struct octpow_dump_ops_entry *, size_t,
878 1.6 simonb const char *, int);
879 1.1 hikaru
880 1.1 hikaru #define _ENTRY_COMMON(name, prefix, x, y) \
881 1.6 simonb { #name "_" #x, prefix##_##y##_BITS, octpow_status_by_##name##_##x }
882 1.1 hikaru
883 1.6 simonb const struct octpow_dump_ops_entry octpow_dump_ops_coreid_entries[] = {
884 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(coreid, POW_STATUS_LOAD_RESULT, x, y)
885 1.1 hikaru _ENTRY(pend_tag, PEND_TAG),
886 1.1 hikaru _ENTRY(pend_wqp, PEND_WQP),
887 1.1 hikaru _ENTRY(cur_tag_next, CUR_TAG_NEXT),
888 1.1 hikaru _ENTRY(cur_tag_prev, CUR_TAG_PREV),
889 1.1 hikaru _ENTRY(cur_wqp_next, CUR_WQP_NEXT),
890 1.1 hikaru _ENTRY(cur_wqp_prev, CUR_WQP_PREV)
891 1.1 hikaru #undef _ENTRY
892 1.1 hikaru };
893 1.1 hikaru
894 1.6 simonb const struct octpow_dump_ops_entry octpow_dump_ops_index_entries[] = {
895 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(index, POW_MEMORY_LOAD_RESULT, x, y)
896 1.1 hikaru _ENTRY(tag, TAG),
897 1.1 hikaru _ENTRY(wqp, WQP),
898 1.1 hikaru _ENTRY(desched, DESCHED)
899 1.1 hikaru #undef _ENTRY
900 1.1 hikaru };
901 1.1 hikaru
902 1.6 simonb const struct octpow_dump_ops_entry octpow_dump_ops_qos_entries[] = {
903 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(qos, POW_IDXPTR_LOAD_RESULT_QOS, x, y)
904 1.1 hikaru _ENTRY(free_loc, FREE_LOC)
905 1.1 hikaru #undef _ENTRY
906 1.1 hikaru };
907 1.1 hikaru
908 1.6 simonb const struct octpow_dump_ops_entry octpow_dump_ops_grp_entries[] = {
909 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(grp, POW_IDXPTR_LOAD_RESULT_GRP, x, y)
910 1.1 hikaru _ENTRY(nosched_des, NOSCHED_DES)
911 1.1 hikaru #undef _ENTRY
912 1.1 hikaru };
913 1.1 hikaru
914 1.6 simonb const struct octpow_dump_ops_entry octpow_dump_ops_queue_entries[] = {
915 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(queue, POW_IDXPTR_LOAD_RESULT_QUEUE, x, y)
916 1.1 hikaru _ENTRY(remote_head, REMOTE_HEAD),
917 1.1 hikaru _ENTRY(remote_tail, REMOTE_TAIL)
918 1.1 hikaru #undef _ENTRY
919 1.1 hikaru };
920 1.1 hikaru
921 1.1 hikaru void
922 1.6 simonb octpow_dump_ops(void)
923 1.1 hikaru {
924 1.1 hikaru int i;
925 1.1 hikaru
926 1.1 hikaru /* XXX */
927 1.1 hikaru for (i = 0; i < 2/* XXX */; i++)
928 1.6 simonb octpow_dump_ops_coreid(i);
929 1.1 hikaru
930 1.1 hikaru /* XXX */
931 1.6 simonb octpow_dump_ops_index(0);
932 1.1 hikaru
933 1.1 hikaru for (i = 0; i < 8; i++)
934 1.6 simonb octpow_dump_ops_qos(i);
935 1.1 hikaru
936 1.1 hikaru for (i = 0; i < 16; i++)
937 1.6 simonb octpow_dump_ops_grp(i);
938 1.1 hikaru
939 1.1 hikaru for (i = 0; i < 16; i++)
940 1.6 simonb octpow_dump_ops_queue(i);
941 1.1 hikaru }
942 1.1 hikaru
943 1.1 hikaru void
944 1.6 simonb octpow_dump_ops_coreid(int coreid)
945 1.1 hikaru {
946 1.6 simonb octpow_dump_ops_common(octpow_dump_ops_coreid_entries,
947 1.6 simonb __arraycount(octpow_dump_ops_coreid_entries), "coreid", coreid);
948 1.1 hikaru }
949 1.1 hikaru
950 1.1 hikaru void
951 1.6 simonb octpow_dump_ops_index(int index)
952 1.1 hikaru {
953 1.6 simonb octpow_dump_ops_common(octpow_dump_ops_index_entries,
954 1.6 simonb __arraycount(octpow_dump_ops_index_entries), "index", index);
955 1.1 hikaru }
956 1.1 hikaru
957 1.1 hikaru void
958 1.6 simonb octpow_dump_ops_qos(int qos)
959 1.1 hikaru {
960 1.6 simonb octpow_dump_ops_common(octpow_dump_ops_qos_entries,
961 1.6 simonb __arraycount(octpow_dump_ops_qos_entries), "qos", qos);
962 1.1 hikaru }
963 1.1 hikaru
964 1.1 hikaru void
965 1.6 simonb octpow_dump_ops_grp(int grp)
966 1.1 hikaru {
967 1.6 simonb octpow_dump_ops_common(octpow_dump_ops_grp_entries,
968 1.6 simonb __arraycount(octpow_dump_ops_grp_entries), "grp", grp);
969 1.1 hikaru }
970 1.1 hikaru
971 1.1 hikaru void
972 1.6 simonb octpow_dump_ops_queue(int queue)
973 1.1 hikaru {
974 1.6 simonb octpow_dump_ops_common(octpow_dump_ops_queue_entries,
975 1.6 simonb __arraycount(octpow_dump_ops_queue_entries), "queue", queue);
976 1.1 hikaru }
977 1.1 hikaru
978 1.1 hikaru void
979 1.6 simonb octpow_dump_ops_common(const struct octpow_dump_ops_entry *entries,
980 1.1 hikaru size_t nentries, const char *by_what, int arg)
981 1.1 hikaru {
982 1.6 simonb const struct octpow_dump_ops_entry *entry;
983 1.1 hikaru uint64_t tmp;
984 1.1 hikaru char buf[512];
985 1.1 hikaru int i;
986 1.1 hikaru
987 1.1 hikaru printf("%s=%d\n", by_what, arg);
988 1.1 hikaru for (i = 0; i < (int)nentries; i++) {
989 1.1 hikaru entry = &entries[i];
990 1.1 hikaru tmp = (*entry->func)(arg);
991 1.1 hikaru if (entry->format == NULL)
992 1.1 hikaru snprintf(buf, sizeof(buf), "%16" PRIx64, tmp);
993 1.1 hikaru else
994 1.1 hikaru snprintb(buf, sizeof(buf), entry->format, tmp);
995 1.1 hikaru printf("\t%-24s: %s\n", entry->name, buf);
996 1.1 hikaru }
997 1.1 hikaru }
998 1.1 hikaru
999 1.1 hikaru #endif
1000 1.1 hikaru
1001 1.1 hikaru /* -------------------------------------------------------------------------- */
1002 1.1 hikaru
1003 1.1 hikaru /* ---- test */
1004 1.1 hikaru
1005 1.6 simonb #ifdef octPOW_TEST
1006 1.1 hikaru /*
1007 1.1 hikaru * Standalone test entries; meant to be called from ddb.
1008 1.1 hikaru */
1009 1.1 hikaru
1010 1.6 simonb void octpow_test(void);
1011 1.6 simonb void octpow_test_dump_wqe(paddr_t);
1012 1.1 hikaru
1013 1.6 simonb static void octpow_test_1(void);
1014 1.1 hikaru
1015 1.1 hikaru struct test_wqe {
1016 1.1 hikaru uint64_t word0;
1017 1.1 hikaru uint64_t word1;
1018 1.1 hikaru uint64_t word2;
1019 1.1 hikaru uint64_t word3;
1020 1.1 hikaru } __packed;
1021 1.1 hikaru struct test_wqe test_wqe;
1022 1.1 hikaru
1023 1.1 hikaru void
1024 1.6 simonb octpow_test(void)
1025 1.1 hikaru {
1026 1.6 simonb octpow_test_1();
1027 1.1 hikaru }
1028 1.1 hikaru
1029 1.1 hikaru static void
1030 1.6 simonb octpow_test_1(void)
1031 1.1 hikaru {
1032 1.1 hikaru struct test_wqe *wqe = &test_wqe;
1033 1.1 hikaru int qos, grp, queue, tt;
1034 1.1 hikaru uint32_t tag;
1035 1.1 hikaru paddr_t ptr;
1036 1.1 hikaru
1037 1.1 hikaru qos = 7; /* XXX */
1038 1.1 hikaru grp = queue = 15; /* XXX */
1039 1.1 hikaru tt = POW_TAG_TYPE_ORDERED; /* XXX */
1040 1.1 hikaru tag = UINT32_C(0x01234567); /* XXX */
1041 1.1 hikaru
1042 1.1 hikaru /* => make sure that the queue is empty */
1043 1.1 hikaru
1044 1.6 simonb octpow_dump_ops_qos(qos);
1045 1.6 simonb octpow_dump_ops_grp(grp);
1046 1.1 hikaru printf("\n");
1047 1.1 hikaru
1048 1.1 hikaru /*
1049 1.1 hikaru * Initialize WQE.
1050 1.1 hikaru *
1051 1.1 hikaru * word0:next is used by hardware.
1052 1.1 hikaru *
1053 1.1 hikaru * word1:qos, word1:grp, word1:tt, word1:tag must match with arguments
1054 1.1 hikaru * of the following ADDWQ transaction.
1055 1.1 hikaru */
1056 1.1 hikaru
1057 1.1 hikaru (void)memset(wqe, 0, sizeof(*wqe));
1058 1.1 hikaru wqe->word0 =
1059 1.1 hikaru __BITS64_SET(POW_WQE_WORD0_NEXT, 0);
1060 1.1 hikaru wqe->word1 =
1061 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_QOS, qos) |
1062 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_GRP, grp) |
1063 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_TT, tt) |
1064 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_TAG, tag);
1065 1.1 hikaru
1066 1.1 hikaru printf("calling ADDWQ\n");
1067 1.6 simonb octpow_ops_addwq(MIPS_KSEG0_TO_PHYS(wqe), qos, grp, tt, tag);
1068 1.1 hikaru
1069 1.6 simonb octpow_dump_ops_qos(qos);
1070 1.6 simonb octpow_dump_ops_grp(grp);
1071 1.1 hikaru printf("\n");
1072 1.1 hikaru
1073 1.1 hikaru /* => make sure that a WQE is added to the queue */
1074 1.1 hikaru
1075 1.1 hikaru printf("calling GET_WORK_LOAD\n");
1076 1.6 simonb ptr = octpow_ops_get_work_load(0);
1077 1.1 hikaru
1078 1.6 simonb octpow_dump_ops_qos(qos);
1079 1.6 simonb octpow_dump_ops_grp(grp);
1080 1.1 hikaru printf("\n");
1081 1.1 hikaru
1082 1.6 simonb octpow_test_dump_wqe(ptr);
1083 1.1 hikaru
1084 1.1 hikaru /* => make sure that the WQE is in-flight (and scheduled) */
1085 1.1 hikaru
1086 1.1 hikaru printf("calling SWTAG(NULL)\n");
1087 1.6 simonb octpow_ops_swtag(POW_TAG_TYPE_NULL, tag);
1088 1.1 hikaru
1089 1.6 simonb octpow_dump_ops_qos(qos);
1090 1.6 simonb octpow_dump_ops_grp(grp);
1091 1.1 hikaru printf("\n");
1092 1.1 hikaru
1093 1.1 hikaru /* => make sure that the WQE is un-scheduled (completed) */
1094 1.1 hikaru }
1095 1.1 hikaru
1096 1.1 hikaru void
1097 1.6 simonb octpow_test_dump_wqe(paddr_t ptr)
1098 1.1 hikaru {
1099 1.1 hikaru uint64_t word0, word1;
1100 1.1 hikaru char buf[128];
1101 1.1 hikaru
1102 1.1 hikaru printf("wqe\n");
1103 1.1 hikaru
1104 1.1 hikaru word0 = *(uint64_t *)MIPS_PHYS_TO_XKPHYS_CACHED(ptr);
1105 1.1 hikaru snprintb(buf, sizeof(buf), POW_WQE_WORD0_BITS, word0);
1106 1.1 hikaru printf("\t%-24s: %s\n", "word0", buf);
1107 1.1 hikaru
1108 1.1 hikaru word1 = *(uint64_t *)MIPS_PHYS_TO_XKPHYS_CACHED(ptr + 8);
1109 1.1 hikaru snprintb(buf, sizeof(buf), POW_WQE_WORD1_BITS, word1);
1110 1.1 hikaru printf("\t%-24s: %s\n", "word1", buf);
1111 1.1 hikaru }
1112 1.1 hikaru #endif
1113