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