Home | History | Annotate | Line # | Download | only in dev
      1  1.2  simonb /*	$NetBSD: octeon_twsi.c,v 1.2 2020/06/18 13:52:08 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 #undef	TWSIDEBUG
     30  1.1  hikaru #undef	TWSITEST
     31  1.1  hikaru 
     32  1.1  hikaru #include <sys/cdefs.h>
     33  1.2  simonb __KERNEL_RCSID(0, "$NetBSD: octeon_twsi.c,v 1.2 2020/06/18 13:52:08 simonb Exp $");
     34  1.1  hikaru 
     35  1.1  hikaru #include "opt_octeon.h"
     36  1.1  hikaru 
     37  1.1  hikaru #include <sys/param.h>
     38  1.1  hikaru #include <sys/systm.h>
     39  1.1  hikaru #include <sys/types.h>
     40  1.1  hikaru #include <sys/device.h>
     41  1.1  hikaru #include <sys/lock.h>
     42  1.1  hikaru 
     43  1.1  hikaru #include <sys/bus.h>
     44  1.1  hikaru 
     45  1.1  hikaru #include <dev/i2c/i2cvar.h>
     46  1.1  hikaru 
     47  1.1  hikaru #include <mips/cavium/include/iobusvar.h>
     48  1.1  hikaru #include <mips/cavium/dev/octeon_twsireg.h>
     49  1.1  hikaru 
     50  1.1  hikaru #ifdef TWSIDEBUG
     51  1.1  hikaru #define	DPRINTF(x)	printf x
     52  1.1  hikaru #else
     53  1.1  hikaru #define	DPRINTF(x)
     54  1.1  hikaru #endif
     55  1.1  hikaru 
     56  1.1  hikaru struct octeon_twsi_reg;
     57  1.1  hikaru 
     58  1.1  hikaru struct octeon_twsi_softc {
     59  1.1  hikaru 	device_t		sc_dev;
     60  1.1  hikaru 	bus_space_tag_t		sc_regt;
     61  1.1  hikaru 	bus_space_handle_t	sc_regh;
     62  1.1  hikaru 
     63  1.1  hikaru 	void *sc_ih;
     64  1.1  hikaru 
     65  1.1  hikaru 	struct i2c_controller	sc_i2c;
     66  1.1  hikaru 	struct lock		sc_lock;
     67  1.1  hikaru 
     68  1.1  hikaru 	/* ... */
     69  1.1  hikaru };
     70  1.1  hikaru 
     71  1.1  hikaru /* Auto-configuration */
     72  1.1  hikaru 
     73  1.1  hikaru static int		octeon_twsi_match(device_t, struct cfdata *,
     74  1.1  hikaru 			    void *);
     75  1.1  hikaru static void		octeon_twsi_attach(device_t, device_t,
     76  1.1  hikaru 			    void *);
     77  1.1  hikaru 
     78  1.1  hikaru /* High-Level Controller Master */
     79  1.1  hikaru 
     80  1.1  hikaru #ifdef notyet
     81  1.1  hikaru static uint8_t		octeon_twsi_hlcm_read_1(struct octeon_twsi_softc *,
     82  1.1  hikaru 			    ...)
     83  1.1  hikaru static uint64_t		octeon_twsi_hlcm_read_4(struct octeon_twsi_softc *,
     84  1.1  hikaru 			    ...)
     85  1.1  hikaru static void		octeon_twsi_hlcm_read(struct octeon_twsi_softc *,
     86  1.1  hikaru 			    ...)
     87  1.1  hikaru static void		octeon_twsi_hlcm_write_1(struct octeon_twsi_softc *,
     88  1.1  hikaru 			    ...)
     89  1.1  hikaru static void		octeon_twsi_hlcm_write_4(struct octeon_twsi_softc *,
     90  1.1  hikaru 			    ...)
     91  1.1  hikaru static void		octeon_twsi_hlcm_write(struct octeon_twsi_softc *,
     92  1.1  hikaru 			    ...)
     93  1.1  hikaru #endif
     94  1.1  hikaru 
     95  1.1  hikaru /* High-Level Controller Slave */
     96  1.1  hikaru 
     97  1.1  hikaru /* XXX */
     98  1.1  hikaru 
     99  1.1  hikaru /* Control Register */
    100  1.1  hikaru 
    101  1.1  hikaru #ifdef notyet
    102  1.1  hikaru #define	_CONTROL_READ(sc, reg) \
    103  1.1  hikaru 	octeon_twsi_control_read((sc), MIO_TWS_SW_TWSI_EOP_IA_##reg)
    104  1.1  hikaru #define	_CONTROL_WRITE(sc, reg, value) \
    105  1.1  hikaru 	octeon_twsi_control_write((sc), MIO_TWS_SW_TWSI_EOP_IA_##reg, value)
    106  1.1  hikaru static uint8_t		octeon_twsi_control_read(struct octeon_twsi_softc *sc,
    107  1.1  hikaru 			    uint64_t);
    108  1.1  hikaru static void		octeon_twsi_control_write(struct octeon_twsi_softc *sc,
    109  1.1  hikaru 			    uint64_t, uint8_t);
    110  1.1  hikaru #endif
    111  1.1  hikaru 
    112  1.1  hikaru /* Register accessors */
    113  1.1  hikaru 
    114  1.1  hikaru static inline uint64_t	octeon_twsi_reg_rd(struct octeon_twsi_softc *, int);
    115  1.1  hikaru static inline void	octeon_twsi_reg_wr(struct octeon_twsi_softc *, int,
    116  1.1  hikaru 			    uint64_t);
    117  1.1  hikaru #ifdef TWSIDEBUG
    118  1.1  hikaru static inline void	octeon_twsi_reg_dump(struct octeon_twsi_softc *, int);
    119  1.1  hikaru #endif
    120  1.1  hikaru 
    121  1.1  hikaru /* Test functions */
    122  1.1  hikaru 
    123  1.1  hikaru #ifdef TWSIDEBUG
    124  1.1  hikaru static void		octeon_twsi_test(struct octeon_twsi_softc *);
    125  1.1  hikaru #endif
    126  1.1  hikaru 
    127  1.1  hikaru /* Debug functions */
    128  1.1  hikaru 
    129  1.1  hikaru #ifdef TWSIDEBUG
    130  1.1  hikaru static inline void	octeon_twsi_debug_reg_dump(struct octeon_twsi_softc *,
    131  1.1  hikaru 			    int);
    132  1.1  hikaru static void		octeon_twsi_debug_dumpregs(struct octeon_twsi_softc *);
    133  1.1  hikaru static void		octeon_twsi_debug_dumpreg(struct octeon_twsi_softc *,
    134  1.1  hikaru 			    const struct octeon_twsi_reg *);
    135  1.1  hikaru #endif
    136  1.1  hikaru 
    137  1.1  hikaru /* -------------------------------------------------------------------------- */
    138  1.1  hikaru 
    139  1.1  hikaru /*
    140  1.1  hikaru  * Auto-configuration
    141  1.1  hikaru  */
    142  1.1  hikaru 
    143  1.1  hikaru CFATTACH_DECL_NEW(octeon_twsi, sizeof(struct octeon_twsi_softc),
    144  1.1  hikaru     octeon_twsi_match, octeon_twsi_attach, NULL, NULL);
    145  1.1  hikaru 
    146  1.1  hikaru static int
    147  1.1  hikaru octeon_twsi_match(device_t parent, struct cfdata *cf, void *aux)
    148  1.1  hikaru {
    149  1.1  hikaru 	struct iobus_attach_args *aa = aux;
    150  1.1  hikaru 
    151  1.1  hikaru 	if (strcmp(cf->cf_name, aa->aa_name) != 0)
    152  1.1  hikaru 		return 0;
    153  1.1  hikaru 	return 1;
    154  1.1  hikaru }
    155  1.1  hikaru 
    156  1.1  hikaru static void
    157  1.1  hikaru octeon_twsi_attach(device_t parent, device_t self, void *aux)
    158  1.1  hikaru {
    159  1.1  hikaru 	struct octeon_twsi_softc *sc = device_private(self);
    160  1.1  hikaru 	struct iobus_attach_args *aa = aux;
    161  1.1  hikaru 	int status;
    162  1.1  hikaru 
    163  1.1  hikaru 	sc->sc_dev = self;
    164  1.1  hikaru 	sc->sc_regt = aa->aa_bust;
    165  1.1  hikaru 
    166  1.1  hikaru 	status = bus_space_map(sc->sc_regt, MIO_TWS_BASE_0, MIO_TWS_SIZE, 0,
    167  1.1  hikaru 	    &sc->sc_regh);
    168  1.1  hikaru 	if (status != 0)
    169  1.1  hikaru 		panic(": can't map register");
    170  1.1  hikaru 
    171  1.1  hikaru 	aprint_normal("\n");
    172  1.1  hikaru 
    173  1.1  hikaru #ifdef TWSITEST
    174  1.1  hikaru 	octeon_twsi_test(sc);
    175  1.1  hikaru #endif
    176  1.1  hikaru }
    177  1.1  hikaru 
    178  1.1  hikaru /* -------------------------------------------------------------------------- */
    179  1.1  hikaru 
    180  1.1  hikaru /*
    181  1.1  hikaru  * Initialization, basic operations
    182  1.1  hikaru  */
    183  1.1  hikaru 
    184  1.1  hikaru #ifdef notyet
    185  1.1  hikaru 
    186  1.1  hikaru static void
    187  1.1  hikaru octeon_twsi_wait(struct octeon_twsi_softc *sc)
    188  1.1  hikaru {
    189  1.1  hikaru }
    190  1.1  hikaru 
    191  1.1  hikaru static void
    192  1.1  hikaru octeon_twsi_intr(struct octeon_twsi_softc *sc)
    193  1.1  hikaru {
    194  1.1  hikaru }
    195  1.1  hikaru 
    196  1.1  hikaru static void
    197  1.1  hikaru octeon_twsi_lock(struct octeon_twsi_softc *sc)
    198  1.1  hikaru {
    199  1.1  hikaru }
    200  1.1  hikaru 
    201  1.1  hikaru static void
    202  1.1  hikaru octeon_twsi_unlock(struct octeon_twsi_softc *sc)
    203  1.1  hikaru {
    204  1.1  hikaru }
    205  1.1  hikaru 
    206  1.1  hikaru #endif
    207  1.1  hikaru 
    208  1.1  hikaru /* -------------------------------------------------------------------------- */
    209  1.1  hikaru 
    210  1.1  hikaru /*
    211  1.1  hikaru  * High-Level Controller as a Master
    212  1.1  hikaru  */
    213  1.1  hikaru 
    214  1.1  hikaru #ifdef notyet
    215  1.1  hikaru 
    216  1.1  hikaru #define	_BUFTOLE32(buf)						\
    217  1.1  hikaru 	((buf[0] << 24) | (buf[1] << 16) | (buf[2] <<  8) | (buf[3] <<  0))
    218  1.1  hikaru #define	_LE32TOBUF(buf, x)					\
    219  1.1  hikaru 	do {							\
    220  1.1  hikaru 		buf[0] = (char)((x) >> 24);			\
    221  1.1  hikaru 		buf[1] = (char)((x) >> 16);			\
    222  1.1  hikaru 		buf[2] = (char)((x) >> 8);			\
    223  1.1  hikaru 		buf[3] = (char)((x) >> 0);			\
    224  1.1  hikaru 	} while (0)
    225  1.1  hikaru 
    226  1.1  hikaru static void
    227  1.1  hikaru octeon_twsi_hlcm_read(struct octeon_twsi_softc *sc, int addr, char *buf,
    228  1.1  hikaru     size_t len)
    229  1.1  hikaru {
    230  1.1  hikaru 	uint64_t cmd;
    231  1.1  hikaru 	size_t resid;
    232  1.1  hikaru 
    233  1.1  hikaru 	octeon_twsi_lock(sc);
    234  1.1  hikaru 
    235  1.1  hikaru #ifdef notyet
    236  1.1  hikaru 
    237  1.1  hikaru 	octeon_twsi_hlcm_setup(sc);
    238  1.1  hikaru 
    239  1.1  hikaru 	resid = len;
    240  1.1  hikaru 
    241  1.1  hikaru 	while (resid > 4) {
    242  1.2  simonb 		cmd =
    243  1.2  simonb 		    __SHIFTIN(MIO_TWS_SW_TWSI_OP_FOUR, MIO_TWS_SW_TWSI_OP) |
    244  1.2  simonb 		    MIO_TWS_SW_TWSI_R |
    245  1.2  simonb 		    __SHIFTIN(addr, MIO_TWS_SW_TWSI_A);
    246  1.1  hikaru 		octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
    247  1.1  hikaru 		octeon_twsi_wait(sc);
    248  1.1  hikaru 		cmd = octeon_twsi_reg_rd(sc);
    249  1.1  hikaru 		_LE32TOBUF(&buf[len - 1 - resid], (uint32_t)cmd);
    250  1.1  hikaru 		resid -= 4;
    251  1.1  hikaru 	}
    252  1.1  hikaru 
    253  1.1  hikaru 	while (resid > 0) {
    254  1.2  simonb 		cmd =
    255  1.2  simonb 		    __SHIFTIN(MIO_TWS_SW_TWSI_OP_ONE, MIO_TWS_SW_TWSI_OP) |
    256  1.2  simonb 		    MIO_TWS_SW_TWSI_R |
    257  1.2  simonb 		    __SHIFTIN(addr, MIO_TWS_SW_TWSI_A);
    258  1.1  hikaru 		octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
    259  1.1  hikaru 		octeon_twsi_wait(sc);
    260  1.1  hikaru 		cmd = octeon_twsi_reg_rd(sc);
    261  1.1  hikaru 		buf[len - 1 - resid] = (uint8_t)cmd;
    262  1.1  hikaru 		resid--;
    263  1.1  hikaru 	}
    264  1.1  hikaru 
    265  1.1  hikaru #endif
    266  1.1  hikaru 
    267  1.1  hikaru 	octeon_twsi_unlock(sc);
    268  1.1  hikaru }
    269  1.1  hikaru 
    270  1.1  hikaru static void
    271  1.1  hikaru octeon_twsi_hlcm_write(struct octeon_twsi_softc *sc, int addr, char *buf,
    272  1.1  hikaru     size_t len)
    273  1.1  hikaru {
    274  1.1  hikaru 	uint64_t cmd;
    275  1.1  hikaru 	size_t resid;
    276  1.1  hikaru 
    277  1.1  hikaru 	octeon_twsi_lock(sc);
    278  1.1  hikaru 
    279  1.1  hikaru #ifdef notyet
    280  1.1  hikaru 
    281  1.1  hikaru 	octeon_twsi_hlcm_setup(sc);
    282  1.1  hikaru 
    283  1.1  hikaru 	resid = len;
    284  1.1  hikaru 
    285  1.1  hikaru 	while (resid > 4) {
    286  1.2  simonb 		cmd =
    287  1.2  simonb 		    __SHIFTIN(MIO_TWS_SW_TWSI_OP_FOUR, MIO_TWS_SW_TWSI_OP) |
    288  1.2  simonb 		    __SHIFTIN(addr, MIO_TWS_SW_TWSI_A) |
    289  1.2  simonb 		    __SHIFTIN(_BUFTOLE32(&buf[len - 1 - resid]), MIO_TWS_SW_TWSI_D);
    290  1.1  hikaru 		octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
    291  1.1  hikaru 		octeon_twsi_wait(sc);
    292  1.1  hikaru 		resid -= 4;
    293  1.1  hikaru 	}
    294  1.1  hikaru 
    295  1.1  hikaru 	while (resid > 0) {
    296  1.2  simonb 		cmd =
    297  1.2  simonb 		    __SHIFTIN(MIO_TWS_SW_TWSI_OP_ONE, MIO_TWS_SW_TWSI_OP) |
    298  1.2  simonb 		    __SHIFTIN(addr, MIO_TWS_SW_TWSI_A) |
    299  1.2  simonb 		    __SHIFTIN(buf[len - 1 - resid], MIO_TWS_SW_TWSI_D);
    300  1.1  hikaru 		octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
    301  1.1  hikaru 		octeon_twsi_wait(sc);
    302  1.1  hikaru 		resid--;
    303  1.1  hikaru 	}
    304  1.1  hikaru 
    305  1.1  hikaru 	/* MIO_TWS_SW_TWSI:V must be zero */
    306  1.1  hikaru 
    307  1.1  hikaru 	/* check error */
    308  1.1  hikaru 	if (MIO_TWS_SW_TWSI:R == 0) {
    309  1.1  hikaru 		code = MIO_TWS_SW_TWSI:D;
    310  1.1  hikaru 	}
    311  1.1  hikaru #endif
    312  1.1  hikaru 
    313  1.1  hikaru 	octeon_twsi_unlock(sc);
    314  1.1  hikaru }
    315  1.1  hikaru 
    316  1.1  hikaru static void
    317  1.1  hikaru octeon_twsi_hlcm_setup(struct octeon_twsi_softc *sc, ...)
    318  1.1  hikaru {
    319  1.1  hikaru 	/* XXX */
    320  1.1  hikaru 
    321  1.1  hikaru 	_CONTROL_WR(sc, TWSI_CTL, TWSI_CTL_CE | TWSI_CTL_ENAB | TWSI_AAK);
    322  1.1  hikaru }
    323  1.1  hikaru 
    324  1.1  hikaru static uint8_t
    325  1.1  hikaru octeon_twsi_hlcm_read_1(struct octeon_twsi_softc *sc, ...)
    326  1.1  hikaru {
    327  1.1  hikaru 	/* XXX */
    328  1.1  hikaru 	return 0;
    329  1.1  hikaru }
    330  1.1  hikaru 
    331  1.1  hikaru static uint64_t
    332  1.1  hikaru octeon_twsi_hlcm_read_4(struct octeon_twsi_softc *sc, ...)
    333  1.1  hikaru {
    334  1.1  hikaru 	/* XXX */
    335  1.1  hikaru 	return 0;
    336  1.1  hikaru }
    337  1.1  hikaru 
    338  1.1  hikaru static void
    339  1.1  hikaru octeon_twsi_hlcm_write_1(struct octeon_twsi_softc *sc, ...)
    340  1.1  hikaru {
    341  1.1  hikaru 	/* XXX */
    342  1.1  hikaru }
    343  1.1  hikaru 
    344  1.1  hikaru static void
    345  1.1  hikaru octeon_twsi_hlcm_write_4(struct octeon_twsi_softc *sc, ...)
    346  1.1  hikaru {
    347  1.1  hikaru 	/* XXX */
    348  1.1  hikaru }
    349  1.1  hikaru 
    350  1.1  hikaru #endif
    351  1.1  hikaru 
    352  1.1  hikaru /* -------------------------------------------------------------------------- */
    353  1.1  hikaru 
    354  1.1  hikaru /*
    355  1.1  hikaru  * High-Level Controller as a Slave
    356  1.1  hikaru  */
    357  1.1  hikaru 
    358  1.1  hikaru #ifdef notyet
    359  1.1  hikaru 
    360  1.1  hikaru static void
    361  1.1  hikaru octeon_twsi_hlcs_setup(struct octeon_twsi_softc *sc, ...)
    362  1.1  hikaru {
    363  1.1  hikaru 	/* XXX */
    364  1.1  hikaru }
    365  1.1  hikaru 
    366  1.1  hikaru #endif
    367  1.1  hikaru 
    368  1.1  hikaru /* -------------------------------------------------------------------------- */
    369  1.1  hikaru 
    370  1.1  hikaru /*
    371  1.1  hikaru  * TWSI Control Register operations
    372  1.1  hikaru  */
    373  1.1  hikaru 
    374  1.1  hikaru #ifdef notyet
    375  1.1  hikaru 
    376  1.1  hikaru static uint8_t
    377  1.1  hikaru octeon_twsi_control_read(struct octeon_twsi_softc *sc, uint64_t eop_ia)
    378  1.1  hikaru {
    379  1.1  hikaru 	uint64_t cmd;
    380  1.1  hikaru 
    381  1.2  simonb 	cmd =
    382  1.2  simonb 	    __SHIFTIN(MIO_TWS_SW_TWSI_OP_EXTEND, MIO_TWS_SW_TWSI_OP) |
    383  1.2  simonb 	    __SHIFTIN(addr, MIO_TWS_SW_TWSI_A) |
    384  1.2  simonb 	    __SHIFTIN(eop_ia, MIO_TWS_SW_TWSI_EOP_IA);
    385  1.1  hikaru 	octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
    386  1.1  hikaru 	octeon_twsi_wait(sc);
    387  1.1  hikaru 	return (uint8_t)octeon_twsi_reg_rd(sc, MIO_TWS_SW_TWSI_OFFSET);
    388  1.1  hikaru }
    389  1.1  hikaru 
    390  1.1  hikaru static void
    391  1.1  hikaru octeon_twsi_control_write(struct octeon_twsi_softc *sc, uint64_t eop_ia,
    392  1.1  hikaru     char *buf, size_t len)
    393  1.1  hikaru {
    394  1.1  hikaru 	uint64_t cmd;
    395  1.1  hikaru 
    396  1.2  simonb 	cmd =
    397  1.2  simonb 	    __SHIFTIN(MIO_TWS_SW_TWSI_OP_EXTEND, MIO_TWS_SW_TWSI_OP) |
    398  1.2  simonb 	    __SHIFTIN(addr, MIO_TWS_SW_TWSI_A_SHIFT) |
    399  1.2  simonb 	    __SHIFTIN(eop_ia, MIO_TWS_SW_TWSI_EOP_IA) |
    400  1.2  simonb 	    __SHIFTIN(_BUFTOLE32(&buf[len - 1 - resid]), MIO_TWS_SW_TWSI_D);
    401  1.1  hikaru 	octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, cmd);
    402  1.1  hikaru 	octeon_twsi_wait(sc);
    403  1.1  hikaru }
    404  1.1  hikaru 
    405  1.1  hikaru #endif
    406  1.1  hikaru 
    407  1.1  hikaru /* -------------------------------------------------------------------------- */
    408  1.1  hikaru 
    409  1.1  hikaru /*
    410  1.1  hikaru  * Send / receive operations
    411  1.1  hikaru  */
    412  1.1  hikaru 
    413  1.1  hikaru /* Send (== software to TWSI) */
    414  1.1  hikaru 
    415  1.1  hikaru #ifdef notyet
    416  1.1  hikaru 
    417  1.1  hikaru static void
    418  1.1  hikaru octeon_twsi_send(struct octeon_twsi_softc *sc, ...)
    419  1.1  hikaru {
    420  1.1  hikaru 	octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, ...);
    421  1.1  hikaru }
    422  1.1  hikaru 
    423  1.1  hikaru /* Receive (== TWSI to software) */
    424  1.1  hikaru 
    425  1.1  hikaru static void
    426  1.1  hikaru octeon_twsi_recv(struct octeon_twsi_softc *sc, ...)
    427  1.1  hikaru {
    428  1.1  hikaru 	/* XXX */
    429  1.1  hikaru 	octeon_twsi_reg_wr(sc, MIO_TWS_SW_TWSI_OFFSET, ...);
    430  1.1  hikaru 	octeon_twsi_wait(sc, MIO_TWS_SW_TWSI_OFFSET, ...);
    431  1.1  hikaru 	octeon_twsi_reg_rd(sc, MIO_TWS_SW_TWSI_OFFSET, ...);
    432  1.1  hikaru }
    433  1.1  hikaru 
    434  1.1  hikaru #endif
    435  1.1  hikaru 
    436  1.1  hikaru /* -------------------------------------------------------------------------- */
    437  1.1  hikaru 
    438  1.1  hikaru /*
    439  1.1  hikaru  * Register accessors
    440  1.1  hikaru  */
    441  1.1  hikaru 
    442  1.1  hikaru static inline uint64_t
    443  1.1  hikaru octeon_twsi_reg_rd(struct octeon_twsi_softc *sc, int offset)
    444  1.1  hikaru {
    445  1.1  hikaru 	return bus_space_read_8(sc->sc_regt, sc->sc_regh, offset);
    446  1.1  hikaru }
    447  1.1  hikaru 
    448  1.1  hikaru static inline void
    449  1.1  hikaru octeon_twsi_reg_wr(struct octeon_twsi_softc *sc, int offset, uint64_t value)
    450  1.1  hikaru {
    451  1.1  hikaru 	bus_space_write_8(sc->sc_regt, sc->sc_regh, offset, value);
    452  1.1  hikaru }
    453  1.1  hikaru 
    454  1.1  hikaru #ifdef TWSIDEBUG
    455  1.1  hikaru 
    456  1.1  hikaru void
    457  1.1  hikaru octeon_twsi_reg_dump(struct octeon_twsi_softc *sc, int offset)
    458  1.1  hikaru {
    459  1.1  hikaru 	octeon_twsi_debug_reg_dump(sc, offset);
    460  1.1  hikaru }
    461  1.1  hikaru 
    462  1.1  hikaru #endif
    463  1.1  hikaru 
    464  1.1  hikaru /* -------------------------------------------------------------------------- */
    465  1.1  hikaru 
    466  1.1  hikaru /*
    467  1.1  hikaru  * Test functions
    468  1.1  hikaru  */
    469  1.1  hikaru 
    470  1.1  hikaru #ifdef TWSITEST
    471  1.1  hikaru 
    472  1.1  hikaru void
    473  1.1  hikaru octeon_twsi_test(struct octeon_twsi_softc *sc)
    474  1.1  hikaru {
    475  1.1  hikaru 	octeon_twsi_debug_dumpregs(sc);
    476  1.1  hikaru }
    477  1.1  hikaru 
    478  1.1  hikaru #endif
    479  1.1  hikaru 
    480  1.1  hikaru /* -------------------------------------------------------------------------- */
    481  1.1  hikaru 
    482  1.1  hikaru #ifdef TWSIDEBUG
    483  1.1  hikaru 
    484  1.1  hikaru /*
    485  1.1  hikaru  * Debug functions
    486  1.1  hikaru  *
    487  1.1  hikaru  *	octeon_twsi_debug_reg_dump
    488  1.1  hikaru  *	octeon_twsi_debug_dumpregs
    489  1.1  hikaru  *	octeon_twsi_debug_dumpreg
    490  1.1  hikaru  */
    491  1.1  hikaru 
    492  1.1  hikaru struct octeon_twsi_reg {
    493  1.1  hikaru 	const char		*name;
    494  1.1  hikaru 	int			offset;
    495  1.1  hikaru 	const char		*format;
    496  1.1  hikaru };
    497  1.1  hikaru 
    498  1.1  hikaru static const struct octeon_twsi_reg octeon_twsi_regs[] = {
    499  1.1  hikaru #define	_ENTRY(x)	{ #x, x##_OFFSET, x##_BITS }
    500  1.1  hikaru 	_ENTRY(MIO_TWS_SW_TWSI),
    501  1.1  hikaru 	_ENTRY(MIO_TWS_TWSI_SW),
    502  1.1  hikaru 	_ENTRY(MIO_TWS_INT),
    503  1.1  hikaru 	_ENTRY(MIO_TWS_SW_TWSI_EXT)
    504  1.1  hikaru #undef	_ENTRY
    505  1.1  hikaru };
    506  1.1  hikaru 
    507  1.1  hikaru void
    508  1.1  hikaru octeon_twsi_debug_reg_dump(struct octeon_twsi_softc *sc, int offset)
    509  1.1  hikaru {
    510  1.1  hikaru 	int i;
    511  1.1  hikaru 	const struct octeon_twsi_reg *reg;
    512  1.1  hikaru 
    513  1.1  hikaru 	reg = NULL;
    514  1.1  hikaru 	for (i = 0; i < (int)__arraycount(octeon_twsi_regs); i++)
    515  1.1  hikaru 		if (octeon_twsi_regs[i].offset == offset) {
    516  1.1  hikaru 			reg = &octeon_twsi_regs[i];
    517  1.1  hikaru 			break;
    518  1.1  hikaru 		}
    519  1.1  hikaru 	KASSERT(reg != NULL);
    520  1.1  hikaru 
    521  1.1  hikaru 	octeon_twsi_debug_dumpreg(sc, reg);
    522  1.1  hikaru }
    523  1.1  hikaru 
    524  1.1  hikaru void
    525  1.1  hikaru octeon_twsi_debug_dumpregs(struct octeon_twsi_softc *sc)
    526  1.1  hikaru {
    527  1.1  hikaru 	int i;
    528  1.1  hikaru 
    529  1.1  hikaru 	for (i = 0; i < (int)__arraycount(octeon_twsi_regs); i++)
    530  1.1  hikaru 		octeon_twsi_debug_dumpreg(sc, &octeon_twsi_regs[i]);
    531  1.1  hikaru }
    532  1.1  hikaru 
    533  1.1  hikaru void
    534  1.1  hikaru octeon_twsi_debug_dumpreg(struct octeon_twsi_softc *sc,
    535  1.1  hikaru     const struct octeon_twsi_reg *reg)
    536  1.1  hikaru {
    537  1.1  hikaru 	uint64_t value;
    538  1.1  hikaru 	char buf[256];
    539  1.1  hikaru 
    540  1.1  hikaru 	value = octeon_twsi_reg_rd(sc, reg->offset);
    541  1.1  hikaru 	snprintb(buf, sizeof(buf), reg->format, value);
    542  1.1  hikaru 	printf("\t%-24s: %s\n", reg->name, buf);
    543  1.1  hikaru }
    544  1.1  hikaru 
    545  1.1  hikaru #endif
    546