Home | History | Annotate | Line # | Download | only in dev
octeon_fpa.c revision 1.9
      1  1.9  thorpej /*	$NetBSD: octeon_fpa.c,v 1.9 2021/01/04 17:22:59 thorpej 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 #undef	FPADEBUG
     30  1.1   hikaru 
     31  1.1   hikaru #include <sys/cdefs.h>
     32  1.9  thorpej __KERNEL_RCSID(0, "$NetBSD: octeon_fpa.c,v 1.9 2021/01/04 17:22:59 thorpej Exp $");
     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.9  thorpej #include <sys/kmem.h>
     38  1.1   hikaru 
     39  1.1   hikaru #include <sys/bus.h>
     40  1.1   hikaru #include <machine/locore.h>
     41  1.1   hikaru #include <machine/vmparam.h>
     42  1.1   hikaru 
     43  1.1   hikaru #include <mips/cavium/octeonvar.h>
     44  1.1   hikaru #include <mips/cavium/include/iobusvar.h>
     45  1.6   simonb #include <mips/cavium/dev/octeon_fpareg.h>
     46  1.1   hikaru #include <mips/cavium/dev/octeon_fpavar.h>
     47  1.1   hikaru 
     48  1.1   hikaru #ifdef FPADEBUG
     49  1.1   hikaru #define	DPRINTF(x)	printf x
     50  1.1   hikaru #else
     51  1.1   hikaru #define	DPRINTF(x)
     52  1.1   hikaru #endif
     53  1.1   hikaru 
     54  1.1   hikaru #define	_DMA_NSEGS	1
     55  1.1   hikaru #define	_DMA_BUFLEN	0x01000000
     56  1.1   hikaru 
     57  1.1   hikaru /* pool descriptor */
     58  1.5   simonb struct octfpa_desc {
     59  1.1   hikaru };
     60  1.1   hikaru 
     61  1.5   simonb struct octfpa_softc {
     62  1.1   hikaru 	int			sc_initialized;
     63  1.1   hikaru 
     64  1.1   hikaru 	bus_space_tag_t		sc_regt;
     65  1.1   hikaru 	bus_space_handle_t	sc_regh;
     66  1.1   hikaru 
     67  1.1   hikaru 	bus_space_tag_t		sc_opst;
     68  1.1   hikaru 	bus_space_handle_t	sc_opsh;
     69  1.1   hikaru 
     70  1.1   hikaru 	bus_dma_tag_t		sc_dmat;
     71  1.1   hikaru 
     72  1.5   simonb 	struct octfpa_desc	sc_descs[8];
     73  1.1   hikaru };
     74  1.1   hikaru 
     75  1.5   simonb void			octfpa_bootstrap(struct octeon_config *);
     76  1.5   simonb void			octfpa_reset(void);
     77  1.5   simonb void			octfpa_int_enable(struct octfpa_softc *, int);
     78  1.5   simonb void			octfpa_buf_dma_alloc(struct octfpa_buf *);
     79  1.1   hikaru 
     80  1.5   simonb static void		octfpa_init(struct octfpa_softc *);
     81  1.1   hikaru #ifdef notyet
     82  1.5   simonb static uint64_t		octfpa_iobdma(struct octfpa_softc *, int, int);
     83  1.1   hikaru #endif
     84  1.1   hikaru 
     85  1.5   simonb static struct octfpa_softc	octfpa_softc;
     86  1.1   hikaru 
     87  1.1   hikaru /* ---- global functions */
     88  1.1   hikaru 
     89  1.1   hikaru void
     90  1.5   simonb octfpa_bootstrap(struct octeon_config *mcp)
     91  1.1   hikaru {
     92  1.5   simonb 	struct octfpa_softc *sc = &octfpa_softc;
     93  1.1   hikaru 
     94  1.1   hikaru 	sc->sc_regt = &mcp->mc_iobus_bust;
     95  1.1   hikaru 	sc->sc_opst = &mcp->mc_iobus_bust;
     96  1.1   hikaru 	sc->sc_dmat = &mcp->mc_iobus_dmat;
     97  1.1   hikaru 
     98  1.5   simonb 	octfpa_init(sc);
     99  1.1   hikaru }
    100  1.1   hikaru 
    101  1.1   hikaru void
    102  1.5   simonb octfpa_reset(void)
    103  1.1   hikaru {
    104  1.1   hikaru 	/* XXX */
    105  1.1   hikaru }
    106  1.1   hikaru 
    107  1.1   hikaru int
    108  1.5   simonb octfpa_buf_init(int poolno, size_t size, size_t nelems, struct octfpa_buf **rfb)
    109  1.1   hikaru {
    110  1.5   simonb 	struct octfpa_softc *sc = &octfpa_softc;
    111  1.5   simonb 	struct octfpa_buf *fb;
    112  1.1   hikaru 	int nsegs;
    113  1.1   hikaru 	paddr_t paddr;
    114  1.1   hikaru 
    115  1.1   hikaru 	nsegs = 1/* XXX */;
    116  1.9  thorpej 	fb = kmem_zalloc(sizeof(*fb) + sizeof(*fb->fb_dma_segs) * nsegs,
    117  1.9  thorpej 	    KM_SLEEP);
    118  1.1   hikaru 	fb->fb_poolno = poolno;
    119  1.1   hikaru 	fb->fb_size = size;
    120  1.1   hikaru 	fb->fb_nelems = nelems;
    121  1.1   hikaru 	fb->fb_len = size * nelems;
    122  1.1   hikaru 	fb->fb_dmat = sc->sc_dmat;
    123  1.1   hikaru 	fb->fb_dma_segs = (void *)(fb + 1);
    124  1.1   hikaru 	fb->fb_dma_nsegs = nsegs;
    125  1.1   hikaru 
    126  1.5   simonb 	octfpa_buf_dma_alloc(fb);
    127  1.1   hikaru 
    128  1.1   hikaru 	for (paddr = fb->fb_paddr; paddr < fb->fb_paddr + fb->fb_len;
    129  1.1   hikaru 	    paddr += fb->fb_size)
    130  1.5   simonb 		octfpa_buf_put_paddr(fb, paddr);
    131  1.1   hikaru 
    132  1.1   hikaru 	*rfb = fb;
    133  1.1   hikaru 
    134  1.1   hikaru 	return 0;
    135  1.1   hikaru }
    136  1.1   hikaru 
    137  1.1   hikaru void *
    138  1.5   simonb octfpa_buf_get(struct octfpa_buf *fb)
    139  1.1   hikaru {
    140  1.1   hikaru 	paddr_t paddr;
    141  1.1   hikaru 	vaddr_t addr;
    142  1.1   hikaru 
    143  1.5   simonb 	paddr = octfpa_buf_get_paddr(fb);
    144  1.1   hikaru 	if (paddr == 0)
    145  1.1   hikaru 		addr = 0;
    146  1.1   hikaru 	else
    147  1.1   hikaru 		addr = fb->fb_addr + (vaddr_t/* XXX */)(paddr - fb->fb_paddr);
    148  1.1   hikaru 	return (void *)addr;
    149  1.1   hikaru }
    150  1.1   hikaru 
    151  1.1   hikaru void
    152  1.5   simonb octfpa_buf_dma_alloc(struct octfpa_buf *fb)
    153  1.1   hikaru {
    154  1.1   hikaru 	int status;
    155  1.1   hikaru 	int nsegs;
    156  1.1   hikaru 	void *va;
    157  1.1   hikaru 
    158  1.1   hikaru 	status = bus_dmamap_create(fb->fb_dmat, fb->fb_len,
    159  1.1   hikaru 	    fb->fb_len / PAGE_SIZE,	/* # of segments */
    160  1.1   hikaru 	    fb->fb_len,			/* we don't use s/g for FPA buf */
    161  1.1   hikaru 	    PAGE_SIZE,			/* OCTEON hates >PAGE_SIZE boundary */
    162  1.1   hikaru 	    0, &fb->fb_dmah);
    163  1.1   hikaru 	if (status != 0)
    164  1.1   hikaru 		panic("%s failed", "bus_dmamap_create");
    165  1.1   hikaru 
    166  1.1   hikaru 	status = bus_dmamem_alloc(fb->fb_dmat, fb->fb_len, 128, 0,
    167  1.1   hikaru 	    fb->fb_dma_segs, fb->fb_dma_nsegs, &nsegs, 0);
    168  1.1   hikaru 	if (status != 0 || fb->fb_dma_nsegs != nsegs)
    169  1.1   hikaru 		panic("%s failed", "bus_dmamem_alloc");
    170  1.1   hikaru 
    171  1.1   hikaru 	status = bus_dmamem_map(fb->fb_dmat, fb->fb_dma_segs, fb->fb_dma_nsegs,
    172  1.1   hikaru 	    fb->fb_len, &va, 0);
    173  1.1   hikaru 	if (status != 0)
    174  1.1   hikaru 		panic("%s failed", "bus_dmamem_map");
    175  1.1   hikaru 
    176  1.1   hikaru 	status = bus_dmamap_load(fb->fb_dmat, fb->fb_dmah, va, fb->fb_len,
    177  1.1   hikaru 	    NULL,		/* kernel */
    178  1.1   hikaru 	    0);
    179  1.1   hikaru 	if (status != 0)
    180  1.1   hikaru 		panic("%s failed", "bus_dmamap_load");
    181  1.1   hikaru 
    182  1.1   hikaru 	fb->fb_addr = (vaddr_t)va;
    183  1.1   hikaru 	fb->fb_paddr = fb->fb_dma_segs[0].ds_addr;
    184  1.1   hikaru }
    185  1.1   hikaru 
    186  1.1   hikaru uint64_t
    187  1.5   simonb octfpa_query(int poolno)
    188  1.1   hikaru {
    189  1.5   simonb 	struct octfpa_softc *sc = &octfpa_softc;
    190  1.1   hikaru 
    191  1.1   hikaru 	return bus_space_read_8(sc->sc_regt, sc->sc_regh,
    192  1.1   hikaru 	    FPA_QUE0_AVAILABLE_OFFSET + sizeof(uint64_t) * poolno);
    193  1.1   hikaru }
    194  1.1   hikaru 
    195  1.1   hikaru /* ---- local functions */
    196  1.1   hikaru 
    197  1.5   simonb static inline void	octfpa_init_bus(struct octfpa_softc *);
    198  1.5   simonb static inline void	octfpa_init_bus_space(struct octfpa_softc *);
    199  1.5   simonb static inline void	octfpa_init_regs(struct octfpa_softc *);
    200  1.1   hikaru 
    201  1.1   hikaru void
    202  1.5   simonb octfpa_init(struct octfpa_softc *sc)
    203  1.1   hikaru {
    204  1.1   hikaru 	if (sc->sc_initialized != 0)
    205  1.1   hikaru 		panic("%s: already initialized", __func__);
    206  1.1   hikaru 	sc->sc_initialized = 1;
    207  1.1   hikaru 
    208  1.5   simonb 	octfpa_init_bus(sc);
    209  1.5   simonb 	octfpa_init_regs(sc);
    210  1.1   hikaru }
    211  1.1   hikaru 
    212  1.1   hikaru void
    213  1.5   simonb octfpa_init_bus(struct octfpa_softc *sc)
    214  1.1   hikaru {
    215  1.8   simonb 
    216  1.5   simonb 	octfpa_init_bus_space(sc);
    217  1.1   hikaru }
    218  1.1   hikaru 
    219  1.1   hikaru void
    220  1.5   simonb octfpa_init_bus_space(struct octfpa_softc *sc)
    221  1.1   hikaru {
    222  1.1   hikaru 	int status;
    223  1.1   hikaru 
    224  1.1   hikaru 	status = bus_space_map(sc->sc_regt, FPA_BASE, FPA_SIZE, 0, &sc->sc_regh);
    225  1.1   hikaru 	if (status != 0)
    226  1.1   hikaru 		panic("can't map %s space", "register");
    227  1.1   hikaru 
    228  1.1   hikaru 	status = bus_space_map(sc->sc_opst,
    229  1.1   hikaru 	    0x0001180028000000ULL/* XXX */, 0x0200/* XXX */, 0, &sc->sc_opsh);
    230  1.1   hikaru 	if (status != 0)
    231  1.1   hikaru 		panic("can't map %s space", "operations");
    232  1.1   hikaru }
    233  1.1   hikaru 
    234  1.1   hikaru void
    235  1.5   simonb octfpa_init_regs(struct octfpa_softc *sc)
    236  1.1   hikaru {
    237  1.1   hikaru 
    238  1.1   hikaru 	bus_space_write_8(sc->sc_regt, sc->sc_regh, FPA_CTL_STATUS_OFFSET,
    239  1.1   hikaru 	    FPA_CTL_STATUS_ENB);
    240  1.1   hikaru }
    241  1.1   hikaru 
    242  1.1   hikaru int
    243  1.5   simonb octfpa_available_fpa_pool(int *available, int pool_no) {
    244  1.5   simonb 	struct octfpa_softc *sc = &octfpa_softc;
    245  1.1   hikaru 	size_t offset;
    246  1.1   hikaru 	uint64_t tmp;
    247  1.1   hikaru 
    248  1.1   hikaru 	switch (pool_no) {
    249  1.1   hikaru 	case OCTEON_POOL_NO_PKT:
    250  1.1   hikaru 		offset = FPA_QUE0_AVAILABLE_OFFSET;
    251  1.1   hikaru 		break;
    252  1.1   hikaru 	case OCTEON_POOL_NO_WQE:
    253  1.1   hikaru 		offset = FPA_QUE1_AVAILABLE_OFFSET;
    254  1.1   hikaru 		break;
    255  1.1   hikaru 	case OCTEON_POOL_NO_CMD:
    256  1.1   hikaru 		offset = FPA_QUE2_AVAILABLE_OFFSET;
    257  1.1   hikaru 		break;
    258  1.1   hikaru 	case OCTEON_POOL_NO_SG:
    259  1.1   hikaru 		offset = FPA_QUE3_AVAILABLE_OFFSET;
    260  1.1   hikaru 		break;
    261  1.1   hikaru 	case OCTEON_POOL_NO_XXX_4:
    262  1.1   hikaru 		offset = FPA_QUE4_AVAILABLE_OFFSET;
    263  1.1   hikaru 		break;
    264  1.1   hikaru 	case OCTEON_POOL_NO_XXX_5:
    265  1.1   hikaru 		offset = FPA_QUE5_AVAILABLE_OFFSET;
    266  1.1   hikaru 		break;
    267  1.1   hikaru 	case OCTEON_POOL_NO_XXX_6:
    268  1.1   hikaru 		offset = FPA_QUE6_AVAILABLE_OFFSET;
    269  1.1   hikaru 		break;
    270  1.1   hikaru 	case OCTEON_POOL_NO_DUMP:
    271  1.1   hikaru 		offset = FPA_QUE7_AVAILABLE_OFFSET;
    272  1.1   hikaru 		break;
    273  1.1   hikaru 	default:
    274  1.1   hikaru 		return EINVAL;
    275  1.1   hikaru 	}
    276  1.1   hikaru 	tmp = bus_space_read_8(sc->sc_regt, sc->sc_regh, offset);
    277  1.1   hikaru 	if (available) {
    278  1.1   hikaru 		*available = (int)(tmp & FPA_QUEX_AVAILABLE_QUE_SIZ);
    279  1.1   hikaru 	}
    280  1.1   hikaru 
    281  1.1   hikaru 	return 0;
    282  1.1   hikaru }
    283