octeon_pow.c revision 1.2 1 1.1 hikaru /* $NetbBSD$ */
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.2 matt __KERNEL_RCSID(0, "$NetBSD: octeon_pow.c,v 1.2 2015/06/01 22:55:12 matt Exp $");
31 1.1 hikaru
32 1.1 hikaru #include "opt_octeon.h" /* OCTEON_ETH_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.1 hikaru struct octeon_pow_intr_handle {
59 1.1 hikaru void *pi_ih;
60 1.1 hikaru struct octeon_pow_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.1 hikaru #ifdef OCTEON_ETH_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.1 hikaru void octeon_pow_bootstrap(struct octeon_config *);
79 1.1 hikaru
80 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
81 1.1 hikaru void octeon_pow_intr_evcnt_attach(struct octeon_pow_softc *);
82 1.1 hikaru void octeon_pow_intr_rml(void *);
83 1.1 hikaru
84 1.1 hikaru static void octeon_pow_intr_debug_init(
85 1.1 hikaru struct octeon_pow_intr_handle *, int);
86 1.1 hikaru static inline void octeon_pow_intr_work_debug_ival(struct octeon_pow_softc *,
87 1.1 hikaru struct octeon_pow_intr_handle *);
88 1.1 hikaru static inline void octeon_pow_intr_work_debug_per(struct octeon_pow_softc *,
89 1.1 hikaru struct octeon_pow_intr_handle *, int);
90 1.1 hikaru #endif
91 1.1 hikaru static void octeon_pow_init(struct octeon_pow_softc *);
92 1.1 hikaru static void octeon_pow_init_regs(struct octeon_pow_softc *);
93 1.1 hikaru static inline int octeon_pow_tag_sw_poll(void) __unused;
94 1.1 hikaru static inline void octeon_pow_tag_sw_wait(void);
95 1.1 hikaru static inline void octeon_pow_config_int_pc(struct octeon_pow_softc *, int);
96 1.1 hikaru static inline void octeon_pow_config_int(struct octeon_pow_softc *, int,
97 1.1 hikaru uint64_t, uint64_t, uint64_t);
98 1.1 hikaru static inline void octeon_pow_intr_work(struct octeon_pow_softc *,
99 1.1 hikaru struct octeon_pow_intr_handle *, int);
100 1.1 hikaru static int octeon_pow_intr(void *);
101 1.1 hikaru
102 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
103 1.1 hikaru void octeon_pow_dump(void);
104 1.1 hikaru #endif
105 1.1 hikaru
106 1.1 hikaru /* XXX */
107 1.1 hikaru struct octeon_pow_softc octeon_pow_softc;
108 1.1 hikaru
109 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
110 1.1 hikaru struct octeon_pow_softc *__octeon_pow_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.1 hikaru #ifndef OCTEON_ETH_RING_MAX
117 1.1 hikaru #define OCTEON_ETH_RING_MAX 512
118 1.1 hikaru #endif
119 1.1 hikaru #ifndef OCTEON_ETH_RING_MIN
120 1.1 hikaru #define OCTEON_ETH_RING_MIN 1
121 1.1 hikaru #endif
122 1.1 hikaru
123 1.1 hikaru #ifdef OCTEON_ETH_INTR_FEEDBACK_RING
124 1.1 hikaru int max_recv_cnt = OCTEON_ETH_RING_MAX;
125 1.1 hikaru int min_recv_cnt = OCTEON_ETH_RING_MIN;
126 1.1 hikaru int recv_cnt = OCTEON_ETH_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 /* ---- operation primitive functions */
133 1.1 hikaru
134 1.1 hikaru /* Load Operations */
135 1.1 hikaru
136 1.1 hikaru /* IOBDMA Operations */
137 1.1 hikaru
138 1.1 hikaru /* Store Operations */
139 1.1 hikaru
140 1.1 hikaru /* -------------------------------------------------------------------------- */
141 1.1 hikaru
142 1.1 hikaru /* ---- utility functions */
143 1.1 hikaru
144 1.1 hikaru
145 1.1 hikaru /* ---- status by coreid */
146 1.1 hikaru
147 1.1 hikaru static inline uint64_t
148 1.1 hikaru octeon_pow_status_by_coreid_pend_tag(int coreid)
149 1.1 hikaru {
150 1.1 hikaru return octeon_pow_ops_pow_status(coreid, 0, 0, 0);
151 1.1 hikaru }
152 1.1 hikaru
153 1.1 hikaru static inline uint64_t
154 1.1 hikaru octeon_pow_status_by_coreid_pend_wqp(int coreid)
155 1.1 hikaru {
156 1.1 hikaru return octeon_pow_ops_pow_status(coreid, 0, 0, 1);
157 1.1 hikaru }
158 1.1 hikaru
159 1.1 hikaru static inline uint64_t
160 1.1 hikaru octeon_pow_status_by_coreid_cur_tag_next(int coreid)
161 1.1 hikaru {
162 1.1 hikaru return octeon_pow_ops_pow_status(coreid, 0, 1, 0);
163 1.1 hikaru }
164 1.1 hikaru
165 1.1 hikaru static inline uint64_t
166 1.1 hikaru octeon_pow_status_by_coreid_cur_tag_prev(int coreid)
167 1.1 hikaru {
168 1.1 hikaru return octeon_pow_ops_pow_status(coreid, 1, 1, 0);
169 1.1 hikaru }
170 1.1 hikaru
171 1.1 hikaru static inline uint64_t
172 1.1 hikaru octeon_pow_status_by_coreid_cur_wqp_next(int coreid)
173 1.1 hikaru {
174 1.1 hikaru return octeon_pow_ops_pow_status(coreid, 0, 1, 1);
175 1.1 hikaru }
176 1.1 hikaru
177 1.1 hikaru static inline uint64_t
178 1.1 hikaru octeon_pow_status_by_coreid_cur_wqp_prev(int coreid)
179 1.1 hikaru {
180 1.1 hikaru return octeon_pow_ops_pow_status(coreid, 1, 1, 1);
181 1.1 hikaru }
182 1.1 hikaru
183 1.1 hikaru /* ---- status by index */
184 1.1 hikaru
185 1.1 hikaru static inline uint64_t
186 1.1 hikaru octeon_pow_status_by_index_tag(int index)
187 1.1 hikaru {
188 1.1 hikaru return octeon_pow_ops_pow_memory(index, 0, 0);
189 1.1 hikaru }
190 1.1 hikaru
191 1.1 hikaru static inline uint64_t
192 1.1 hikaru octeon_pow_status_by_index_wqp(int index)
193 1.1 hikaru {
194 1.1 hikaru return octeon_pow_ops_pow_memory(index, 0, 1);
195 1.1 hikaru }
196 1.1 hikaru
197 1.1 hikaru static inline uint64_t
198 1.1 hikaru octeon_pow_status_by_index_desched(int index)
199 1.1 hikaru {
200 1.1 hikaru return octeon_pow_ops_pow_memory(index, 1, 0);
201 1.1 hikaru }
202 1.1 hikaru
203 1.1 hikaru /* ---- status by qos level */
204 1.1 hikaru
205 1.1 hikaru static inline uint64_t
206 1.1 hikaru octeon_pow_status_by_qos_free_loc(int qos)
207 1.1 hikaru {
208 1.1 hikaru return octeon_pow_ops_pow_idxptr(qos, 0, 0);
209 1.1 hikaru }
210 1.1 hikaru
211 1.1 hikaru /* ---- status by desched group */
212 1.1 hikaru
213 1.1 hikaru static inline uint64_t
214 1.1 hikaru octeon_pow_status_by_grp_nosched_des(int grp)
215 1.1 hikaru {
216 1.1 hikaru return octeon_pow_ops_pow_idxptr(grp, 0, 1);
217 1.1 hikaru }
218 1.1 hikaru
219 1.1 hikaru /* ---- status by memory input queue */
220 1.1 hikaru
221 1.1 hikaru static inline uint64_t
222 1.1 hikaru octeon_pow_status_by_queue_remote_head(int queue)
223 1.1 hikaru {
224 1.1 hikaru return octeon_pow_ops_pow_idxptr(queue, 1, 0);
225 1.1 hikaru }
226 1.1 hikaru
227 1.1 hikaru static inline uint64_t
228 1.1 hikaru octeon_pow_status_by_queue_remote_tail(int queue)
229 1.1 hikaru {
230 1.1 hikaru return octeon_pow_ops_pow_idxptr(queue, 1, 0);
231 1.1 hikaru }
232 1.1 hikaru
233 1.1 hikaru /* ---- tag switch */
234 1.1 hikaru
235 1.1 hikaru /*
236 1.1 hikaru * "RDHWR rt, $30" returns:
237 1.1 hikaru * 0 => pending bit is set
238 1.1 hikaru * 1 => pending bit is clear
239 1.1 hikaru */
240 1.1 hikaru
241 1.1 hikaru /* return 1 if pending bit is clear (ready) */
242 1.1 hikaru static inline int
243 1.1 hikaru octeon_pow_tag_sw_poll(void)
244 1.1 hikaru {
245 1.1 hikaru uint64_t result;
246 1.1 hikaru
247 1.1 hikaru /* XXX O32 */
248 1.1 hikaru __asm __volatile (
249 1.1 hikaru " .set push \n"
250 1.1 hikaru " .set noreorder \n"
251 1.1 hikaru " .set arch=octeon \n"
252 1.1 hikaru " rdhwr %[result], $30 \n"
253 1.1 hikaru " .set pop \n"
254 1.1 hikaru : [result]"=r"(result)
255 1.1 hikaru );
256 1.1 hikaru /* XXX O32 */
257 1.1 hikaru return (int)result;
258 1.1 hikaru }
259 1.1 hikaru
260 1.1 hikaru /* -------------------------------------------------------------------------- */
261 1.1 hikaru
262 1.1 hikaru /* ---- initialization and configuration */
263 1.1 hikaru
264 1.1 hikaru void
265 1.1 hikaru octeon_pow_bootstrap(struct octeon_config *mcp)
266 1.1 hikaru {
267 1.1 hikaru struct octeon_pow_softc *sc = &octeon_pow_softc;
268 1.1 hikaru
269 1.1 hikaru sc->sc_regt = &mcp->mc_iobus_bust;
270 1.1 hikaru /* XXX */
271 1.1 hikaru
272 1.1 hikaru octeon_pow_init(sc);
273 1.1 hikaru
274 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
275 1.1 hikaru __octeon_pow_softc = sc;
276 1.1 hikaru #endif
277 1.1 hikaru
278 1.1 hikaru }
279 1.1 hikaru
280 1.1 hikaru static inline void
281 1.1 hikaru octeon_pow_config_int(struct octeon_pow_softc *sc, int group,
282 1.1 hikaru uint64_t tc_thr, uint64_t ds_thr, uint64_t iq_thr)
283 1.1 hikaru {
284 1.1 hikaru uint64_t wq_int_thr;
285 1.1 hikaru
286 1.1 hikaru wq_int_thr =
287 1.1 hikaru POW_WQ_INT_THRX_TC_EN |
288 1.1 hikaru (tc_thr << POW_WQ_INT_THRX_TC_THR_SHIFT) |
289 1.1 hikaru (ds_thr << POW_WQ_INT_THRX_DS_THR_SHIFT) |
290 1.1 hikaru (iq_thr << POW_WQ_INT_THRX_IQ_THR_SHIFT);
291 1.1 hikaru _POW_WR8(sc, POW_WQ_INT_THR0_OFFSET + (group * 8), wq_int_thr);
292 1.1 hikaru }
293 1.1 hikaru
294 1.1 hikaru /*
295 1.1 hikaru * interrupt threshold configuration
296 1.1 hikaru *
297 1.1 hikaru * => DS / IQ
298 1.1 hikaru * => ...
299 1.1 hikaru * => time counter threshold
300 1.1 hikaru * => unit is 1msec
301 1.1 hikaru * => each group can set timeout
302 1.1 hikaru * => temporary disable bit
303 1.1 hikaru * => use CIU generic timer
304 1.1 hikaru */
305 1.1 hikaru
306 1.1 hikaru void
307 1.1 hikaru octeon_pow_config(struct octeon_pow_softc *sc, int group)
308 1.1 hikaru {
309 1.1 hikaru
310 1.1 hikaru octeon_pow_config_int(sc, group,
311 1.1 hikaru 0x0f, /* TC */
312 1.1 hikaru 0x00, /* DS */
313 1.1 hikaru 0x00); /* IQ */
314 1.1 hikaru }
315 1.1 hikaru
316 1.1 hikaru void *
317 1.1 hikaru octeon_pow_intr_establish(int group, int level,
318 1.1 hikaru void (*cb)(void *, uint64_t *), void (*fcb)(int*, int *, uint64_t, void *),
319 1.1 hikaru void *data)
320 1.1 hikaru {
321 1.1 hikaru struct octeon_pow_intr_handle *pow_ih;
322 1.1 hikaru
323 1.1 hikaru KASSERT(group >= 0);
324 1.1 hikaru KASSERT(group < 16);
325 1.1 hikaru
326 1.1 hikaru pow_ih = malloc(sizeof(*pow_ih), M_DEVBUF, M_NOWAIT);
327 1.1 hikaru KASSERT(pow_ih != NULL);
328 1.1 hikaru
329 1.1 hikaru pow_ih->pi_ih = octeon_intr_establish(
330 1.1 hikaru ffs64(CIU_INTX_SUM0_WORKQ_0) - 1 + group,
331 1.1 hikaru level,
332 1.1 hikaru octeon_pow_intr, pow_ih);
333 1.1 hikaru KASSERT(pow_ih->pi_ih != NULL);
334 1.1 hikaru
335 1.1 hikaru pow_ih->pi_sc = &octeon_pow_softc; /* XXX */
336 1.1 hikaru pow_ih->pi_group = group;
337 1.1 hikaru pow_ih->pi_cb = cb;
338 1.1 hikaru pow_ih->pi_data = data;
339 1.1 hikaru
340 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
341 1.1 hikaru octeon_pow_intr_debug_init(pow_ih, group);
342 1.1 hikaru #endif
343 1.1 hikaru return pow_ih;
344 1.1 hikaru }
345 1.1 hikaru
346 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
347 1.1 hikaru #define _NAMELEN 8
348 1.1 hikaru #define _DESCRLEN 40
349 1.1 hikaru
350 1.1 hikaru static void
351 1.1 hikaru octeon_pow_intr_debug_init(struct octeon_pow_intr_handle *pow_ih, int group)
352 1.1 hikaru {
353 1.1 hikaru pow_ih->pi_first = 1;
354 1.1 hikaru char *name, *descr;
355 1.1 hikaru int i;
356 1.1 hikaru
357 1.1 hikaru name = malloc(_NAMELEN +
358 1.1 hikaru _DESCRLEN * __arraycount(pow_ih->pi_ev_per) +
359 1.1 hikaru _DESCRLEN * __arraycount(pow_ih->pi_ev_ival),
360 1.1 hikaru M_DEVBUF, M_NOWAIT);
361 1.1 hikaru descr = name + _NAMELEN;
362 1.1 hikaru snprintf(name, _NAMELEN, "pow%d", group);
363 1.1 hikaru for (i = 0; i < (int)__arraycount(pow_ih->pi_ev_per); i++) {
364 1.1 hikaru int n = 1 << (i - 1);
365 1.1 hikaru
366 1.1 hikaru (void)snprintf(descr, _DESCRLEN,
367 1.1 hikaru "# of works per intr (%d-%d)",
368 1.1 hikaru (i == 0) ? 0 : n,
369 1.1 hikaru (i == 0) ? 0 : ((n << 1) - 1));
370 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_per[i],
371 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, descr);
372 1.1 hikaru descr += _DESCRLEN;
373 1.1 hikaru }
374 1.1 hikaru for (i = 0; i < (int)__arraycount(pow_ih->pi_ev_ival); i++) {
375 1.1 hikaru int n = 1 << (i - 1);
376 1.1 hikaru int p, q;
377 1.1 hikaru char unit;
378 1.1 hikaru
379 1.1 hikaru p = n;
380 1.1 hikaru q = (n << 1) - 1;
381 1.1 hikaru unit = 'u';
382 1.1 hikaru /*
383 1.1 hikaru * 0 is exceptional
384 1.1 hikaru */
385 1.1 hikaru if (i == 0)
386 1.1 hikaru p = q = 0;
387 1.1 hikaru /*
388 1.1 hikaru * count 1024usec as 1msec
389 1.1 hikaru *
390 1.1 hikaru * XXX this is not exact
391 1.1 hikaru */
392 1.1 hikaru if ((i - 1) >= 10) {
393 1.1 hikaru p /= 1000;
394 1.1 hikaru q /= 1000;
395 1.1 hikaru unit = 'm';
396 1.1 hikaru }
397 1.1 hikaru (void)snprintf(descr, _DESCRLEN, "intr interval (%d-%d%csec)",
398 1.1 hikaru p, q, unit);
399 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_ival[i],
400 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, descr);
401 1.1 hikaru descr += _DESCRLEN;
402 1.1 hikaru }
403 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_stray_tc,
404 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, "stray intr (TC)");
405 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_stray_ds,
406 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, "stray intr (DS)");
407 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_stray_iq,
408 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, "stray intr (IQ)");
409 1.1 hikaru }
410 1.1 hikaru #endif
411 1.1 hikaru
412 1.1 hikaru void
413 1.1 hikaru octeon_pow_init(struct octeon_pow_softc *sc)
414 1.1 hikaru {
415 1.1 hikaru octeon_pow_init_regs(sc);
416 1.1 hikaru
417 1.1 hikaru sc->sc_int_pc_base = 10000;
418 1.1 hikaru octeon_pow_config_int_pc(sc, sc->sc_int_pc_base);
419 1.1 hikaru
420 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
421 1.1 hikaru octeon_pow_error_int_enable(sc, 1);
422 1.1 hikaru #endif
423 1.1 hikaru }
424 1.1 hikaru
425 1.1 hikaru void
426 1.1 hikaru octeon_pow_init_regs(struct octeon_pow_softc *sc)
427 1.1 hikaru {
428 1.1 hikaru int status;
429 1.1 hikaru
430 1.1 hikaru status = bus_space_map(sc->sc_regt, POW_BASE, POW_SIZE, 0,
431 1.1 hikaru &sc->sc_regh);
432 1.1 hikaru if (status != 0)
433 1.1 hikaru panic("can't map %s space", "pow register");
434 1.1 hikaru
435 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
436 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET,
437 1.1 hikaru POW_ECC_ERR_IOP_IE | POW_ECC_ERR_RPE_IE |
438 1.1 hikaru POW_ECC_ERR_DBE_IE | POW_ECC_ERR_SBE_IE);
439 1.1 hikaru #endif
440 1.1 hikaru }
441 1.1 hikaru
442 1.1 hikaru /* -------------------------------------------------------------------------- */
443 1.1 hikaru
444 1.1 hikaru /* ---- interrupt handling */
445 1.1 hikaru
446 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
447 1.1 hikaru static inline void
448 1.1 hikaru octeon_pow_intr_work_debug_ival(struct octeon_pow_softc *sc,
449 1.1 hikaru struct octeon_pow_intr_handle *pow_ih)
450 1.1 hikaru {
451 1.1 hikaru struct timeval now;
452 1.1 hikaru struct timeval ival;
453 1.1 hikaru int n;
454 1.1 hikaru
455 1.1 hikaru microtime(&now);
456 1.1 hikaru if (__predict_false(pow_ih->pi_first == 1)) {
457 1.1 hikaru pow_ih->pi_first = 0;
458 1.1 hikaru goto stat_done;
459 1.1 hikaru }
460 1.1 hikaru timersub(&now, &pow_ih->pi_last, &ival);
461 1.1 hikaru if (ival.tv_sec != 0)
462 1.1 hikaru goto stat_done; /* XXX */
463 1.1 hikaru n = ffs64((uint64_t)ival.tv_usec);
464 1.1 hikaru if (n > (int)__arraycount(pow_ih->pi_ev_ival) - 1)
465 1.1 hikaru n = (int)__arraycount(pow_ih->pi_ev_ival) - 1;
466 1.1 hikaru pow_ih->pi_ev_ival[n].ev_count++;
467 1.1 hikaru
468 1.1 hikaru stat_done:
469 1.1 hikaru pow_ih->pi_last = now; /* struct copy */
470 1.1 hikaru }
471 1.1 hikaru
472 1.1 hikaru static inline void
473 1.1 hikaru octeon_pow_intr_work_debug_per(struct octeon_pow_softc *sc,
474 1.1 hikaru struct octeon_pow_intr_handle *pow_ih, int count)
475 1.1 hikaru {
476 1.1 hikaru int n;
477 1.1 hikaru
478 1.1 hikaru n = ffs64(count);
479 1.1 hikaru if (n > (int)__arraycount(pow_ih->pi_ev_per) - 1)
480 1.1 hikaru n = (int)__arraycount(pow_ih->pi_ev_per) - 1;
481 1.1 hikaru pow_ih->pi_ev_per[n].ev_count++;
482 1.1 hikaru #if 1
483 1.1 hikaru if (count == 0) {
484 1.1 hikaru uint64_t wq_int_cnt;
485 1.1 hikaru
486 1.1 hikaru wq_int_cnt = _POW_GROUP_RD8(sc, pow_ih, POW_WQ_INT_CNT0_OFFSET);
487 1.1 hikaru if (wq_int_cnt & POW_WQ_INT_CNTX_TC_CNT)
488 1.1 hikaru pow_ih->pi_ev_stray_tc.ev_count++;
489 1.1 hikaru if (wq_int_cnt & POW_WQ_INT_CNTX_DS_CNT)
490 1.1 hikaru pow_ih->pi_ev_stray_ds.ev_count++;
491 1.1 hikaru if (wq_int_cnt & POW_WQ_INT_CNTX_IQ_CNT)
492 1.1 hikaru pow_ih->pi_ev_stray_iq.ev_count++;
493 1.1 hikaru }
494 1.1 hikaru #endif
495 1.1 hikaru }
496 1.1 hikaru #endif
497 1.1 hikaru
498 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
499 1.1 hikaru #define _POW_INTR_WORK_DEBUG_IVAL(sc, ih) \
500 1.1 hikaru octeon_pow_intr_work_debug_ival((sc), (ih))
501 1.1 hikaru #define _POW_INTR_WORK_DEBUG_PER(sc, ih, count) \
502 1.1 hikaru octeon_pow_intr_work_debug_per((sc), (ih), (count))
503 1.1 hikaru #else
504 1.1 hikaru #define _POW_INTR_WORK_DEBUG_IVAL(sc, ih) \
505 1.1 hikaru do {} while (0)
506 1.1 hikaru #define _POW_INTR_WORK_DEBUG_PER(sc, ih, count) \
507 1.1 hikaru do {} while (0)
508 1.1 hikaru #endif
509 1.1 hikaru
510 1.1 hikaru /*
511 1.1 hikaru * Interrupt handling by fixed count, following Cavium's SDK code.
512 1.1 hikaru *
513 1.1 hikaru * XXX the fixed count (MAX_RX_CNT) could be changed dynamically?
514 1.1 hikaru *
515 1.1 hikaru * XXX this does not utilize "tag switch" very well
516 1.1 hikaru */
517 1.1 hikaru /*
518 1.1 hikaru * usually all packet recieve
519 1.1 hikaru */
520 1.1 hikaru #define MAX_RX_CNT 0x7fffffff
521 1.1 hikaru
522 1.1 hikaru static inline void
523 1.1 hikaru octeon_pow_intr_work(struct octeon_pow_softc *sc,
524 1.1 hikaru struct octeon_pow_intr_handle *pow_ih, int recv_limit)
525 1.1 hikaru {
526 1.1 hikaru uint64_t *work;
527 1.1 hikaru uint64_t count = 0;
528 1.1 hikaru
529 1.1 hikaru _POW_WR8(sc, POW_PP_GRP_MSK0_OFFSET, UINT64_C(1) << pow_ih->pi_group);
530 1.1 hikaru
531 1.1 hikaru _POW_INTR_WORK_DEBUG_IVAL(sc, pow_ih);
532 1.1 hikaru
533 1.1 hikaru for (count = 0; count < recv_limit; count++) {
534 1.1 hikaru octeon_pow_tag_sw_wait();
535 1.1 hikaru octeon_pow_work_request_async(
536 1.1 hikaru OCTEON_CVMSEG_OFFSET(csm_pow_intr), POW_NO_WAIT);
537 1.1 hikaru work = (uint64_t *)octeon_pow_work_response_async(
538 1.1 hikaru OCTEON_CVMSEG_OFFSET(csm_pow_intr));
539 1.1 hikaru if (work == NULL)
540 1.1 hikaru break;
541 1.1 hikaru (*pow_ih->pi_cb)(pow_ih->pi_data, work);
542 1.1 hikaru }
543 1.1 hikaru
544 1.1 hikaru _POW_INTR_WORK_DEBUG_PER(sc, pow_ih, count);
545 1.1 hikaru }
546 1.1 hikaru
547 1.1 hikaru static int
548 1.1 hikaru octeon_pow_intr(void *data)
549 1.1 hikaru {
550 1.1 hikaru struct octeon_pow_intr_handle *pow_ih = data;
551 1.1 hikaru struct octeon_pow_softc *sc = pow_ih->pi_sc;
552 1.1 hikaru uint64_t wq_int_mask = UINT64_C(0x1) << pow_ih->pi_group;
553 1.1 hikaru
554 1.1 hikaru #ifdef OCTEON_ETH_INTR_FEEDBACK_RING
555 1.1 hikaru octeon_pow_intr_work(sc, pow_ih, recv_cnt);
556 1.1 hikaru #else
557 1.1 hikaru octeon_pow_intr_work(sc, pow_ih, INT_MAX);
558 1.1 hikaru #endif /* OCTEON_ETH_INTR_FEEDBACK_RING */
559 1.1 hikaru
560 1.1 hikaru _POW_WR8(sc, POW_WQ_INT_OFFSET, wq_int_mask << POW_WQ_INT_WQ_INT_SHIFT);
561 1.1 hikaru return 1;
562 1.1 hikaru }
563 1.1 hikaru
564 1.1 hikaru #ifdef OCTEON_ETH_INTR_FEEDBACK_RING
565 1.1 hikaru int
566 1.1 hikaru octeon_pow_ring_reduce(void *arg)
567 1.1 hikaru {
568 1.1 hikaru struct octeon_pow_softc *sc = arg;
569 1.1 hikaru int new, newi;
570 1.1 hikaru int s;
571 1.1 hikaru
572 1.1 hikaru #if 0
573 1.1 hikaru if (ipflow_fastforward_disable_flags == 0) {
574 1.1 hikaru newi = int_rate = 1;
575 1.1 hikaru octeon_pow_config_int_pc_rate(sc, int_rate);
576 1.1 hikaru return recv_cnt;
577 1.1 hikaru }
578 1.1 hikaru #endif
579 1.1 hikaru
580 1.1 hikaru new = recv_cnt / 2;
581 1.1 hikaru if (new < min_recv_cnt) {
582 1.1 hikaru newi = int_rate << 1;
583 1.1 hikaru if (newi > 128) {
584 1.1 hikaru newi = 128;
585 1.1 hikaru #ifdef POW_DEBUG
586 1.1 hikaru log(LOG_DEBUG,
587 1.1 hikaru "Min intr rate.\n");
588 1.1 hikaru #endif
589 1.1 hikaru new = min_recv_cnt;
590 1.1 hikaru }
591 1.1 hikaru else {
592 1.1 hikaru log(LOG_DEBUG,
593 1.1 hikaru "pow interrupt rate optimized %d->%d.\n",
594 1.1 hikaru int_rate, newi);
595 1.1 hikaru int_rate = newi;
596 1.1 hikaru octeon_pow_config_int_pc_rate(sc, int_rate);
597 1.1 hikaru new = max_recv_cnt;
598 1.1 hikaru }
599 1.1 hikaru }
600 1.1 hikaru
601 1.1 hikaru s = splhigh(); /* XXX */
602 1.1 hikaru recv_cnt = new;
603 1.1 hikaru splx(s);
604 1.1 hikaru
605 1.1 hikaru return new;
606 1.1 hikaru }
607 1.1 hikaru
608 1.1 hikaru int
609 1.1 hikaru octeon_pow_ring_grow(void *arg)
610 1.1 hikaru {
611 1.1 hikaru struct octeon_pow_softc *sc = arg;
612 1.1 hikaru int new, newi;
613 1.1 hikaru int s;
614 1.1 hikaru
615 1.1 hikaru #if 0
616 1.1 hikaru if (ipflow_fastforward_disable_flags == 0) {
617 1.1 hikaru newi = int_rate = 1;
618 1.1 hikaru octeon_pow_config_int_pc_rate(sc, int_rate);
619 1.1 hikaru return recv_cnt;
620 1.1 hikaru }
621 1.1 hikaru #endif
622 1.1 hikaru
623 1.1 hikaru new = recv_cnt + 1;
624 1.1 hikaru if (new > max_recv_cnt) {
625 1.1 hikaru newi = int_rate >> 1;
626 1.1 hikaru if (newi <= 0) {
627 1.1 hikaru newi = 1;
628 1.1 hikaru #ifdef POW_DEBUG
629 1.1 hikaru log(LOG_DEBUG,
630 1.1 hikaru "Max intr rate.\n");
631 1.1 hikaru #endif
632 1.1 hikaru new = max_recv_cnt;
633 1.1 hikaru }
634 1.1 hikaru else {
635 1.1 hikaru log(LOG_DEBUG,
636 1.1 hikaru "pow interrupt rate optimized %d->%d.\n",
637 1.1 hikaru int_rate, newi);
638 1.1 hikaru int_rate = newi;
639 1.1 hikaru octeon_pow_config_int_pc_rate(sc, int_rate);
640 1.1 hikaru new = min_recv_cnt;
641 1.1 hikaru }
642 1.1 hikaru }
643 1.1 hikaru
644 1.1 hikaru s = splhigh(); /* XXX */
645 1.1 hikaru recv_cnt = new;
646 1.1 hikaru splx(s);
647 1.1 hikaru
648 1.1 hikaru return new;
649 1.1 hikaru }
650 1.1 hikaru
651 1.1 hikaru int
652 1.1 hikaru octeon_pow_ring_size(void)
653 1.1 hikaru {
654 1.1 hikaru return recv_cnt;
655 1.1 hikaru }
656 1.1 hikaru
657 1.1 hikaru int
658 1.1 hikaru octeon_pow_ring_intr(void)
659 1.1 hikaru {
660 1.1 hikaru return int_rate;
661 1.1 hikaru }
662 1.1 hikaru #endif /* OCTEON_ETH_INTR_FEEDBACK_RING */
663 1.1 hikaru
664 1.1 hikaru /* -------------------------------------------------------------------------- */
665 1.1 hikaru
666 1.1 hikaru /* ---- debug configuration */
667 1.1 hikaru
668 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
669 1.1 hikaru
670 1.1 hikaru void
671 1.1 hikaru octeon_pow_error_int_enable(void *data, int enable)
672 1.1 hikaru {
673 1.1 hikaru struct octeon_pow_softc *sc = data;
674 1.1 hikaru uint64_t pow_error_int_xxx;
675 1.1 hikaru
676 1.1 hikaru pow_error_int_xxx =
677 1.1 hikaru POW_ECC_ERR_IOP | POW_ECC_ERR_RPE |
678 1.1 hikaru POW_ECC_ERR_DBE | POW_ECC_ERR_SBE;
679 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET, pow_error_int_xxx);
680 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET, enable ? pow_error_int_xxx : 0);
681 1.1 hikaru }
682 1.1 hikaru
683 1.1 hikaru uint64_t
684 1.1 hikaru octeon_pow_error_int_summary(void *data)
685 1.1 hikaru {
686 1.1 hikaru struct octeon_pow_softc *sc = data;
687 1.1 hikaru uint64_t summary;
688 1.1 hikaru
689 1.1 hikaru summary = _POW_RD8(sc, POW_ECC_ERR_OFFSET);
690 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET, summary);
691 1.1 hikaru return summary;
692 1.1 hikaru }
693 1.1 hikaru
694 1.1 hikaru #endif
695 1.1 hikaru
696 1.1 hikaru /* -------------------------------------------------------------------------- */
697 1.1 hikaru
698 1.1 hikaru /* ---- debug counter */
699 1.1 hikaru
700 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
701 1.1 hikaru int octeon_pow_intr_rml_verbose;
702 1.1 hikaru struct evcnt octeon_pow_intr_evcnt;
703 1.1 hikaru
704 1.1 hikaru static const struct octeon_evcnt_entry octeon_pow_intr_evcnt_entries[] = {
705 1.1 hikaru #define _ENTRY(name, type, parent, descr) \
706 1.1 hikaru OCTEON_EVCNT_ENTRY(struct octeon_pow_softc, name, type, parent, descr)
707 1.1 hikaru _ENTRY(powecciopcsrpend, MISC, NULL, "pow csr load"),
708 1.1 hikaru _ENTRY(powecciopdbgpend, MISC, NULL, "pow dbg load"),
709 1.1 hikaru _ENTRY(powecciopaddwork, MISC, NULL, "pow addwork"),
710 1.1 hikaru _ENTRY(powecciopillop, MISC, NULL, "pow ill op"),
711 1.1 hikaru _ENTRY(poweccioppend24, MISC, NULL, "pow pend24"),
712 1.1 hikaru _ENTRY(poweccioppend23, MISC, NULL, "pow pend23"),
713 1.1 hikaru _ENTRY(poweccioppend22, MISC, NULL, "pow pend22"),
714 1.1 hikaru _ENTRY(poweccioppend21, MISC, NULL, "pow pend21"),
715 1.1 hikaru _ENTRY(poweccioptagnull, MISC, NULL, "pow tag null"),
716 1.1 hikaru _ENTRY(poweccioptagnullnull, MISC, NULL, "pow tag nullnull"),
717 1.1 hikaru _ENTRY(powecciopordatom, MISC, NULL, "pow ordered atomic"),
718 1.1 hikaru _ENTRY(powecciopnull, MISC, NULL, "pow core null"),
719 1.1 hikaru _ENTRY(powecciopnullnull, MISC, NULL, "pow core nullnull"),
720 1.1 hikaru _ENTRY(poweccrpe, MISC, NULL, "pow remote-pointer error"),
721 1.1 hikaru _ENTRY(poweccsyn, MISC, NULL, "pow syndrome value"),
722 1.1 hikaru _ENTRY(poweccdbe, MISC, NULL, "pow double bit"),
723 1.1 hikaru _ENTRY(poweccsbe, MISC, NULL, "pow single bit"),
724 1.1 hikaru #undef _ENTRY
725 1.1 hikaru };
726 1.1 hikaru
727 1.1 hikaru void
728 1.1 hikaru octeon_pow_intr_evcnt_attach(struct octeon_pow_softc *sc)
729 1.1 hikaru {
730 1.1 hikaru OCTEON_EVCNT_ATTACH_EVCNTS(sc, octeon_pow_intr_evcnt_entries, "pow0");
731 1.1 hikaru }
732 1.1 hikaru
733 1.1 hikaru void
734 1.1 hikaru octeon_pow_intr_rml(void *arg)
735 1.1 hikaru {
736 1.1 hikaru struct octeon_pow_softc *sc;
737 1.1 hikaru uint64_t reg;
738 1.1 hikaru
739 1.1 hikaru octeon_pow_intr_evcnt.ev_count++;
740 1.1 hikaru sc = __octeon_pow_softc;
741 1.1 hikaru KASSERT(sc != NULL);
742 1.1 hikaru reg = octeon_pow_error_int_summary(sc);
743 1.1 hikaru if (octeon_pow_intr_rml_verbose)
744 1.1 hikaru printf("%s: POW_ECC_ERR=0x%016" PRIx64 "\n", __func__, reg);
745 1.1 hikaru switch (reg & POW_ECC_ERR_IOP) {
746 1.1 hikaru case POW_ECC_ERR_IOP_CSRPEND:
747 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopcsrpend);
748 1.1 hikaru break;
749 1.1 hikaru case POW_ECC_ERR_IOP_DBGPEND:
750 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopdbgpend);
751 1.1 hikaru break;
752 1.1 hikaru case POW_ECC_ERR_IOP_ADDWORK:
753 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopaddwork);
754 1.1 hikaru break;
755 1.1 hikaru case POW_ECC_ERR_IOP_ILLOP:
756 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopillop);
757 1.1 hikaru break;
758 1.1 hikaru case POW_ECC_ERR_IOP_PEND24:
759 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend24);
760 1.1 hikaru break;
761 1.1 hikaru case POW_ECC_ERR_IOP_PEND23:
762 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend23);
763 1.1 hikaru break;
764 1.1 hikaru case POW_ECC_ERR_IOP_PEND22:
765 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend22);
766 1.1 hikaru break;
767 1.1 hikaru case POW_ECC_ERR_IOP_PEND21:
768 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend21);
769 1.1 hikaru break;
770 1.1 hikaru case POW_ECC_ERR_IOP_TAGNULL:
771 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioptagnull);
772 1.1 hikaru break;
773 1.1 hikaru case POW_ECC_ERR_IOP_TAGNULLNULL:
774 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioptagnullnull);
775 1.1 hikaru break;
776 1.1 hikaru case POW_ECC_ERR_IOP_ORDATOM:
777 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopordatom);
778 1.1 hikaru break;
779 1.1 hikaru case POW_ECC_ERR_IOP_NULL:
780 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopnull);
781 1.1 hikaru break;
782 1.1 hikaru case POW_ECC_ERR_IOP_NULLNULL:
783 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopnullnull);
784 1.1 hikaru break;
785 1.1 hikaru default:
786 1.1 hikaru break;
787 1.1 hikaru }
788 1.1 hikaru if (reg & POW_ECC_ERR_RPE)
789 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccrpe);
790 1.1 hikaru if (reg & POW_ECC_ERR_SYN)
791 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccsyn);
792 1.1 hikaru if (reg & POW_ECC_ERR_DBE)
793 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccdbe);
794 1.1 hikaru if (reg & POW_ECC_ERR_SBE)
795 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccsbe);
796 1.1 hikaru }
797 1.1 hikaru #endif
798 1.1 hikaru
799 1.1 hikaru /* -------------------------------------------------------------------------- */
800 1.1 hikaru
801 1.1 hikaru /* ---- debug dump */
802 1.1 hikaru
803 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
804 1.1 hikaru
805 1.1 hikaru void octeon_pow_dump_reg(void);
806 1.1 hikaru void octeon_pow_dump_ops(void);
807 1.1 hikaru
808 1.1 hikaru void
809 1.1 hikaru octeon_pow_dump(void)
810 1.1 hikaru {
811 1.1 hikaru octeon_pow_dump_reg();
812 1.1 hikaru octeon_pow_dump_ops();
813 1.1 hikaru }
814 1.1 hikaru
815 1.1 hikaru /* ---- register dump */
816 1.1 hikaru
817 1.1 hikaru struct octeon_pow_dump_reg_entry {
818 1.1 hikaru const char *name;
819 1.1 hikaru const char *format;
820 1.1 hikaru size_t offset;
821 1.1 hikaru };
822 1.1 hikaru
823 1.1 hikaru #define _ENTRY(x) { #x, x##_BITS, x##_OFFSET }
824 1.1 hikaru #define _ENTRY_0_7(x) \
825 1.1 hikaru _ENTRY(x## 0), _ENTRY(x## 1), _ENTRY(x## 2), _ENTRY(x## 3), \
826 1.1 hikaru _ENTRY(x## 4), _ENTRY(x## 5), _ENTRY(x## 6), _ENTRY(x## 7)
827 1.1 hikaru #define _ENTRY_0_15(x) \
828 1.1 hikaru _ENTRY(x## 0), _ENTRY(x## 1), _ENTRY(x## 2), _ENTRY(x## 3), \
829 1.1 hikaru _ENTRY(x## 4), _ENTRY(x## 5), _ENTRY(x## 6), _ENTRY(x## 7), \
830 1.1 hikaru _ENTRY(x## 8), _ENTRY(x## 9), _ENTRY(x##10), _ENTRY(x##11), \
831 1.1 hikaru _ENTRY(x##12), _ENTRY(x##13), _ENTRY(x##14), _ENTRY(x##15)
832 1.1 hikaru
833 1.1 hikaru static const struct octeon_pow_dump_reg_entry octeon_pow_dump_reg_entries[] = {
834 1.1 hikaru _ENTRY (POW_PP_GRP_MSK0),
835 1.1 hikaru _ENTRY (POW_PP_GRP_MSK1),
836 1.1 hikaru _ENTRY_0_15 (POW_WQ_INT_THR),
837 1.1 hikaru _ENTRY_0_15 (POW_WQ_INT_CNT),
838 1.1 hikaru _ENTRY_0_7 (POW_QOS_THR),
839 1.1 hikaru _ENTRY_0_7 (POW_QOS_RND),
840 1.1 hikaru _ENTRY (POW_WQ_INT),
841 1.1 hikaru _ENTRY (POW_WQ_INT_PC),
842 1.1 hikaru _ENTRY (POW_NW_TIM),
843 1.1 hikaru _ENTRY (POW_ECC_ERR),
844 1.1 hikaru _ENTRY (POW_NOS_CNT),
845 1.1 hikaru _ENTRY_0_15 (POW_WS_PC),
846 1.1 hikaru _ENTRY_0_7 (POW_WA_PC),
847 1.1 hikaru _ENTRY_0_7 (POW_IQ_CNT),
848 1.1 hikaru _ENTRY (POW_WA_COM_PC),
849 1.1 hikaru _ENTRY (POW_IQ_COM_CNT),
850 1.1 hikaru _ENTRY (POW_TS_PC),
851 1.1 hikaru _ENTRY (POW_DS_PC),
852 1.1 hikaru _ENTRY (POW_BIST_STAT)
853 1.1 hikaru };
854 1.1 hikaru
855 1.1 hikaru #undef _ENTRY
856 1.1 hikaru
857 1.1 hikaru void
858 1.1 hikaru octeon_pow_dump_reg(void)
859 1.1 hikaru {
860 1.1 hikaru struct octeon_pow_softc *sc = __octeon_pow_softc;
861 1.1 hikaru const struct octeon_pow_dump_reg_entry *entry;
862 1.1 hikaru uint64_t tmp;
863 1.1 hikaru char buf[512];
864 1.1 hikaru int i;
865 1.1 hikaru
866 1.1 hikaru for (i = 0; i < (int)__arraycount(octeon_pow_dump_reg_entries); i++) {
867 1.1 hikaru entry = &octeon_pow_dump_reg_entries[i];
868 1.1 hikaru tmp = _POW_RD8(sc, entry->offset);
869 1.1 hikaru if (entry->format == NULL)
870 1.1 hikaru snprintf(buf, sizeof(buf), "%16" PRIx64, tmp);
871 1.1 hikaru else
872 1.1 hikaru snprintb(buf, sizeof(buf), entry->format, tmp);
873 1.1 hikaru printf("\t%-24s: %s\n", entry->name, buf);
874 1.1 hikaru }
875 1.1 hikaru }
876 1.1 hikaru
877 1.1 hikaru /* ---- operations dump */
878 1.1 hikaru
879 1.1 hikaru struct octeon_pow_dump_ops_entry {
880 1.1 hikaru const char *name;
881 1.1 hikaru const char *format;
882 1.1 hikaru uint64_t (*func)(int);
883 1.1 hikaru };
884 1.1 hikaru
885 1.1 hikaru void octeon_pow_dump_ops_coreid(int);
886 1.1 hikaru void octeon_pow_dump_ops_index(int);
887 1.1 hikaru void octeon_pow_dump_ops_qos(int);
888 1.1 hikaru void octeon_pow_dump_ops_grp(int);
889 1.1 hikaru void octeon_pow_dump_ops_queue(int);
890 1.1 hikaru void octeon_pow_dump_ops_common(const struct
891 1.1 hikaru octeon_pow_dump_ops_entry *, size_t, const char *,
892 1.1 hikaru int);
893 1.1 hikaru
894 1.1 hikaru #define _ENTRY_COMMON(name, prefix, x, y) \
895 1.1 hikaru { #name "_" #x, prefix##_##y##_BITS, octeon_pow_status_by_##name##_##x }
896 1.1 hikaru
897 1.1 hikaru const struct octeon_pow_dump_ops_entry octeon_pow_dump_ops_coreid_entries[] = {
898 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(coreid, POW_STATUS_LOAD_RESULT, x, y)
899 1.1 hikaru _ENTRY(pend_tag, PEND_TAG),
900 1.1 hikaru _ENTRY(pend_wqp, PEND_WQP),
901 1.1 hikaru _ENTRY(cur_tag_next, CUR_TAG_NEXT),
902 1.1 hikaru _ENTRY(cur_tag_prev, CUR_TAG_PREV),
903 1.1 hikaru _ENTRY(cur_wqp_next, CUR_WQP_NEXT),
904 1.1 hikaru _ENTRY(cur_wqp_prev, CUR_WQP_PREV)
905 1.1 hikaru #undef _ENTRY
906 1.1 hikaru };
907 1.1 hikaru
908 1.1 hikaru const struct octeon_pow_dump_ops_entry octeon_pow_dump_ops_index_entries[] = {
909 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(index, POW_MEMORY_LOAD_RESULT, x, y)
910 1.1 hikaru _ENTRY(tag, TAG),
911 1.1 hikaru _ENTRY(wqp, WQP),
912 1.1 hikaru _ENTRY(desched, DESCHED)
913 1.1 hikaru #undef _ENTRY
914 1.1 hikaru };
915 1.1 hikaru
916 1.1 hikaru const struct octeon_pow_dump_ops_entry octeon_pow_dump_ops_qos_entries[] = {
917 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(qos, POW_IDXPTR_LOAD_RESULT_QOS, x, y)
918 1.1 hikaru _ENTRY(free_loc, FREE_LOC)
919 1.1 hikaru #undef _ENTRY
920 1.1 hikaru };
921 1.1 hikaru
922 1.1 hikaru const struct octeon_pow_dump_ops_entry octeon_pow_dump_ops_grp_entries[] = {
923 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(grp, POW_IDXPTR_LOAD_RESULT_GRP, x, y)
924 1.1 hikaru _ENTRY(nosched_des, NOSCHED_DES)
925 1.1 hikaru #undef _ENTRY
926 1.1 hikaru };
927 1.1 hikaru
928 1.1 hikaru const struct octeon_pow_dump_ops_entry octeon_pow_dump_ops_queue_entries[] = {
929 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(queue, POW_IDXPTR_LOAD_RESULT_QUEUE, x, y)
930 1.1 hikaru _ENTRY(remote_head, REMOTE_HEAD),
931 1.1 hikaru _ENTRY(remote_tail, REMOTE_TAIL)
932 1.1 hikaru #undef _ENTRY
933 1.1 hikaru };
934 1.1 hikaru
935 1.1 hikaru void
936 1.1 hikaru octeon_pow_dump_ops(void)
937 1.1 hikaru {
938 1.1 hikaru int i;
939 1.1 hikaru
940 1.1 hikaru /* XXX */
941 1.1 hikaru for (i = 0; i < 2/* XXX */; i++)
942 1.1 hikaru octeon_pow_dump_ops_coreid(i);
943 1.1 hikaru
944 1.1 hikaru /* XXX */
945 1.1 hikaru octeon_pow_dump_ops_index(0);
946 1.1 hikaru
947 1.1 hikaru for (i = 0; i < 8; i++)
948 1.1 hikaru octeon_pow_dump_ops_qos(i);
949 1.1 hikaru
950 1.1 hikaru for (i = 0; i < 16; i++)
951 1.1 hikaru octeon_pow_dump_ops_grp(i);
952 1.1 hikaru
953 1.1 hikaru for (i = 0; i < 16; i++)
954 1.1 hikaru octeon_pow_dump_ops_queue(i);
955 1.1 hikaru }
956 1.1 hikaru
957 1.1 hikaru void
958 1.1 hikaru octeon_pow_dump_ops_coreid(int coreid)
959 1.1 hikaru {
960 1.1 hikaru octeon_pow_dump_ops_common(octeon_pow_dump_ops_coreid_entries,
961 1.1 hikaru __arraycount(octeon_pow_dump_ops_coreid_entries), "coreid", coreid);
962 1.1 hikaru }
963 1.1 hikaru
964 1.1 hikaru void
965 1.1 hikaru octeon_pow_dump_ops_index(int index)
966 1.1 hikaru {
967 1.1 hikaru octeon_pow_dump_ops_common(octeon_pow_dump_ops_index_entries,
968 1.1 hikaru __arraycount(octeon_pow_dump_ops_index_entries), "index", index);
969 1.1 hikaru }
970 1.1 hikaru
971 1.1 hikaru void
972 1.1 hikaru octeon_pow_dump_ops_qos(int qos)
973 1.1 hikaru {
974 1.1 hikaru octeon_pow_dump_ops_common(octeon_pow_dump_ops_qos_entries,
975 1.1 hikaru __arraycount(octeon_pow_dump_ops_qos_entries), "qos", qos);
976 1.1 hikaru }
977 1.1 hikaru
978 1.1 hikaru void
979 1.1 hikaru octeon_pow_dump_ops_grp(int grp)
980 1.1 hikaru {
981 1.1 hikaru octeon_pow_dump_ops_common(octeon_pow_dump_ops_grp_entries,
982 1.1 hikaru __arraycount(octeon_pow_dump_ops_grp_entries), "grp", grp);
983 1.1 hikaru }
984 1.1 hikaru
985 1.1 hikaru void
986 1.1 hikaru octeon_pow_dump_ops_queue(int queue)
987 1.1 hikaru {
988 1.1 hikaru octeon_pow_dump_ops_common(octeon_pow_dump_ops_queue_entries,
989 1.1 hikaru __arraycount(octeon_pow_dump_ops_queue_entries), "queue", queue);
990 1.1 hikaru }
991 1.1 hikaru
992 1.1 hikaru void
993 1.1 hikaru octeon_pow_dump_ops_common(const struct octeon_pow_dump_ops_entry *entries,
994 1.1 hikaru size_t nentries, const char *by_what, int arg)
995 1.1 hikaru {
996 1.1 hikaru const struct octeon_pow_dump_ops_entry *entry;
997 1.1 hikaru uint64_t tmp;
998 1.1 hikaru char buf[512];
999 1.1 hikaru int i;
1000 1.1 hikaru
1001 1.1 hikaru printf("%s=%d\n", by_what, arg);
1002 1.1 hikaru for (i = 0; i < (int)nentries; i++) {
1003 1.1 hikaru entry = &entries[i];
1004 1.1 hikaru tmp = (*entry->func)(arg);
1005 1.1 hikaru if (entry->format == NULL)
1006 1.1 hikaru snprintf(buf, sizeof(buf), "%16" PRIx64, tmp);
1007 1.1 hikaru else
1008 1.1 hikaru snprintb(buf, sizeof(buf), entry->format, tmp);
1009 1.1 hikaru printf("\t%-24s: %s\n", entry->name, buf);
1010 1.1 hikaru }
1011 1.1 hikaru }
1012 1.1 hikaru
1013 1.1 hikaru #endif
1014 1.1 hikaru
1015 1.1 hikaru /* -------------------------------------------------------------------------- */
1016 1.1 hikaru
1017 1.1 hikaru /* ---- test */
1018 1.1 hikaru
1019 1.1 hikaru #ifdef OCTEON_POW_TEST
1020 1.1 hikaru /*
1021 1.1 hikaru * Standalone test entries; meant to be called from ddb.
1022 1.1 hikaru */
1023 1.1 hikaru
1024 1.1 hikaru void octeon_pow_test(void);
1025 1.1 hikaru void octeon_pow_test_dump_wqe(paddr_t);
1026 1.1 hikaru
1027 1.1 hikaru static void octeon_pow_test_1(void);
1028 1.1 hikaru
1029 1.1 hikaru struct test_wqe {
1030 1.1 hikaru uint64_t word0;
1031 1.1 hikaru uint64_t word1;
1032 1.1 hikaru uint64_t word2;
1033 1.1 hikaru uint64_t word3;
1034 1.1 hikaru } __packed;
1035 1.1 hikaru struct test_wqe test_wqe;
1036 1.1 hikaru
1037 1.1 hikaru void
1038 1.1 hikaru octeon_pow_test(void)
1039 1.1 hikaru {
1040 1.1 hikaru octeon_pow_test_1();
1041 1.1 hikaru }
1042 1.1 hikaru
1043 1.1 hikaru static void
1044 1.1 hikaru octeon_pow_test_1(void)
1045 1.1 hikaru {
1046 1.1 hikaru struct test_wqe *wqe = &test_wqe;
1047 1.1 hikaru int qos, grp, queue, tt;
1048 1.1 hikaru uint32_t tag;
1049 1.1 hikaru paddr_t ptr;
1050 1.1 hikaru
1051 1.1 hikaru qos = 7; /* XXX */
1052 1.1 hikaru grp = queue = 15; /* XXX */
1053 1.1 hikaru tt = POW_TAG_TYPE_ORDERED; /* XXX */
1054 1.1 hikaru tag = UINT32_C(0x01234567); /* XXX */
1055 1.1 hikaru
1056 1.1 hikaru /* => make sure that the queue is empty */
1057 1.1 hikaru
1058 1.1 hikaru octeon_pow_dump_ops_qos(qos);
1059 1.1 hikaru octeon_pow_dump_ops_grp(grp);
1060 1.1 hikaru printf("\n");
1061 1.1 hikaru
1062 1.1 hikaru /*
1063 1.1 hikaru * Initialize WQE.
1064 1.1 hikaru *
1065 1.1 hikaru * word0:next is used by hardware.
1066 1.1 hikaru *
1067 1.1 hikaru * word1:qos, word1:grp, word1:tt, word1:tag must match with arguments
1068 1.1 hikaru * of the following ADDWQ transaction.
1069 1.1 hikaru */
1070 1.1 hikaru
1071 1.1 hikaru (void)memset(wqe, 0, sizeof(*wqe));
1072 1.1 hikaru wqe->word0 =
1073 1.1 hikaru __BITS64_SET(POW_WQE_WORD0_NEXT, 0);
1074 1.1 hikaru wqe->word1 =
1075 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_QOS, qos) |
1076 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_GRP, grp) |
1077 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_TT, tt) |
1078 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_TAG, tag);
1079 1.1 hikaru
1080 1.1 hikaru printf("calling ADDWQ\n");
1081 1.1 hikaru octeon_pow_ops_addwq(MIPS_KSEG0_TO_PHYS(wqe), qos, grp, tt, tag);
1082 1.1 hikaru
1083 1.1 hikaru octeon_pow_dump_ops_qos(qos);
1084 1.1 hikaru octeon_pow_dump_ops_grp(grp);
1085 1.1 hikaru printf("\n");
1086 1.1 hikaru
1087 1.1 hikaru /* => make sure that a WQE is added to the queue */
1088 1.1 hikaru
1089 1.1 hikaru printf("calling GET_WORK_LOAD\n");
1090 1.1 hikaru ptr = octeon_pow_ops_get_work_load(0);
1091 1.1 hikaru
1092 1.1 hikaru octeon_pow_dump_ops_qos(qos);
1093 1.1 hikaru octeon_pow_dump_ops_grp(grp);
1094 1.1 hikaru printf("\n");
1095 1.1 hikaru
1096 1.1 hikaru octeon_pow_test_dump_wqe(ptr);
1097 1.1 hikaru
1098 1.1 hikaru /* => make sure that the WQE is in-flight (and scheduled) */
1099 1.1 hikaru
1100 1.1 hikaru printf("calling SWTAG(NULL)\n");
1101 1.1 hikaru octeon_pow_ops_swtag(POW_TAG_TYPE_NULL, tag);
1102 1.1 hikaru
1103 1.1 hikaru octeon_pow_dump_ops_qos(qos);
1104 1.1 hikaru octeon_pow_dump_ops_grp(grp);
1105 1.1 hikaru printf("\n");
1106 1.1 hikaru
1107 1.1 hikaru /* => make sure that the WQE is un-scheduled (completed) */
1108 1.1 hikaru }
1109 1.1 hikaru
1110 1.1 hikaru void
1111 1.1 hikaru octeon_pow_test_dump_wqe(paddr_t ptr)
1112 1.1 hikaru {
1113 1.1 hikaru uint64_t word0, word1;
1114 1.1 hikaru char buf[128];
1115 1.1 hikaru
1116 1.1 hikaru printf("wqe\n");
1117 1.1 hikaru
1118 1.1 hikaru word0 = *(uint64_t *)MIPS_PHYS_TO_XKPHYS_CACHED(ptr);
1119 1.1 hikaru snprintb(buf, sizeof(buf), POW_WQE_WORD0_BITS, word0);
1120 1.1 hikaru printf("\t%-24s: %s\n", "word0", buf);
1121 1.1 hikaru
1122 1.1 hikaru word1 = *(uint64_t *)MIPS_PHYS_TO_XKPHYS_CACHED(ptr + 8);
1123 1.1 hikaru snprintb(buf, sizeof(buf), POW_WQE_WORD1_BITS, word1);
1124 1.1 hikaru printf("\t%-24s: %s\n", "word1", buf);
1125 1.1 hikaru }
1126 1.1 hikaru #endif
1127