Home | History | Annotate | Line # | Download | only in dev
octeon_pip.c revision 1.6
      1  1.6   simonb /*	$NetBSD: octeon_pip.c,v 1.6 2020/06/22 02:26:20 simonb Exp $	*/
      2  1.1   hikaru 
      3  1.1   hikaru /*
      4  1.1   hikaru  * Copyright (c) 2007 Internet Initiative Japan, Inc.
      5  1.1   hikaru  * All rights reserved.
      6  1.1   hikaru  *
      7  1.1   hikaru  * Redistribution and use in source and binary forms, with or without
      8  1.1   hikaru  * modification, are permitted provided that the following conditions
      9  1.1   hikaru  * are met:
     10  1.1   hikaru  * 1. Redistributions of source code must retain the above copyright
     11  1.1   hikaru  *    notice, this list of conditions and the following disclaimer.
     12  1.1   hikaru  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1   hikaru  *    notice, this list of conditions and the following disclaimer in the
     14  1.1   hikaru  *    documentation and/or other materials provided with the distribution.
     15  1.1   hikaru  *
     16  1.1   hikaru  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     17  1.1   hikaru  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     18  1.1   hikaru  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     19  1.1   hikaru  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     20  1.1   hikaru  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     21  1.1   hikaru  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     22  1.1   hikaru  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     23  1.1   hikaru  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     24  1.1   hikaru  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     25  1.1   hikaru  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     26  1.1   hikaru  * SUCH DAMAGE.
     27  1.1   hikaru  */
     28  1.1   hikaru 
     29  1.1   hikaru #include <sys/cdefs.h>
     30  1.6   simonb __KERNEL_RCSID(0, "$NetBSD: octeon_pip.c,v 1.6 2020/06/22 02:26:20 simonb Exp $");
     31  1.1   hikaru 
     32  1.1   hikaru #include "opt_octeon.h"
     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/malloc.h>
     37  1.1   hikaru #include <sys/syslog.h>
     38  1.1   hikaru #include <sys/time.h>
     39  1.1   hikaru #include <net/if.h>
     40  1.1   hikaru #include <mips/locore.h>
     41  1.1   hikaru #include <mips/cavium/octeonvar.h>
     42  1.1   hikaru #include <mips/cavium/dev/octeon_pipreg.h>
     43  1.1   hikaru #include <mips/cavium/dev/octeon_pipvar.h>
     44  1.1   hikaru 
     45  1.1   hikaru /*
     46  1.1   hikaru  * register definitions (for debug and statics)
     47  1.1   hikaru  */
     48  1.1   hikaru #define	_ENTRY(x)	{ #x, x##_BITS, x##_OFFSET }
     49  1.1   hikaru #define	_ENTRY_0_3(x) \
     50  1.1   hikaru 	_ENTRY(x## 0), _ENTRY(x## 1), _ENTRY(x## 2), _ENTRY(x## 3)
     51  1.1   hikaru #define	_ENTRY_0_7(x) \
     52  1.1   hikaru 	_ENTRY(x## 0), _ENTRY(x## 1), _ENTRY(x## 2), _ENTRY(x## 3), \
     53  1.1   hikaru 	_ENTRY(x## 4), _ENTRY(x## 5), _ENTRY(x## 6), _ENTRY(x## 7)
     54  1.1   hikaru #define	_ENTRY_0_1_2_32(x) \
     55  1.1   hikaru 	_ENTRY(x## 0), _ENTRY(x## 1), _ENTRY(x## 2), _ENTRY(x##32)
     56  1.1   hikaru 
     57  1.4   simonb struct octpip_dump_reg_ {
     58  1.1   hikaru 	const char *name;
     59  1.1   hikaru 	const char *format;
     60  1.1   hikaru 	size_t	offset;
     61  1.1   hikaru };
     62  1.1   hikaru 
     63  1.4   simonb static const struct octpip_dump_reg_ octpip_dump_stats_[] = {
     64  1.1   hikaru /* PIP_QOS_DIFF[0-63] */
     65  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT0_PRT),
     66  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT1_PRT),
     67  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT2_PRT),
     68  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT3_PRT),
     69  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT4_PRT),
     70  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT5_PRT),
     71  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT6_PRT),
     72  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT7_PRT),
     73  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT8_PRT),
     74  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT9_PRT),
     75  1.1   hikaru /* PIP_TAG_INC[0-63] */
     76  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT_INB_PKTS),
     77  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT_INB_OCTS),
     78  1.1   hikaru 	_ENTRY_0_1_2_32	(PIP_STAT_INB_ERRS),
     79  1.1   hikaru };
     80  1.1   hikaru 
     81  1.1   hikaru #undef	_ENTRY
     82  1.1   hikaru #undef	_ENTRY_0_3
     83  1.1   hikaru #undef	_ENTRY_0_7
     84  1.1   hikaru #undef	_ENTRY_0_1_2_32
     85  1.1   hikaru 
     86  1.1   hikaru /* XXX */
     87  1.1   hikaru void
     88  1.4   simonb octpip_init(struct octpip_attach_args *aa, struct octpip_softc **rsc)
     89  1.1   hikaru {
     90  1.4   simonb 	struct octpip_softc *sc;
     91  1.1   hikaru 	int status;
     92  1.1   hikaru 
     93  1.1   hikaru 	sc = malloc(sizeof(*sc), M_DEVBUF, M_WAITOK | M_ZERO);
     94  1.1   hikaru 	if (sc == NULL)
     95  1.1   hikaru 		panic("can't allocate memory: %s", __func__);
     96  1.1   hikaru 
     97  1.1   hikaru 	sc->sc_port = aa->aa_port;
     98  1.1   hikaru 	sc->sc_regt = aa->aa_regt;
     99  1.1   hikaru 	sc->sc_tag_type = aa->aa_tag_type;
    100  1.1   hikaru 	sc->sc_receive_group = aa->aa_receive_group;
    101  1.1   hikaru 	sc->sc_ip_offset = aa->aa_ip_offset;
    102  1.1   hikaru 
    103  1.1   hikaru 	status = bus_space_map(sc->sc_regt, PIP_BASE, PIP_SIZE, 0,
    104  1.1   hikaru 	    &sc->sc_regh);
    105  1.1   hikaru 	if (status != 0)
    106  1.1   hikaru 		panic("can't map %s space", "pip register");
    107  1.1   hikaru 
    108  1.1   hikaru 	*rsc = sc;
    109  1.1   hikaru }
    110  1.1   hikaru 
    111  1.1   hikaru #define	_PIP_RD8(sc, off) \
    112  1.1   hikaru 	bus_space_read_8((sc)->sc_regt, (sc)->sc_regh, (off))
    113  1.1   hikaru #define	_PIP_WR8(sc, off, v) \
    114  1.1   hikaru 	bus_space_write_8((sc)->sc_regt, (sc)->sc_regh, (off), (v))
    115  1.1   hikaru 
    116  1.1   hikaru int
    117  1.4   simonb octpip_port_config(struct octpip_softc *sc)
    118  1.1   hikaru {
    119  1.1   hikaru 	uint64_t prt_cfg;
    120  1.1   hikaru 	uint64_t prt_tag;
    121  1.1   hikaru 	uint64_t ip_offset;
    122  1.1   hikaru 
    123  1.1   hikaru 	/*
    124  1.1   hikaru 	 * Process the headers and place the IP header in the work queue
    125  1.1   hikaru 	 */
    126  1.1   hikaru 	prt_cfg = 0;
    127  1.1   hikaru 	if (MIPS_PRID_IMPL(mips_options.mips_cpu_id) == MIPS_CN50XX) {
    128  1.1   hikaru 		SET(prt_cfg, PIP_PRT_CFGN_LENERR_EN);
    129  1.1   hikaru 		SET(prt_cfg, PIP_PRT_CFGN_MAXERR_EN);
    130  1.1   hikaru 		SET(prt_cfg, PIP_PRT_CFGN_MINERR_EN);
    131  1.1   hikaru 	}
    132  1.1   hikaru 	/* RAWDRP=0; don't allow raw packet drop */
    133  1.1   hikaru 	/* TAGINC=0 */
    134  1.1   hikaru 	SET(prt_cfg, PIP_PRT_CFGN_DYN_RS);
    135  1.1   hikaru 	/* INST_HDR=0 */
    136  1.1   hikaru 	/* GRP_WAT=0 */
    137  1.1   hikaru 	SET(prt_cfg, (sc->sc_port << 24) & PIP_PRT_CFGN_QOS);
    138  1.1   hikaru 	/* QOS_WAT=0 */
    139  1.1   hikaru 	/* SPARE=0 */
    140  1.1   hikaru 	/* QOS_DIFF=0 */
    141  1.1   hikaru 	/* QOS_VLAN=0 */
    142  1.1   hikaru 	SET(prt_cfg, PIP_PRT_CFGN_CRC_EN);
    143  1.1   hikaru 	/* SKIP=0 */
    144  1.1   hikaru 
    145  1.1   hikaru 	prt_tag = 0;
    146  1.1   hikaru 	SET(prt_tag, PIP_PRT_TAGN_INC_PRT);
    147  1.1   hikaru 	CLR(prt_tag, PIP_PRT_TAGN_IP6_DPRT);
    148  1.1   hikaru 	CLR(prt_tag, PIP_PRT_TAGN_IP4_DPRT);
    149  1.1   hikaru 	CLR(prt_tag, PIP_PRT_TAGN_IP6_SPRT);
    150  1.1   hikaru 	CLR(prt_tag, PIP_PRT_TAGN_IP4_SPRT);
    151  1.1   hikaru 	CLR(prt_tag, PIP_PRT_TAGN_IP6_NXTH);
    152  1.1   hikaru 	CLR(prt_tag, PIP_PRT_TAGN_IP4_PCTL);
    153  1.1   hikaru 	CLR(prt_tag, PIP_PRT_TAGN_IP6_DST);
    154  1.1   hikaru 	CLR(prt_tag, PIP_PRT_TAGN_IP4_SRC);
    155  1.1   hikaru 	CLR(prt_tag, PIP_PRT_TAGN_IP6_SRC);
    156  1.1   hikaru 	CLR(prt_tag, PIP_PRT_TAGN_IP4_DST);
    157  1.5   simonb 	SET(prt_tag, __SHIFTIN(PIP_PRT_TAGN_TCP6_TAG_ORDERED, PIP_PRT_TAGN_TCP6_TAG));
    158  1.5   simonb 	SET(prt_tag, __SHIFTIN(PIP_PRT_TAGN_TCP4_TAG_ORDERED, PIP_PRT_TAGN_TCP4_TAG));
    159  1.5   simonb 	SET(prt_tag, __SHIFTIN(PIP_PRT_TAGN_IP6_TAG_ORDERED, PIP_PRT_TAGN_IP6_TAG));
    160  1.5   simonb 	SET(prt_tag, __SHIFTIN(PIP_PRT_TAGN_IP4_TAG_ORDERED, PIP_PRT_TAGN_IP4_TAG));
    161  1.5   simonb 	SET(prt_tag, __SHIFTIN(PIP_PRT_TAGN_NON_TAG_ORDERED, PIP_PRT_TAGN_NON_TAG));
    162  1.1   hikaru 	SET(prt_tag, sc->sc_receive_group & PIP_PRT_TAGN_GRP);
    163  1.1   hikaru 
    164  1.1   hikaru 	ip_offset = 0;
    165  1.1   hikaru 	SET(ip_offset, (sc->sc_ip_offset / 8) & PIP_IP_OFFSET_MASK_OFFSET);
    166  1.1   hikaru 
    167  1.1   hikaru 	_PIP_WR8(sc, PIP_PRT_CFG0_OFFSET + (8 * sc->sc_port), prt_cfg);
    168  1.1   hikaru 	_PIP_WR8(sc, PIP_PRT_TAG0_OFFSET + (8 * sc->sc_port), prt_tag);
    169  1.1   hikaru 	_PIP_WR8(sc, PIP_IP_OFFSET_OFFSET, ip_offset);
    170  1.1   hikaru 
    171  1.1   hikaru 	return 0;
    172  1.1   hikaru }
    173  1.1   hikaru 
    174  1.1   hikaru void
    175  1.4   simonb octpip_prt_cfg_enable(struct octpip_softc *sc, uint64_t prt_cfg, int enable)
    176  1.1   hikaru {
    177  1.1   hikaru 	uint64_t tmp;
    178  1.1   hikaru 
    179  1.1   hikaru 	tmp = _PIP_RD8(sc, PIP_PRT_CFG0_OFFSET + (8 * sc->sc_port));
    180  1.1   hikaru 	if (enable)
    181  1.1   hikaru 		tmp |= prt_cfg;
    182  1.1   hikaru 	else
    183  1.1   hikaru 		tmp &= ~prt_cfg;
    184  1.1   hikaru 	_PIP_WR8(sc, PIP_PRT_CFG0_OFFSET + (8 * sc->sc_port), tmp);
    185  1.1   hikaru }
    186  1.1   hikaru 
    187  1.1   hikaru void
    188  1.4   simonb octpip_stats(struct octpip_softc *sc, struct ifnet *ifp, int gmx_port)
    189  1.1   hikaru {
    190  1.4   simonb 	const struct octpip_dump_reg_ *reg;
    191  1.1   hikaru 	uint64_t tmp, pkts;
    192  1.1   hikaru 	uint64_t pip_stat_ctl;
    193  1.1   hikaru 
    194  1.1   hikaru 	if (sc == NULL || ifp == NULL)
    195  1.1   hikaru 		panic("%s: invalid argument. sc=%p, ifp=%p\n", __func__,
    196  1.1   hikaru 			sc, ifp);
    197  1.1   hikaru 
    198  1.1   hikaru 	if (gmx_port < 0 || gmx_port > 2) {
    199  1.1   hikaru 		printf("%s: invalid gmx_port %d\n", __func__, gmx_port);
    200  1.1   hikaru 		return;
    201  1.1   hikaru 	}
    202  1.1   hikaru 
    203  1.1   hikaru 	pip_stat_ctl = _PIP_RD8(sc, PIP_STAT_CTL_OFFSET);
    204  1.1   hikaru 	_PIP_WR8(sc, PIP_STAT_CTL_OFFSET, pip_stat_ctl | PIP_STAT_CTL_RDCLR);
    205  1.4   simonb 	reg = &octpip_dump_stats_[gmx_port];
    206  1.1   hikaru 	tmp = _PIP_RD8(sc, reg->offset);
    207  1.5   simonb 	pkts = __SHIFTOUT(tmp, PIP_STAT0_PRTN_DRP_PKTS);
    208  1.3  thorpej 	if_statadd(ifp, if_iqdrops, pkts);
    209  1.1   hikaru 
    210  1.1   hikaru 	_PIP_WR8(sc, PIP_STAT_CTL_OFFSET, pip_stat_ctl);
    211  1.1   hikaru }
    212