octeon_pow.c revision 1.1 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.1 hikaru __KERNEL_RCSID(0, "$NetBSD: octeon_pow.c,v 1.1 2015/04/29 08:32:01 hikaru 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 0/* XXX */,
332 1.1 hikaru level,
333 1.1 hikaru octeon_pow_intr, pow_ih);
334 1.1 hikaru KASSERT(pow_ih->pi_ih != NULL);
335 1.1 hikaru
336 1.1 hikaru pow_ih->pi_sc = &octeon_pow_softc; /* XXX */
337 1.1 hikaru pow_ih->pi_group = group;
338 1.1 hikaru pow_ih->pi_cb = cb;
339 1.1 hikaru pow_ih->pi_data = data;
340 1.1 hikaru
341 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
342 1.1 hikaru octeon_pow_intr_debug_init(pow_ih, group);
343 1.1 hikaru #endif
344 1.1 hikaru return pow_ih;
345 1.1 hikaru }
346 1.1 hikaru
347 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
348 1.1 hikaru #define _NAMELEN 8
349 1.1 hikaru #define _DESCRLEN 40
350 1.1 hikaru
351 1.1 hikaru static void
352 1.1 hikaru octeon_pow_intr_debug_init(struct octeon_pow_intr_handle *pow_ih, int group)
353 1.1 hikaru {
354 1.1 hikaru pow_ih->pi_first = 1;
355 1.1 hikaru char *name, *descr;
356 1.1 hikaru int i;
357 1.1 hikaru
358 1.1 hikaru name = malloc(_NAMELEN +
359 1.1 hikaru _DESCRLEN * __arraycount(pow_ih->pi_ev_per) +
360 1.1 hikaru _DESCRLEN * __arraycount(pow_ih->pi_ev_ival),
361 1.1 hikaru M_DEVBUF, M_NOWAIT);
362 1.1 hikaru descr = name + _NAMELEN;
363 1.1 hikaru snprintf(name, _NAMELEN, "pow%d", group);
364 1.1 hikaru for (i = 0; i < (int)__arraycount(pow_ih->pi_ev_per); i++) {
365 1.1 hikaru int n = 1 << (i - 1);
366 1.1 hikaru
367 1.1 hikaru (void)snprintf(descr, _DESCRLEN,
368 1.1 hikaru "# of works per intr (%d-%d)",
369 1.1 hikaru (i == 0) ? 0 : n,
370 1.1 hikaru (i == 0) ? 0 : ((n << 1) - 1));
371 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_per[i],
372 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, descr);
373 1.1 hikaru descr += _DESCRLEN;
374 1.1 hikaru }
375 1.1 hikaru for (i = 0; i < (int)__arraycount(pow_ih->pi_ev_ival); i++) {
376 1.1 hikaru int n = 1 << (i - 1);
377 1.1 hikaru int p, q;
378 1.1 hikaru char unit;
379 1.1 hikaru
380 1.1 hikaru p = n;
381 1.1 hikaru q = (n << 1) - 1;
382 1.1 hikaru unit = 'u';
383 1.1 hikaru /*
384 1.1 hikaru * 0 is exceptional
385 1.1 hikaru */
386 1.1 hikaru if (i == 0)
387 1.1 hikaru p = q = 0;
388 1.1 hikaru /*
389 1.1 hikaru * count 1024usec as 1msec
390 1.1 hikaru *
391 1.1 hikaru * XXX this is not exact
392 1.1 hikaru */
393 1.1 hikaru if ((i - 1) >= 10) {
394 1.1 hikaru p /= 1000;
395 1.1 hikaru q /= 1000;
396 1.1 hikaru unit = 'm';
397 1.1 hikaru }
398 1.1 hikaru (void)snprintf(descr, _DESCRLEN, "intr interval (%d-%d%csec)",
399 1.1 hikaru p, q, unit);
400 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_ival[i],
401 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, descr);
402 1.1 hikaru descr += _DESCRLEN;
403 1.1 hikaru }
404 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_stray_tc,
405 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, "stray intr (TC)");
406 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_stray_ds,
407 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, "stray intr (DS)");
408 1.1 hikaru evcnt_attach_dynamic(&pow_ih->pi_ev_stray_iq,
409 1.1 hikaru EVCNT_TYPE_MISC, NULL, name, "stray intr (IQ)");
410 1.1 hikaru }
411 1.1 hikaru #endif
412 1.1 hikaru
413 1.1 hikaru void
414 1.1 hikaru octeon_pow_init(struct octeon_pow_softc *sc)
415 1.1 hikaru {
416 1.1 hikaru octeon_pow_init_regs(sc);
417 1.1 hikaru
418 1.1 hikaru sc->sc_int_pc_base = 10000;
419 1.1 hikaru octeon_pow_config_int_pc(sc, sc->sc_int_pc_base);
420 1.1 hikaru
421 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
422 1.1 hikaru octeon_pow_error_int_enable(sc, 1);
423 1.1 hikaru #endif
424 1.1 hikaru }
425 1.1 hikaru
426 1.1 hikaru void
427 1.1 hikaru octeon_pow_init_regs(struct octeon_pow_softc *sc)
428 1.1 hikaru {
429 1.1 hikaru int status;
430 1.1 hikaru
431 1.1 hikaru status = bus_space_map(sc->sc_regt, POW_BASE, POW_SIZE, 0,
432 1.1 hikaru &sc->sc_regh);
433 1.1 hikaru if (status != 0)
434 1.1 hikaru panic("can't map %s space", "pow register");
435 1.1 hikaru
436 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
437 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET,
438 1.1 hikaru POW_ECC_ERR_IOP_IE | POW_ECC_ERR_RPE_IE |
439 1.1 hikaru POW_ECC_ERR_DBE_IE | POW_ECC_ERR_SBE_IE);
440 1.1 hikaru #endif
441 1.1 hikaru }
442 1.1 hikaru
443 1.1 hikaru /* -------------------------------------------------------------------------- */
444 1.1 hikaru
445 1.1 hikaru /* ---- interrupt handling */
446 1.1 hikaru
447 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
448 1.1 hikaru static inline void
449 1.1 hikaru octeon_pow_intr_work_debug_ival(struct octeon_pow_softc *sc,
450 1.1 hikaru struct octeon_pow_intr_handle *pow_ih)
451 1.1 hikaru {
452 1.1 hikaru struct timeval now;
453 1.1 hikaru struct timeval ival;
454 1.1 hikaru int n;
455 1.1 hikaru
456 1.1 hikaru microtime(&now);
457 1.1 hikaru if (__predict_false(pow_ih->pi_first == 1)) {
458 1.1 hikaru pow_ih->pi_first = 0;
459 1.1 hikaru goto stat_done;
460 1.1 hikaru }
461 1.1 hikaru timersub(&now, &pow_ih->pi_last, &ival);
462 1.1 hikaru if (ival.tv_sec != 0)
463 1.1 hikaru goto stat_done; /* XXX */
464 1.1 hikaru n = ffs64((uint64_t)ival.tv_usec);
465 1.1 hikaru if (n > (int)__arraycount(pow_ih->pi_ev_ival) - 1)
466 1.1 hikaru n = (int)__arraycount(pow_ih->pi_ev_ival) - 1;
467 1.1 hikaru pow_ih->pi_ev_ival[n].ev_count++;
468 1.1 hikaru
469 1.1 hikaru stat_done:
470 1.1 hikaru pow_ih->pi_last = now; /* struct copy */
471 1.1 hikaru }
472 1.1 hikaru
473 1.1 hikaru static inline void
474 1.1 hikaru octeon_pow_intr_work_debug_per(struct octeon_pow_softc *sc,
475 1.1 hikaru struct octeon_pow_intr_handle *pow_ih, int count)
476 1.1 hikaru {
477 1.1 hikaru int n;
478 1.1 hikaru
479 1.1 hikaru n = ffs64(count);
480 1.1 hikaru if (n > (int)__arraycount(pow_ih->pi_ev_per) - 1)
481 1.1 hikaru n = (int)__arraycount(pow_ih->pi_ev_per) - 1;
482 1.1 hikaru pow_ih->pi_ev_per[n].ev_count++;
483 1.1 hikaru #if 1
484 1.1 hikaru if (count == 0) {
485 1.1 hikaru uint64_t wq_int_cnt;
486 1.1 hikaru
487 1.1 hikaru wq_int_cnt = _POW_GROUP_RD8(sc, pow_ih, POW_WQ_INT_CNT0_OFFSET);
488 1.1 hikaru if (wq_int_cnt & POW_WQ_INT_CNTX_TC_CNT)
489 1.1 hikaru pow_ih->pi_ev_stray_tc.ev_count++;
490 1.1 hikaru if (wq_int_cnt & POW_WQ_INT_CNTX_DS_CNT)
491 1.1 hikaru pow_ih->pi_ev_stray_ds.ev_count++;
492 1.1 hikaru if (wq_int_cnt & POW_WQ_INT_CNTX_IQ_CNT)
493 1.1 hikaru pow_ih->pi_ev_stray_iq.ev_count++;
494 1.1 hikaru }
495 1.1 hikaru #endif
496 1.1 hikaru }
497 1.1 hikaru #endif
498 1.1 hikaru
499 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
500 1.1 hikaru #define _POW_INTR_WORK_DEBUG_IVAL(sc, ih) \
501 1.1 hikaru octeon_pow_intr_work_debug_ival((sc), (ih))
502 1.1 hikaru #define _POW_INTR_WORK_DEBUG_PER(sc, ih, count) \
503 1.1 hikaru octeon_pow_intr_work_debug_per((sc), (ih), (count))
504 1.1 hikaru #else
505 1.1 hikaru #define _POW_INTR_WORK_DEBUG_IVAL(sc, ih) \
506 1.1 hikaru do {} while (0)
507 1.1 hikaru #define _POW_INTR_WORK_DEBUG_PER(sc, ih, count) \
508 1.1 hikaru do {} while (0)
509 1.1 hikaru #endif
510 1.1 hikaru
511 1.1 hikaru /*
512 1.1 hikaru * Interrupt handling by fixed count, following Cavium's SDK code.
513 1.1 hikaru *
514 1.1 hikaru * XXX the fixed count (MAX_RX_CNT) could be changed dynamically?
515 1.1 hikaru *
516 1.1 hikaru * XXX this does not utilize "tag switch" very well
517 1.1 hikaru */
518 1.1 hikaru /*
519 1.1 hikaru * usually all packet recieve
520 1.1 hikaru */
521 1.1 hikaru #define MAX_RX_CNT 0x7fffffff
522 1.1 hikaru
523 1.1 hikaru static inline void
524 1.1 hikaru octeon_pow_intr_work(struct octeon_pow_softc *sc,
525 1.1 hikaru struct octeon_pow_intr_handle *pow_ih, int recv_limit)
526 1.1 hikaru {
527 1.1 hikaru uint64_t *work;
528 1.1 hikaru uint64_t count = 0;
529 1.1 hikaru
530 1.1 hikaru _POW_WR8(sc, POW_PP_GRP_MSK0_OFFSET, UINT64_C(1) << pow_ih->pi_group);
531 1.1 hikaru
532 1.1 hikaru _POW_INTR_WORK_DEBUG_IVAL(sc, pow_ih);
533 1.1 hikaru
534 1.1 hikaru for (count = 0; count < recv_limit; count++) {
535 1.1 hikaru octeon_pow_tag_sw_wait();
536 1.1 hikaru octeon_pow_work_request_async(
537 1.1 hikaru OCTEON_CVMSEG_OFFSET(csm_pow_intr), POW_NO_WAIT);
538 1.1 hikaru work = (uint64_t *)octeon_pow_work_response_async(
539 1.1 hikaru OCTEON_CVMSEG_OFFSET(csm_pow_intr));
540 1.1 hikaru if (work == NULL)
541 1.1 hikaru break;
542 1.1 hikaru (*pow_ih->pi_cb)(pow_ih->pi_data, work);
543 1.1 hikaru }
544 1.1 hikaru
545 1.1 hikaru _POW_INTR_WORK_DEBUG_PER(sc, pow_ih, count);
546 1.1 hikaru }
547 1.1 hikaru
548 1.1 hikaru static int
549 1.1 hikaru octeon_pow_intr(void *data)
550 1.1 hikaru {
551 1.1 hikaru struct octeon_pow_intr_handle *pow_ih = data;
552 1.1 hikaru struct octeon_pow_softc *sc = pow_ih->pi_sc;
553 1.1 hikaru uint64_t wq_int_mask = UINT64_C(0x1) << pow_ih->pi_group;
554 1.1 hikaru
555 1.1 hikaru #ifdef OCTEON_ETH_INTR_FEEDBACK_RING
556 1.1 hikaru octeon_pow_intr_work(sc, pow_ih, recv_cnt);
557 1.1 hikaru #else
558 1.1 hikaru octeon_pow_intr_work(sc, pow_ih, INT_MAX);
559 1.1 hikaru #endif /* OCTEON_ETH_INTR_FEEDBACK_RING */
560 1.1 hikaru
561 1.1 hikaru _POW_WR8(sc, POW_WQ_INT_OFFSET, wq_int_mask << POW_WQ_INT_WQ_INT_SHIFT);
562 1.1 hikaru return 1;
563 1.1 hikaru }
564 1.1 hikaru
565 1.1 hikaru #ifdef OCTEON_ETH_INTR_FEEDBACK_RING
566 1.1 hikaru int
567 1.1 hikaru octeon_pow_ring_reduce(void *arg)
568 1.1 hikaru {
569 1.1 hikaru struct octeon_pow_softc *sc = arg;
570 1.1 hikaru int new, newi;
571 1.1 hikaru int s;
572 1.1 hikaru
573 1.1 hikaru #if 0
574 1.1 hikaru if (ipflow_fastforward_disable_flags == 0) {
575 1.1 hikaru newi = int_rate = 1;
576 1.1 hikaru octeon_pow_config_int_pc_rate(sc, int_rate);
577 1.1 hikaru return recv_cnt;
578 1.1 hikaru }
579 1.1 hikaru #endif
580 1.1 hikaru
581 1.1 hikaru new = recv_cnt / 2;
582 1.1 hikaru if (new < min_recv_cnt) {
583 1.1 hikaru newi = int_rate << 1;
584 1.1 hikaru if (newi > 128) {
585 1.1 hikaru newi = 128;
586 1.1 hikaru #ifdef POW_DEBUG
587 1.1 hikaru log(LOG_DEBUG,
588 1.1 hikaru "Min intr rate.\n");
589 1.1 hikaru #endif
590 1.1 hikaru new = min_recv_cnt;
591 1.1 hikaru }
592 1.1 hikaru else {
593 1.1 hikaru log(LOG_DEBUG,
594 1.1 hikaru "pow interrupt rate optimized %d->%d.\n",
595 1.1 hikaru int_rate, newi);
596 1.1 hikaru int_rate = newi;
597 1.1 hikaru octeon_pow_config_int_pc_rate(sc, int_rate);
598 1.1 hikaru new = max_recv_cnt;
599 1.1 hikaru }
600 1.1 hikaru }
601 1.1 hikaru
602 1.1 hikaru s = splhigh(); /* XXX */
603 1.1 hikaru recv_cnt = new;
604 1.1 hikaru splx(s);
605 1.1 hikaru
606 1.1 hikaru return new;
607 1.1 hikaru }
608 1.1 hikaru
609 1.1 hikaru int
610 1.1 hikaru octeon_pow_ring_grow(void *arg)
611 1.1 hikaru {
612 1.1 hikaru struct octeon_pow_softc *sc = arg;
613 1.1 hikaru int new, newi;
614 1.1 hikaru int s;
615 1.1 hikaru
616 1.1 hikaru #if 0
617 1.1 hikaru if (ipflow_fastforward_disable_flags == 0) {
618 1.1 hikaru newi = int_rate = 1;
619 1.1 hikaru octeon_pow_config_int_pc_rate(sc, int_rate);
620 1.1 hikaru return recv_cnt;
621 1.1 hikaru }
622 1.1 hikaru #endif
623 1.1 hikaru
624 1.1 hikaru new = recv_cnt + 1;
625 1.1 hikaru if (new > max_recv_cnt) {
626 1.1 hikaru newi = int_rate >> 1;
627 1.1 hikaru if (newi <= 0) {
628 1.1 hikaru newi = 1;
629 1.1 hikaru #ifdef POW_DEBUG
630 1.1 hikaru log(LOG_DEBUG,
631 1.1 hikaru "Max intr rate.\n");
632 1.1 hikaru #endif
633 1.1 hikaru new = max_recv_cnt;
634 1.1 hikaru }
635 1.1 hikaru else {
636 1.1 hikaru log(LOG_DEBUG,
637 1.1 hikaru "pow interrupt rate optimized %d->%d.\n",
638 1.1 hikaru int_rate, newi);
639 1.1 hikaru int_rate = newi;
640 1.1 hikaru octeon_pow_config_int_pc_rate(sc, int_rate);
641 1.1 hikaru new = min_recv_cnt;
642 1.1 hikaru }
643 1.1 hikaru }
644 1.1 hikaru
645 1.1 hikaru s = splhigh(); /* XXX */
646 1.1 hikaru recv_cnt = new;
647 1.1 hikaru splx(s);
648 1.1 hikaru
649 1.1 hikaru return new;
650 1.1 hikaru }
651 1.1 hikaru
652 1.1 hikaru int
653 1.1 hikaru octeon_pow_ring_size(void)
654 1.1 hikaru {
655 1.1 hikaru return recv_cnt;
656 1.1 hikaru }
657 1.1 hikaru
658 1.1 hikaru int
659 1.1 hikaru octeon_pow_ring_intr(void)
660 1.1 hikaru {
661 1.1 hikaru return int_rate;
662 1.1 hikaru }
663 1.1 hikaru #endif /* OCTEON_ETH_INTR_FEEDBACK_RING */
664 1.1 hikaru
665 1.1 hikaru /* -------------------------------------------------------------------------- */
666 1.1 hikaru
667 1.1 hikaru /* ---- debug configuration */
668 1.1 hikaru
669 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
670 1.1 hikaru
671 1.1 hikaru void
672 1.1 hikaru octeon_pow_error_int_enable(void *data, int enable)
673 1.1 hikaru {
674 1.1 hikaru struct octeon_pow_softc *sc = data;
675 1.1 hikaru uint64_t pow_error_int_xxx;
676 1.1 hikaru
677 1.1 hikaru pow_error_int_xxx =
678 1.1 hikaru POW_ECC_ERR_IOP | POW_ECC_ERR_RPE |
679 1.1 hikaru POW_ECC_ERR_DBE | POW_ECC_ERR_SBE;
680 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET, pow_error_int_xxx);
681 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET, enable ? pow_error_int_xxx : 0);
682 1.1 hikaru }
683 1.1 hikaru
684 1.1 hikaru uint64_t
685 1.1 hikaru octeon_pow_error_int_summary(void *data)
686 1.1 hikaru {
687 1.1 hikaru struct octeon_pow_softc *sc = data;
688 1.1 hikaru uint64_t summary;
689 1.1 hikaru
690 1.1 hikaru summary = _POW_RD8(sc, POW_ECC_ERR_OFFSET);
691 1.1 hikaru _POW_WR8(sc, POW_ECC_ERR_OFFSET, summary);
692 1.1 hikaru return summary;
693 1.1 hikaru }
694 1.1 hikaru
695 1.1 hikaru #endif
696 1.1 hikaru
697 1.1 hikaru /* -------------------------------------------------------------------------- */
698 1.1 hikaru
699 1.1 hikaru /* ---- debug counter */
700 1.1 hikaru
701 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
702 1.1 hikaru int octeon_pow_intr_rml_verbose;
703 1.1 hikaru struct evcnt octeon_pow_intr_evcnt;
704 1.1 hikaru
705 1.1 hikaru static const struct octeon_evcnt_entry octeon_pow_intr_evcnt_entries[] = {
706 1.1 hikaru #define _ENTRY(name, type, parent, descr) \
707 1.1 hikaru OCTEON_EVCNT_ENTRY(struct octeon_pow_softc, name, type, parent, descr)
708 1.1 hikaru _ENTRY(powecciopcsrpend, MISC, NULL, "pow csr load"),
709 1.1 hikaru _ENTRY(powecciopdbgpend, MISC, NULL, "pow dbg load"),
710 1.1 hikaru _ENTRY(powecciopaddwork, MISC, NULL, "pow addwork"),
711 1.1 hikaru _ENTRY(powecciopillop, MISC, NULL, "pow ill op"),
712 1.1 hikaru _ENTRY(poweccioppend24, MISC, NULL, "pow pend24"),
713 1.1 hikaru _ENTRY(poweccioppend23, MISC, NULL, "pow pend23"),
714 1.1 hikaru _ENTRY(poweccioppend22, MISC, NULL, "pow pend22"),
715 1.1 hikaru _ENTRY(poweccioppend21, MISC, NULL, "pow pend21"),
716 1.1 hikaru _ENTRY(poweccioptagnull, MISC, NULL, "pow tag null"),
717 1.1 hikaru _ENTRY(poweccioptagnullnull, MISC, NULL, "pow tag nullnull"),
718 1.1 hikaru _ENTRY(powecciopordatom, MISC, NULL, "pow ordered atomic"),
719 1.1 hikaru _ENTRY(powecciopnull, MISC, NULL, "pow core null"),
720 1.1 hikaru _ENTRY(powecciopnullnull, MISC, NULL, "pow core nullnull"),
721 1.1 hikaru _ENTRY(poweccrpe, MISC, NULL, "pow remote-pointer error"),
722 1.1 hikaru _ENTRY(poweccsyn, MISC, NULL, "pow syndrome value"),
723 1.1 hikaru _ENTRY(poweccdbe, MISC, NULL, "pow double bit"),
724 1.1 hikaru _ENTRY(poweccsbe, MISC, NULL, "pow single bit"),
725 1.1 hikaru #undef _ENTRY
726 1.1 hikaru };
727 1.1 hikaru
728 1.1 hikaru void
729 1.1 hikaru octeon_pow_intr_evcnt_attach(struct octeon_pow_softc *sc)
730 1.1 hikaru {
731 1.1 hikaru OCTEON_EVCNT_ATTACH_EVCNTS(sc, octeon_pow_intr_evcnt_entries, "pow0");
732 1.1 hikaru }
733 1.1 hikaru
734 1.1 hikaru void
735 1.1 hikaru octeon_pow_intr_rml(void *arg)
736 1.1 hikaru {
737 1.1 hikaru struct octeon_pow_softc *sc;
738 1.1 hikaru uint64_t reg;
739 1.1 hikaru
740 1.1 hikaru octeon_pow_intr_evcnt.ev_count++;
741 1.1 hikaru sc = __octeon_pow_softc;
742 1.1 hikaru KASSERT(sc != NULL);
743 1.1 hikaru reg = octeon_pow_error_int_summary(sc);
744 1.1 hikaru if (octeon_pow_intr_rml_verbose)
745 1.1 hikaru printf("%s: POW_ECC_ERR=0x%016" PRIx64 "\n", __func__, reg);
746 1.1 hikaru switch (reg & POW_ECC_ERR_IOP) {
747 1.1 hikaru case POW_ECC_ERR_IOP_CSRPEND:
748 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopcsrpend);
749 1.1 hikaru break;
750 1.1 hikaru case POW_ECC_ERR_IOP_DBGPEND:
751 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopdbgpend);
752 1.1 hikaru break;
753 1.1 hikaru case POW_ECC_ERR_IOP_ADDWORK:
754 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopaddwork);
755 1.1 hikaru break;
756 1.1 hikaru case POW_ECC_ERR_IOP_ILLOP:
757 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopillop);
758 1.1 hikaru break;
759 1.1 hikaru case POW_ECC_ERR_IOP_PEND24:
760 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend24);
761 1.1 hikaru break;
762 1.1 hikaru case POW_ECC_ERR_IOP_PEND23:
763 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend23);
764 1.1 hikaru break;
765 1.1 hikaru case POW_ECC_ERR_IOP_PEND22:
766 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend22);
767 1.1 hikaru break;
768 1.1 hikaru case POW_ECC_ERR_IOP_PEND21:
769 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioppend21);
770 1.1 hikaru break;
771 1.1 hikaru case POW_ECC_ERR_IOP_TAGNULL:
772 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioptagnull);
773 1.1 hikaru break;
774 1.1 hikaru case POW_ECC_ERR_IOP_TAGNULLNULL:
775 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccioptagnullnull);
776 1.1 hikaru break;
777 1.1 hikaru case POW_ECC_ERR_IOP_ORDATOM:
778 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopordatom);
779 1.1 hikaru break;
780 1.1 hikaru case POW_ECC_ERR_IOP_NULL:
781 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopnull);
782 1.1 hikaru break;
783 1.1 hikaru case POW_ECC_ERR_IOP_NULLNULL:
784 1.1 hikaru OCTEON_EVCNT_INC(sc, powecciopnullnull);
785 1.1 hikaru break;
786 1.1 hikaru default:
787 1.1 hikaru break;
788 1.1 hikaru }
789 1.1 hikaru if (reg & POW_ECC_ERR_RPE)
790 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccrpe);
791 1.1 hikaru if (reg & POW_ECC_ERR_SYN)
792 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccsyn);
793 1.1 hikaru if (reg & POW_ECC_ERR_DBE)
794 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccdbe);
795 1.1 hikaru if (reg & POW_ECC_ERR_SBE)
796 1.1 hikaru OCTEON_EVCNT_INC(sc, poweccsbe);
797 1.1 hikaru }
798 1.1 hikaru #endif
799 1.1 hikaru
800 1.1 hikaru /* -------------------------------------------------------------------------- */
801 1.1 hikaru
802 1.1 hikaru /* ---- debug dump */
803 1.1 hikaru
804 1.1 hikaru #ifdef OCTEON_ETH_DEBUG
805 1.1 hikaru
806 1.1 hikaru void octeon_pow_dump_reg(void);
807 1.1 hikaru void octeon_pow_dump_ops(void);
808 1.1 hikaru
809 1.1 hikaru void
810 1.1 hikaru octeon_pow_dump(void)
811 1.1 hikaru {
812 1.1 hikaru octeon_pow_dump_reg();
813 1.1 hikaru octeon_pow_dump_ops();
814 1.1 hikaru }
815 1.1 hikaru
816 1.1 hikaru /* ---- register dump */
817 1.1 hikaru
818 1.1 hikaru struct octeon_pow_dump_reg_entry {
819 1.1 hikaru const char *name;
820 1.1 hikaru const char *format;
821 1.1 hikaru size_t offset;
822 1.1 hikaru };
823 1.1 hikaru
824 1.1 hikaru #define _ENTRY(x) { #x, x##_BITS, x##_OFFSET }
825 1.1 hikaru #define _ENTRY_0_7(x) \
826 1.1 hikaru _ENTRY(x## 0), _ENTRY(x## 1), _ENTRY(x## 2), _ENTRY(x## 3), \
827 1.1 hikaru _ENTRY(x## 4), _ENTRY(x## 5), _ENTRY(x## 6), _ENTRY(x## 7)
828 1.1 hikaru #define _ENTRY_0_15(x) \
829 1.1 hikaru _ENTRY(x## 0), _ENTRY(x## 1), _ENTRY(x## 2), _ENTRY(x## 3), \
830 1.1 hikaru _ENTRY(x## 4), _ENTRY(x## 5), _ENTRY(x## 6), _ENTRY(x## 7), \
831 1.1 hikaru _ENTRY(x## 8), _ENTRY(x## 9), _ENTRY(x##10), _ENTRY(x##11), \
832 1.1 hikaru _ENTRY(x##12), _ENTRY(x##13), _ENTRY(x##14), _ENTRY(x##15)
833 1.1 hikaru
834 1.1 hikaru static const struct octeon_pow_dump_reg_entry octeon_pow_dump_reg_entries[] = {
835 1.1 hikaru _ENTRY (POW_PP_GRP_MSK0),
836 1.1 hikaru _ENTRY (POW_PP_GRP_MSK1),
837 1.1 hikaru _ENTRY_0_15 (POW_WQ_INT_THR),
838 1.1 hikaru _ENTRY_0_15 (POW_WQ_INT_CNT),
839 1.1 hikaru _ENTRY_0_7 (POW_QOS_THR),
840 1.1 hikaru _ENTRY_0_7 (POW_QOS_RND),
841 1.1 hikaru _ENTRY (POW_WQ_INT),
842 1.1 hikaru _ENTRY (POW_WQ_INT_PC),
843 1.1 hikaru _ENTRY (POW_NW_TIM),
844 1.1 hikaru _ENTRY (POW_ECC_ERR),
845 1.1 hikaru _ENTRY (POW_NOS_CNT),
846 1.1 hikaru _ENTRY_0_15 (POW_WS_PC),
847 1.1 hikaru _ENTRY_0_7 (POW_WA_PC),
848 1.1 hikaru _ENTRY_0_7 (POW_IQ_CNT),
849 1.1 hikaru _ENTRY (POW_WA_COM_PC),
850 1.1 hikaru _ENTRY (POW_IQ_COM_CNT),
851 1.1 hikaru _ENTRY (POW_TS_PC),
852 1.1 hikaru _ENTRY (POW_DS_PC),
853 1.1 hikaru _ENTRY (POW_BIST_STAT)
854 1.1 hikaru };
855 1.1 hikaru
856 1.1 hikaru #undef _ENTRY
857 1.1 hikaru
858 1.1 hikaru void
859 1.1 hikaru octeon_pow_dump_reg(void)
860 1.1 hikaru {
861 1.1 hikaru struct octeon_pow_softc *sc = __octeon_pow_softc;
862 1.1 hikaru const struct octeon_pow_dump_reg_entry *entry;
863 1.1 hikaru uint64_t tmp;
864 1.1 hikaru char buf[512];
865 1.1 hikaru int i;
866 1.1 hikaru
867 1.1 hikaru for (i = 0; i < (int)__arraycount(octeon_pow_dump_reg_entries); i++) {
868 1.1 hikaru entry = &octeon_pow_dump_reg_entries[i];
869 1.1 hikaru tmp = _POW_RD8(sc, entry->offset);
870 1.1 hikaru if (entry->format == NULL)
871 1.1 hikaru snprintf(buf, sizeof(buf), "%16" PRIx64, tmp);
872 1.1 hikaru else
873 1.1 hikaru snprintb(buf, sizeof(buf), entry->format, tmp);
874 1.1 hikaru printf("\t%-24s: %s\n", entry->name, buf);
875 1.1 hikaru }
876 1.1 hikaru }
877 1.1 hikaru
878 1.1 hikaru /* ---- operations dump */
879 1.1 hikaru
880 1.1 hikaru struct octeon_pow_dump_ops_entry {
881 1.1 hikaru const char *name;
882 1.1 hikaru const char *format;
883 1.1 hikaru uint64_t (*func)(int);
884 1.1 hikaru };
885 1.1 hikaru
886 1.1 hikaru void octeon_pow_dump_ops_coreid(int);
887 1.1 hikaru void octeon_pow_dump_ops_index(int);
888 1.1 hikaru void octeon_pow_dump_ops_qos(int);
889 1.1 hikaru void octeon_pow_dump_ops_grp(int);
890 1.1 hikaru void octeon_pow_dump_ops_queue(int);
891 1.1 hikaru void octeon_pow_dump_ops_common(const struct
892 1.1 hikaru octeon_pow_dump_ops_entry *, size_t, const char *,
893 1.1 hikaru int);
894 1.1 hikaru
895 1.1 hikaru #define _ENTRY_COMMON(name, prefix, x, y) \
896 1.1 hikaru { #name "_" #x, prefix##_##y##_BITS, octeon_pow_status_by_##name##_##x }
897 1.1 hikaru
898 1.1 hikaru const struct octeon_pow_dump_ops_entry octeon_pow_dump_ops_coreid_entries[] = {
899 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(coreid, POW_STATUS_LOAD_RESULT, x, y)
900 1.1 hikaru _ENTRY(pend_tag, PEND_TAG),
901 1.1 hikaru _ENTRY(pend_wqp, PEND_WQP),
902 1.1 hikaru _ENTRY(cur_tag_next, CUR_TAG_NEXT),
903 1.1 hikaru _ENTRY(cur_tag_prev, CUR_TAG_PREV),
904 1.1 hikaru _ENTRY(cur_wqp_next, CUR_WQP_NEXT),
905 1.1 hikaru _ENTRY(cur_wqp_prev, CUR_WQP_PREV)
906 1.1 hikaru #undef _ENTRY
907 1.1 hikaru };
908 1.1 hikaru
909 1.1 hikaru const struct octeon_pow_dump_ops_entry octeon_pow_dump_ops_index_entries[] = {
910 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(index, POW_MEMORY_LOAD_RESULT, x, y)
911 1.1 hikaru _ENTRY(tag, TAG),
912 1.1 hikaru _ENTRY(wqp, WQP),
913 1.1 hikaru _ENTRY(desched, DESCHED)
914 1.1 hikaru #undef _ENTRY
915 1.1 hikaru };
916 1.1 hikaru
917 1.1 hikaru const struct octeon_pow_dump_ops_entry octeon_pow_dump_ops_qos_entries[] = {
918 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(qos, POW_IDXPTR_LOAD_RESULT_QOS, x, y)
919 1.1 hikaru _ENTRY(free_loc, FREE_LOC)
920 1.1 hikaru #undef _ENTRY
921 1.1 hikaru };
922 1.1 hikaru
923 1.1 hikaru const struct octeon_pow_dump_ops_entry octeon_pow_dump_ops_grp_entries[] = {
924 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(grp, POW_IDXPTR_LOAD_RESULT_GRP, x, y)
925 1.1 hikaru _ENTRY(nosched_des, NOSCHED_DES)
926 1.1 hikaru #undef _ENTRY
927 1.1 hikaru };
928 1.1 hikaru
929 1.1 hikaru const struct octeon_pow_dump_ops_entry octeon_pow_dump_ops_queue_entries[] = {
930 1.1 hikaru #define _ENTRY(x, y) _ENTRY_COMMON(queue, POW_IDXPTR_LOAD_RESULT_QUEUE, x, y)
931 1.1 hikaru _ENTRY(remote_head, REMOTE_HEAD),
932 1.1 hikaru _ENTRY(remote_tail, REMOTE_TAIL)
933 1.1 hikaru #undef _ENTRY
934 1.1 hikaru };
935 1.1 hikaru
936 1.1 hikaru void
937 1.1 hikaru octeon_pow_dump_ops(void)
938 1.1 hikaru {
939 1.1 hikaru int i;
940 1.1 hikaru
941 1.1 hikaru /* XXX */
942 1.1 hikaru for (i = 0; i < 2/* XXX */; i++)
943 1.1 hikaru octeon_pow_dump_ops_coreid(i);
944 1.1 hikaru
945 1.1 hikaru /* XXX */
946 1.1 hikaru octeon_pow_dump_ops_index(0);
947 1.1 hikaru
948 1.1 hikaru for (i = 0; i < 8; i++)
949 1.1 hikaru octeon_pow_dump_ops_qos(i);
950 1.1 hikaru
951 1.1 hikaru for (i = 0; i < 16; i++)
952 1.1 hikaru octeon_pow_dump_ops_grp(i);
953 1.1 hikaru
954 1.1 hikaru for (i = 0; i < 16; i++)
955 1.1 hikaru octeon_pow_dump_ops_queue(i);
956 1.1 hikaru }
957 1.1 hikaru
958 1.1 hikaru void
959 1.1 hikaru octeon_pow_dump_ops_coreid(int coreid)
960 1.1 hikaru {
961 1.1 hikaru octeon_pow_dump_ops_common(octeon_pow_dump_ops_coreid_entries,
962 1.1 hikaru __arraycount(octeon_pow_dump_ops_coreid_entries), "coreid", coreid);
963 1.1 hikaru }
964 1.1 hikaru
965 1.1 hikaru void
966 1.1 hikaru octeon_pow_dump_ops_index(int index)
967 1.1 hikaru {
968 1.1 hikaru octeon_pow_dump_ops_common(octeon_pow_dump_ops_index_entries,
969 1.1 hikaru __arraycount(octeon_pow_dump_ops_index_entries), "index", index);
970 1.1 hikaru }
971 1.1 hikaru
972 1.1 hikaru void
973 1.1 hikaru octeon_pow_dump_ops_qos(int qos)
974 1.1 hikaru {
975 1.1 hikaru octeon_pow_dump_ops_common(octeon_pow_dump_ops_qos_entries,
976 1.1 hikaru __arraycount(octeon_pow_dump_ops_qos_entries), "qos", qos);
977 1.1 hikaru }
978 1.1 hikaru
979 1.1 hikaru void
980 1.1 hikaru octeon_pow_dump_ops_grp(int grp)
981 1.1 hikaru {
982 1.1 hikaru octeon_pow_dump_ops_common(octeon_pow_dump_ops_grp_entries,
983 1.1 hikaru __arraycount(octeon_pow_dump_ops_grp_entries), "grp", grp);
984 1.1 hikaru }
985 1.1 hikaru
986 1.1 hikaru void
987 1.1 hikaru octeon_pow_dump_ops_queue(int queue)
988 1.1 hikaru {
989 1.1 hikaru octeon_pow_dump_ops_common(octeon_pow_dump_ops_queue_entries,
990 1.1 hikaru __arraycount(octeon_pow_dump_ops_queue_entries), "queue", queue);
991 1.1 hikaru }
992 1.1 hikaru
993 1.1 hikaru void
994 1.1 hikaru octeon_pow_dump_ops_common(const struct octeon_pow_dump_ops_entry *entries,
995 1.1 hikaru size_t nentries, const char *by_what, int arg)
996 1.1 hikaru {
997 1.1 hikaru const struct octeon_pow_dump_ops_entry *entry;
998 1.1 hikaru uint64_t tmp;
999 1.1 hikaru char buf[512];
1000 1.1 hikaru int i;
1001 1.1 hikaru
1002 1.1 hikaru printf("%s=%d\n", by_what, arg);
1003 1.1 hikaru for (i = 0; i < (int)nentries; i++) {
1004 1.1 hikaru entry = &entries[i];
1005 1.1 hikaru tmp = (*entry->func)(arg);
1006 1.1 hikaru if (entry->format == NULL)
1007 1.1 hikaru snprintf(buf, sizeof(buf), "%16" PRIx64, tmp);
1008 1.1 hikaru else
1009 1.1 hikaru snprintb(buf, sizeof(buf), entry->format, tmp);
1010 1.1 hikaru printf("\t%-24s: %s\n", entry->name, buf);
1011 1.1 hikaru }
1012 1.1 hikaru }
1013 1.1 hikaru
1014 1.1 hikaru #endif
1015 1.1 hikaru
1016 1.1 hikaru /* -------------------------------------------------------------------------- */
1017 1.1 hikaru
1018 1.1 hikaru /* ---- test */
1019 1.1 hikaru
1020 1.1 hikaru #ifdef OCTEON_POW_TEST
1021 1.1 hikaru /*
1022 1.1 hikaru * Standalone test entries; meant to be called from ddb.
1023 1.1 hikaru */
1024 1.1 hikaru
1025 1.1 hikaru void octeon_pow_test(void);
1026 1.1 hikaru void octeon_pow_test_dump_wqe(paddr_t);
1027 1.1 hikaru
1028 1.1 hikaru static void octeon_pow_test_1(void);
1029 1.1 hikaru
1030 1.1 hikaru struct test_wqe {
1031 1.1 hikaru uint64_t word0;
1032 1.1 hikaru uint64_t word1;
1033 1.1 hikaru uint64_t word2;
1034 1.1 hikaru uint64_t word3;
1035 1.1 hikaru } __packed;
1036 1.1 hikaru struct test_wqe test_wqe;
1037 1.1 hikaru
1038 1.1 hikaru void
1039 1.1 hikaru octeon_pow_test(void)
1040 1.1 hikaru {
1041 1.1 hikaru octeon_pow_test_1();
1042 1.1 hikaru }
1043 1.1 hikaru
1044 1.1 hikaru static void
1045 1.1 hikaru octeon_pow_test_1(void)
1046 1.1 hikaru {
1047 1.1 hikaru struct test_wqe *wqe = &test_wqe;
1048 1.1 hikaru int qos, grp, queue, tt;
1049 1.1 hikaru uint32_t tag;
1050 1.1 hikaru paddr_t ptr;
1051 1.1 hikaru
1052 1.1 hikaru qos = 7; /* XXX */
1053 1.1 hikaru grp = queue = 15; /* XXX */
1054 1.1 hikaru tt = POW_TAG_TYPE_ORDERED; /* XXX */
1055 1.1 hikaru tag = UINT32_C(0x01234567); /* XXX */
1056 1.1 hikaru
1057 1.1 hikaru /* => make sure that the queue is empty */
1058 1.1 hikaru
1059 1.1 hikaru octeon_pow_dump_ops_qos(qos);
1060 1.1 hikaru octeon_pow_dump_ops_grp(grp);
1061 1.1 hikaru printf("\n");
1062 1.1 hikaru
1063 1.1 hikaru /*
1064 1.1 hikaru * Initialize WQE.
1065 1.1 hikaru *
1066 1.1 hikaru * word0:next is used by hardware.
1067 1.1 hikaru *
1068 1.1 hikaru * word1:qos, word1:grp, word1:tt, word1:tag must match with arguments
1069 1.1 hikaru * of the following ADDWQ transaction.
1070 1.1 hikaru */
1071 1.1 hikaru
1072 1.1 hikaru (void)memset(wqe, 0, sizeof(*wqe));
1073 1.1 hikaru wqe->word0 =
1074 1.1 hikaru __BITS64_SET(POW_WQE_WORD0_NEXT, 0);
1075 1.1 hikaru wqe->word1 =
1076 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_QOS, qos) |
1077 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_GRP, grp) |
1078 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_TT, tt) |
1079 1.1 hikaru __BITS64_SET(POW_WQE_WORD1_TAG, tag);
1080 1.1 hikaru
1081 1.1 hikaru printf("calling ADDWQ\n");
1082 1.1 hikaru octeon_pow_ops_addwq(MIPS_KSEG0_TO_PHYS(wqe), qos, grp, tt, tag);
1083 1.1 hikaru
1084 1.1 hikaru octeon_pow_dump_ops_qos(qos);
1085 1.1 hikaru octeon_pow_dump_ops_grp(grp);
1086 1.1 hikaru printf("\n");
1087 1.1 hikaru
1088 1.1 hikaru /* => make sure that a WQE is added to the queue */
1089 1.1 hikaru
1090 1.1 hikaru printf("calling GET_WORK_LOAD\n");
1091 1.1 hikaru ptr = octeon_pow_ops_get_work_load(0);
1092 1.1 hikaru
1093 1.1 hikaru octeon_pow_dump_ops_qos(qos);
1094 1.1 hikaru octeon_pow_dump_ops_grp(grp);
1095 1.1 hikaru printf("\n");
1096 1.1 hikaru
1097 1.1 hikaru octeon_pow_test_dump_wqe(ptr);
1098 1.1 hikaru
1099 1.1 hikaru /* => make sure that the WQE is in-flight (and scheduled) */
1100 1.1 hikaru
1101 1.1 hikaru printf("calling SWTAG(NULL)\n");
1102 1.1 hikaru octeon_pow_ops_swtag(POW_TAG_TYPE_NULL, tag);
1103 1.1 hikaru
1104 1.1 hikaru octeon_pow_dump_ops_qos(qos);
1105 1.1 hikaru octeon_pow_dump_ops_grp(grp);
1106 1.1 hikaru printf("\n");
1107 1.1 hikaru
1108 1.1 hikaru /* => make sure that the WQE is un-scheduled (completed) */
1109 1.1 hikaru }
1110 1.1 hikaru
1111 1.1 hikaru void
1112 1.1 hikaru octeon_pow_test_dump_wqe(paddr_t ptr)
1113 1.1 hikaru {
1114 1.1 hikaru uint64_t word0, word1;
1115 1.1 hikaru char buf[128];
1116 1.1 hikaru
1117 1.1 hikaru printf("wqe\n");
1118 1.1 hikaru
1119 1.1 hikaru word0 = *(uint64_t *)MIPS_PHYS_TO_XKPHYS_CACHED(ptr);
1120 1.1 hikaru snprintb(buf, sizeof(buf), POW_WQE_WORD0_BITS, word0);
1121 1.1 hikaru printf("\t%-24s: %s\n", "word0", buf);
1122 1.1 hikaru
1123 1.1 hikaru word1 = *(uint64_t *)MIPS_PHYS_TO_XKPHYS_CACHED(ptr + 8);
1124 1.1 hikaru snprintb(buf, sizeof(buf), POW_WQE_WORD1_BITS, word1);
1125 1.1 hikaru printf("\t%-24s: %s\n", "word1", buf);
1126 1.1 hikaru }
1127 1.1 hikaru #endif
1128