Home | History | Annotate | Line # | Download | only in marvell
gtmpsc.c revision 1.14.4.1
      1  1.14.4.1    rpaulo /*	$NetBSD: gtmpsc.c,v 1.14.4.1 2006/09/09 02:51:56 rpaulo Exp $	*/
      2       1.1      matt 
      3       1.1      matt /*
      4       1.1      matt  * Copyright (c) 2002 Allegro Networks, Inc., Wasabi Systems, Inc.
      5       1.1      matt  * All rights reserved.
      6       1.1      matt  *
      7       1.1      matt  * Redistribution and use in source and binary forms, with or without
      8       1.1      matt  * modification, are permitted provided that the following conditions
      9       1.1      matt  * are met:
     10       1.1      matt  * 1. Redistributions of source code must retain the above copyright
     11       1.1      matt  *    notice, this list of conditions and the following disclaimer.
     12       1.1      matt  * 2. Redistributions in binary form must reproduce the above copyright
     13       1.1      matt  *    notice, this list of conditions and the following disclaimer in the
     14       1.1      matt  *    documentation and/or other materials provided with the distribution.
     15       1.1      matt  * 3. All advertising materials mentioning features or use of this software
     16       1.1      matt  *    must display the following acknowledgement:
     17       1.1      matt  *      This product includes software developed for the NetBSD Project by
     18       1.1      matt  *      Allegro Networks, Inc., and Wasabi Systems, Inc.
     19       1.1      matt  * 4. The name of Allegro Networks, Inc. may not be used to endorse
     20       1.1      matt  *    or promote products derived from this software without specific prior
     21       1.1      matt  *    written permission.
     22       1.1      matt  * 5. The name of Wasabi Systems, Inc. may not be used to endorse
     23       1.1      matt  *    or promote products derived from this software without specific prior
     24       1.1      matt  *    written permission.
     25       1.1      matt  *
     26       1.1      matt  * THIS SOFTWARE IS PROVIDED BY ALLEGRO NETWORKS, INC. AND
     27       1.1      matt  * WASABI SYSTEMS, INC. ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES,
     28       1.1      matt  * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY
     29       1.1      matt  * AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     30       1.1      matt  * IN NO EVENT SHALL EITHER ALLEGRO NETWORKS, INC. OR WASABI SYSTEMS, INC.
     31       1.1      matt  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     32       1.1      matt  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     33       1.1      matt  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     34       1.1      matt  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     35       1.1      matt  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     36       1.1      matt  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     37       1.1      matt  * POSSIBILITY OF SUCH DAMAGE.
     38       1.1      matt  */
     39       1.1      matt 
     40       1.1      matt /*
     41       1.1      matt  * mpsc.c - MPSC serial driver, supports UART mode only
     42       1.1      matt  *
     43       1.1      matt  *
     44       1.1      matt  * creation	Mon Apr  9 19:40:15 PDT 2001	cliff
     45       1.1      matt  */
     46       1.9     lukem 
     47       1.9     lukem #include <sys/cdefs.h>
     48  1.14.4.1    rpaulo __KERNEL_RCSID(0, "$NetBSD: gtmpsc.c,v 1.14.4.1 2006/09/09 02:51:56 rpaulo Exp $");
     49       1.1      matt 
     50       1.1      matt #include "opt_kgdb.h"
     51       1.1      matt 
     52       1.1      matt #include <sys/param.h>
     53       1.1      matt #include <sys/conf.h>
     54       1.1      matt #include <sys/device.h>
     55  1.14.4.1    rpaulo #include <sys/kauth.h>
     56       1.1      matt #include <sys/proc.h>
     57       1.1      matt #include <sys/systm.h>
     58       1.1      matt #include <sys/tty.h>
     59       1.1      matt #include <sys/callout.h>
     60       1.1      matt #include <sys/fcntl.h>
     61       1.1      matt #ifdef KGDB
     62       1.1      matt #include <sys/kernel.h>
     63       1.1      matt #include <sys/kgdb.h>
     64       1.1      matt #endif
     65       1.6   thorpej 
     66       1.6   thorpej #include <uvm/uvm_extern.h>
     67       1.6   thorpej 
     68       1.1      matt #include <powerpc/atomic.h>
     69       1.1      matt #include <dev/cons.h>
     70       1.1      matt #include <machine/bus.h>
     71       1.1      matt #include <machine/cpu.h>		/* for DELAY */
     72       1.1      matt #include <machine/stdarg.h>
     73       1.1      matt #include "gtmpsc.h"
     74       1.1      matt 
     75       1.1      matt 
     76       1.1      matt #include <dev/marvell/gtreg.h>
     77       1.1      matt #include <dev/marvell/gtvar.h>
     78       1.1      matt #include <dev/marvell/gtintrreg.h>
     79       1.1      matt #include <dev/marvell/gtmpscreg.h>
     80       1.1      matt #include <dev/marvell/gtsdmareg.h>
     81       1.1      matt #include <dev/marvell/gtmpscvar.h>
     82       1.1      matt #include <dev/marvell/gtbrgreg.h>
     83       1.1      matt 
     84       1.1      matt /*
     85       1.1      matt  * XXX these delays were derived empiracaly
     86       1.1      matt  */
     87       1.1      matt #define GTMPSC_POLL_DELAY	1	/* 1 usec */
     88       1.5      matt /*
     89       1.5      matt  * Wait 2 characters time for RESET_DELAY
     90       1.5      matt  */
     91       1.5      matt #define GTMPSC_RESET_DELAY	(2*8*1000000 / GT_MPSC_DEFAULT_BAUD_RATE)
     92       1.1      matt 
     93       1.1      matt #define BURSTLEN 128
     94       1.1      matt 
     95       1.1      matt /*
     96       1.1      matt  * stat values for gtmpsc_common_pollc
     97       1.1      matt  */
     98       1.1      matt #define GTMPSC_STAT_NONE	0
     99       1.1      matt #define GTMPSC_STAT_BREAK	1
    100       1.1      matt 
    101       1.1      matt 
    102       1.1      matt #define PRINTF(x)	gtmpsc_mem_printf x
    103       1.1      matt 
    104       1.1      matt #if defined(DEBUG)
    105       1.5      matt unsigned int gtmpsc_debug = 0;
    106       1.1      matt # define STATIC
    107       1.5      matt # define DPRINTF(x)	do { if (gtmpsc_debug) gtmpsc_mem_printf x ; } while (0)
    108       1.1      matt #else
    109       1.1      matt # define STATIC static
    110       1.1      matt # define DPRINTF(x)
    111       1.1      matt #endif
    112       1.1      matt 
    113       1.1      matt #define GTMPSCUNIT_MASK    0x7ffff
    114       1.1      matt #define GTMPSCDIALOUT_MASK 0x80000
    115       1.1      matt 
    116       1.1      matt #define GTMPSCUNIT(x)      (minor(x) & GTMPSCUNIT_MASK)
    117       1.1      matt #define GTMPSCDIALOUT(x)   (minor(x) & GTMPSCDIALOUT_MASK)
    118       1.1      matt 
    119       1.2      matt STATIC void gtmpscinit(struct gtmpsc_softc *);
    120       1.2      matt STATIC int  gtmpscmatch(struct device *, struct cfdata *, void *);
    121       1.2      matt STATIC void gtmpscattach(struct device *, struct device *, void *);
    122       1.2      matt STATIC int  compute_cdv(unsigned int);
    123       1.2      matt STATIC void gtmpsc_loadchannelregs(struct gtmpsc_softc *);
    124       1.2      matt STATIC void gtmpscshutdown(struct gtmpsc_softc *);
    125       1.2      matt STATIC void gtmpscstart(struct tty *);
    126       1.2      matt STATIC int  gtmpscparam(struct tty *, struct termios *);
    127       1.2      matt STATIC int  gtmpsc_probe(void);
    128       1.2      matt STATIC int  gtmpsc_intr(void *);
    129       1.3      matt STATIC void gtmpsc_softintr(void *);
    130       1.1      matt 
    131       1.2      matt STATIC void gtmpsc_common_putn(struct gtmpsc_softc *);
    132       1.2      matt STATIC void gtmpsc_common_putc(unsigned int, unsigned char);
    133       1.2      matt STATIC int  gtmpsc_common_getc(unsigned int);
    134       1.2      matt STATIC int  gtmpsc_common_pollc(unsigned int, char *, int *);
    135       1.2      matt STATIC void gtmpsc_poll(void *);
    136       1.1      matt #ifdef KGDB
    137       1.2      matt STATIC void gtmpsc_kgdb_poll(void *);
    138       1.1      matt #endif
    139       1.2      matt STATIC void gtmpsc_mem_printf(const char *, ...);
    140       1.1      matt 
    141       1.1      matt STATIC void gtmpsc_txdesc_init(gtmpsc_poll_sdma_t *, gtmpsc_poll_sdma_t *);
    142       1.1      matt STATIC void gtmpsc_rxdesc_init(gtmpsc_poll_sdma_t *, gtmpsc_poll_sdma_t *);
    143       1.1      matt STATIC unsigned int gtmpsc_get_causes(void);
    144       1.3      matt STATIC void gtmpsc_hackinit(struct gtmpsc_softc *, bus_space_tag_t,
    145       1.3      matt 	bus_space_handle_t, int);
    146       1.1      matt STATIC void gtmpscinit_stop(struct gtmpsc_softc *, int);
    147       1.1      matt STATIC void gtmpscinit_start(struct gtmpsc_softc *, int);
    148       1.2      matt #if 0
    149       1.1      matt void gtmpsc_printf(const char *fmt, ...);
    150       1.2      matt #endif
    151       1.1      matt void gtmpsc_puts(char *);
    152       1.1      matt 
    153       1.2      matt void gtmpsccnprobe(struct consdev *);
    154       1.2      matt void gtmpsccninit(struct consdev *);
    155       1.2      matt int  gtmpsccngetc(dev_t);
    156       1.2      matt void gtmpsccnputc(dev_t, int);
    157       1.2      matt void gtmpsccnpollc(dev_t, int);
    158       1.2      matt void gtmpsccnhalt(dev_t);
    159       1.2      matt 
    160       1.2      matt STATIC void gtmpsc_txflush(gtmpsc_softc_t *);
    161       1.2      matt STATIC void gtmpsc_iflush(gtmpsc_softc_t *);
    162       1.2      matt STATIC void gtmpsc_shutdownhook(void *);
    163       1.1      matt 
    164       1.1      matt dev_type_open(gtmpscopen);
    165       1.1      matt dev_type_close(gtmpscclose);
    166       1.1      matt dev_type_read(gtmpscread);
    167       1.1      matt dev_type_write(gtmpscwrite);
    168       1.1      matt dev_type_ioctl(gtmpscioctl);
    169       1.1      matt dev_type_stop(gtmpscstop);
    170       1.1      matt dev_type_tty(gtmpsctty);
    171       1.1      matt dev_type_poll(gtmpscpoll);
    172       1.1      matt 
    173       1.1      matt const struct cdevsw gtmpsc_cdevsw = {
    174       1.1      matt 	gtmpscopen, gtmpscclose, gtmpscread, gtmpscwrite, gtmpscioctl,
    175       1.1      matt 	gtmpscstop, gtmpsctty, gtmpscpoll, nommap, ttykqfilter, D_TTY
    176       1.1      matt };
    177       1.1      matt 
    178       1.1      matt CFATTACH_DECL(gtmpsc, sizeof(struct gtmpsc_softc),
    179       1.1      matt     gtmpscmatch, gtmpscattach, NULL, NULL);
    180       1.1      matt 
    181       1.1      matt extern struct cfdriver gtmpsc_cd;
    182       1.1      matt 
    183       1.4      matt static struct consdev gtmpsc_consdev = {
    184       1.4      matt 	0,
    185       1.1      matt 	gtmpsccninit,
    186       1.1      matt 	gtmpsccngetc,
    187       1.1      matt 	gtmpsccnputc,
    188       1.1      matt 	gtmpsccnpollc,
    189       1.2      matt 	NULL,		/* cn_bell */
    190       1.4      matt 	gtmpsccnhalt,
    191       1.1      matt 	NULL,		/* cn_flush */
    192       1.4      matt 	NODEV,
    193       1.4      matt 	CN_NORMAL
    194       1.1      matt };
    195       1.1      matt 
    196       1.1      matt STATIC void *gtmpsc_sdma_ih = NULL;
    197       1.1      matt 
    198       1.1      matt gtmpsc_softc_t *gtmpsc_scp[GTMPSC_NCHAN] = { 0 };
    199       1.1      matt 
    200       1.1      matt STATIC int gt_reva_gtmpsc_bug;
    201       1.1      matt unsigned int sdma_imask;        /* soft copy of SDMA IMASK reg */
    202       1.1      matt 
    203       1.1      matt #ifdef KGDB
    204       1.1      matt #include <sys/kgdb.h>
    205       1.1      matt 
    206       1.1      matt static int gtmpsc_kgdb_addr;
    207       1.1      matt static int gtmpsc_kgdb_attached;
    208       1.1      matt 
    209       1.1      matt int kgdb_break_immediate /* = 0 */ ;
    210       1.1      matt 
    211       1.2      matt STATIC int      gtmpsc_kgdb_getc(void *);
    212       1.2      matt STATIC void     gtmpsc_kgdb_putc(void *, int);
    213       1.1      matt #endif /* KGDB */
    214       1.1      matt 
    215       1.1      matt /*
    216       1.1      matt  * hacks for console initialization
    217       1.1      matt  * which happens prior to autoconfig "attach"
    218       1.6   thorpej  *
    219       1.6   thorpej  * XXX Assumes PAGE_SIZE is a constant!
    220       1.1      matt  */
    221       1.1      matt STATIC unsigned int gtmpsccninit_done = 0;
    222       1.1      matt STATIC gtmpsc_softc_t gtmpsc_fake_softc;
    223       1.6   thorpej STATIC unsigned char gtmpsc_earlybuf[PAGE_SIZE]
    224       1.6   thorpej     __attribute__ ((aligned(PAGE_SIZE)));
    225       1.6   thorpej STATIC unsigned char gtmpsc_fake_dmapage[PAGE_SIZE]
    226       1.6   thorpej     __attribute__ ((aligned(PAGE_SIZE)));
    227       1.1      matt 
    228       1.1      matt 
    229       1.1      matt #define GTMPSC_PRINT_BUF_SIZE	4096
    230       1.1      matt STATIC unsigned char gtmpsc_print_buf[GTMPSC_PRINT_BUF_SIZE] = { 0 };
    231       1.1      matt 
    232       1.1      matt unsigned int gtmpsc_poll_putc_cnt = 0;
    233       1.1      matt unsigned int gtmpsc_poll_putn_cnt = 0;
    234       1.1      matt unsigned int gtmpsc_poll_getc_cnt = 0;
    235       1.1      matt unsigned int gtmpsc_poll_pollc_cnt = 0;
    236       1.1      matt unsigned int gtmpsc_poll_putc_miss = 0;
    237       1.1      matt unsigned int gtmpsc_poll_putn_miss = 0;
    238       1.1      matt unsigned int gtmpsc_poll_getc_miss = 0;
    239       1.1      matt unsigned int gtmpsc_poll_pollc_miss = 0;
    240       1.1      matt 
    241       1.1      matt #ifndef SDMA_COHERENT
    242       1.1      matt /*
    243       1.1      matt  * inlines to flush, invalidate cache
    244       1.1      matt  * required if DMA cache coherency is broken
    245       1.1      matt  * note that pointer `p' args are assumed to be cache aligned
    246       1.1      matt  * and the size is assumed to be one CACHELINESIZE block
    247       1.1      matt  */
    248       1.1      matt 
    249       1.1      matt #define GTMPSC_CACHE_FLUSH(p)		gtmpsc_cache_flush(p)
    250       1.1      matt #define GTMPSC_CACHE_INVALIDATE(p)	gtmpsc_cache_invalidate(p)
    251       1.1      matt 
    252  1.14.4.1    rpaulo static inline void
    253       1.1      matt gtmpsc_cache_flush(void *p)
    254       1.1      matt {
    255      1.14     perry 	__asm volatile ("eieio; dcbf 0,%0; lwz %0,0(%0); sync;"
    256       1.1      matt 					: "+r"(p):);
    257       1.1      matt }
    258       1.1      matt 
    259  1.14.4.1    rpaulo static inline void
    260       1.1      matt gtmpsc_cache_invalidate(void *p)
    261       1.1      matt {
    262      1.14     perry 	__asm volatile ("eieio; dcbi 0,%0; sync;" :: "r"(p));
    263       1.1      matt }
    264       1.1      matt #else
    265       1.1      matt 
    266       1.1      matt #define GTMPSC_CACHE_FLUSH(p)
    267       1.1      matt #define GTMPSC_CACHE_INVALIDATE(p)
    268       1.1      matt 
    269       1.1      matt #endif	/* SDMA_COHERENT */
    270       1.1      matt 
    271       1.3      matt #define GT_READ(sc,o) \
    272       1.3      matt 	bus_space_read_4((sc)->gtmpsc_memt, (sc)->gtmpsc_memh, (o))
    273       1.3      matt #define GT_WRITE(sc,o,v) \
    274       1.3      matt 	bus_space_write_4((sc)->gtmpsc_memt, (sc)->gtmpsc_memh, (o), (v))
    275       1.1      matt 
    276       1.1      matt 
    277       1.3      matt #define SDMA_IMASK_ENABLE(sc, bit)  do { \
    278      1.11       scw 	unsigned int    __r; \
    279       1.3      matt 	GT_WRITE(sc, SDMA_ICAUSE, ~(bit)); \
    280       1.1      matt 	if (gt_reva_gtmpsc_bug) \
    281      1.11       scw 		__r = sdma_imask; \
    282       1.1      matt 	else \
    283      1.11       scw 		__r = GT_READ(sc, SDMA_IMASK); \
    284      1.11       scw 	__r |= (bit); \
    285      1.11       scw 	sdma_imask = __r; \
    286      1.11       scw 	GT_WRITE(sc, SDMA_IMASK, __r); \
    287       1.3      matt } while (/*CONSTCOND*/ 0)
    288       1.1      matt 
    289       1.3      matt #define SDMA_IMASK_DISABLE(sc, bit)  do { \
    290      1.11       scw 	unsigned int    __r; \
    291       1.1      matt 	if (gt_reva_gtmpsc_bug) \
    292      1.11       scw 		__r = sdma_imask; \
    293       1.1      matt 	else \
    294      1.11       scw 		__r = GT_READ(sc, SDMA_IMASK); \
    295      1.11       scw 	__r &= ~(bit); \
    296      1.11       scw 	sdma_imask = __r; \
    297      1.11       scw 	GT_WRITE(sc, SDMA_IMASK, __r); \
    298       1.3      matt } while (/*CONSTCOND*/ 0)
    299       1.1      matt 
    300  1.14.4.1    rpaulo static inline unsigned int
    301       1.1      matt desc_read(unsigned int *ip)
    302       1.1      matt {
    303       1.1      matt 	unsigned int rv;
    304       1.1      matt 
    305      1.14     perry 	__asm volatile ("lwzx %0,0,%1; eieio;"
    306       1.1      matt 		: "=r"(rv) : "r"(ip));
    307       1.1      matt 	return rv;
    308       1.1      matt }
    309       1.1      matt 
    310  1.14.4.1    rpaulo static inline void
    311       1.1      matt desc_write(unsigned int *ip, unsigned int val)
    312       1.1      matt {
    313      1.14     perry 	__asm volatile ("stwx %0,0,%1; eieio;"
    314       1.1      matt 		:: "r"(val), "r"(ip));
    315       1.1      matt }
    316       1.1      matt 
    317       1.1      matt 
    318       1.1      matt /*
    319       1.1      matt  * gtmpsc_txdesc_init - set up TX descriptor ring
    320       1.1      matt  */
    321       1.1      matt STATIC void
    322       1.1      matt gtmpsc_txdesc_init(gtmpsc_poll_sdma_t *vmps, gtmpsc_poll_sdma_t *pmps)
    323       1.1      matt {
    324       1.1      matt 	int n;
    325       1.1      matt 	sdma_desc_t *dp;
    326       1.1      matt 	gtmpsc_polltx_t *vtxp;
    327       1.1      matt 	gtmpsc_polltx_t *ptxp;
    328       1.1      matt 	gtmpsc_polltx_t *next_ptxp;
    329       1.1      matt 	gtmpsc_polltx_t *first_ptxp;
    330       1.1      matt 
    331       1.1      matt 	first_ptxp = ptxp = &pmps->tx[0];
    332       1.1      matt 	vtxp = &vmps->tx[0];
    333       1.1      matt 	next_ptxp = ptxp + 1;
    334       1.1      matt 	for (n = (GTMPSC_NTXDESC - 1); n--; ) {
    335       1.1      matt 		dp = &vtxp->txdesc;
    336       1.1      matt 		desc_write(&dp->sdma_csr, 0);
    337       1.1      matt 		desc_write(&dp->sdma_cnt, 0);
    338       1.1      matt 		desc_write(&dp->sdma_bufp, (u_int32_t)&ptxp->txbuf);
    339       1.1      matt 		desc_write(&dp->sdma_next, (u_int32_t)&next_ptxp->txdesc);
    340       1.1      matt 		GTMPSC_CACHE_FLUSH(dp);
    341       1.1      matt 		vtxp++;
    342       1.1      matt 		ptxp++;
    343       1.1      matt 		next_ptxp++;
    344       1.1      matt 	}
    345       1.1      matt 	dp = &vtxp->txdesc;
    346       1.1      matt 	desc_write(&dp->sdma_csr, 0);
    347       1.1      matt 	desc_write(&dp->sdma_cnt, 0);
    348       1.1      matt 	desc_write(&dp->sdma_bufp, (u_int32_t)&ptxp->txbuf);
    349       1.1      matt 	desc_write(&dp->sdma_next, (u_int32_t)&first_ptxp->txdesc);
    350       1.1      matt 	GTMPSC_CACHE_FLUSH(dp);
    351       1.1      matt }
    352       1.1      matt 
    353       1.1      matt /*
    354       1.1      matt  * gtmpsc_rxdesc_init - set up RX descriptor ring
    355       1.1      matt  */
    356       1.1      matt STATIC void
    357       1.1      matt gtmpsc_rxdesc_init(gtmpsc_poll_sdma_t *vmps, gtmpsc_poll_sdma_t *pmps)
    358       1.1      matt {
    359       1.1      matt 	int n;
    360       1.1      matt 	sdma_desc_t *dp;
    361       1.1      matt 	gtmpsc_pollrx_t *vrxp;
    362       1.1      matt 	gtmpsc_pollrx_t *prxp;
    363       1.1      matt 	gtmpsc_pollrx_t *next_prxp;
    364       1.1      matt 	gtmpsc_pollrx_t *first_prxp;
    365       1.1      matt 	unsigned int csr;
    366       1.1      matt 
    367       1.1      matt 	csr = SDMA_CSR_RX_L|SDMA_CSR_RX_F|SDMA_CSR_RX_OWN|SDMA_CSR_RX_EI;
    368       1.1      matt 	first_prxp = prxp = &pmps->rx[0];
    369       1.1      matt 	vrxp = &vmps->rx[0];
    370       1.1      matt 	next_prxp = prxp + 1;
    371       1.1      matt 	for (n = (GTMPSC_NRXDESC - 1); n--; ) {
    372       1.1      matt 		dp = &vrxp->rxdesc;
    373       1.1      matt 		desc_write(&dp->sdma_csr, csr);
    374       1.1      matt 		desc_write(&dp->sdma_cnt,
    375       1.1      matt 			GTMPSC_RXBUFSZ << SDMA_RX_CNT_BUFSZ_SHIFT);
    376       1.1      matt 		desc_write(&dp->sdma_bufp, (u_int32_t)&prxp->rxbuf);
    377       1.1      matt 		desc_write(&dp->sdma_next, (u_int32_t)&next_prxp->rxdesc);
    378       1.1      matt 		GTMPSC_CACHE_FLUSH(dp);
    379       1.1      matt 		vrxp++;
    380       1.1      matt 		prxp++;
    381       1.1      matt 		next_prxp++;
    382       1.1      matt 	}
    383       1.1      matt 	dp = &vrxp->rxdesc;
    384       1.1      matt 	desc_write(&dp->sdma_csr, SDMA_CSR_RX_OWN);
    385       1.1      matt 	desc_write(&dp->sdma_cnt,
    386       1.1      matt 		GTMPSC_RXBUFSZ << SDMA_RX_CNT_BUFSZ_SHIFT);
    387       1.1      matt 	desc_write(&dp->sdma_bufp, (u_int32_t)&prxp->rxbuf);
    388       1.1      matt 	desc_write(&dp->sdma_next, (u_int32_t)&first_prxp->rxdesc);
    389       1.1      matt 	GTMPSC_CACHE_FLUSH(dp);
    390       1.1      matt }
    391       1.1      matt 
    392       1.1      matt /*
    393       1.1      matt  * Compute the BRG countdown value (CDV in BRG_BCR)
    394       1.1      matt  */
    395       1.1      matt 
    396       1.1      matt STATIC int
    397       1.1      matt compute_cdv(unsigned int baud)
    398       1.1      matt {
    399       1.1      matt 	unsigned int    cdv;
    400       1.1      matt 
    401       1.1      matt 	if (baud == 0)
    402       1.1      matt 		return 0;
    403       1.4      matt 	cdv = (GT_MPSC_FREQUENCY / (baud * GTMPSC_CLOCK_DIVIDER) + 1) / 2 - 1;
    404       1.1      matt 	if (cdv > BRG_BCR_CDV_MAX)
    405       1.1      matt 		return -1;
    406       1.1      matt 	return cdv;
    407       1.1      matt }
    408       1.1      matt 
    409       1.1      matt STATIC void
    410       1.1      matt gtmpsc_loadchannelregs(struct gtmpsc_softc *sc)
    411       1.1      matt {
    412       1.1      matt 	u_int   brg_bcr;
    413       1.1      matt 	u_int   unit;
    414       1.1      matt 
    415       1.1      matt 	unit = sc->gtmpsc_unit;
    416       1.1      matt 	brg_bcr = unit ? BRG_BCR1 : BRG_BCR0;
    417       1.1      matt 
    418       1.3      matt 	GT_WRITE(sc, brg_bcr, sc->gtmpsc_brg_bcr);
    419       1.3      matt 	GT_WRITE(sc, GTMPSC_U_CHRN(unit, 3), sc->gtmpsc_chr3);
    420       1.1      matt }
    421       1.1      matt 
    422       1.1      matt STATIC int
    423       1.1      matt gtmpscmatch(struct device *parent, struct cfdata *self, void *aux)
    424       1.1      matt {
    425  1.14.4.1    rpaulo 	struct gt_softc *gt = device_private(parent);
    426       1.1      matt 	struct gt_attach_args *ga = aux;
    427       1.1      matt 
    428       1.3      matt 	return GT_MPSCOK(gt, ga, &gtmpsc_cd);
    429       1.1      matt }
    430       1.1      matt 
    431       1.1      matt STATIC void
    432       1.1      matt gtmpscattach(struct device *parent, struct device *self, void *aux)
    433       1.1      matt {
    434       1.1      matt 	struct gt_attach_args *ga = aux;
    435  1.14.4.1    rpaulo 	struct gt_softc *gt = device_private(parent);
    436  1.14.4.1    rpaulo 	struct gtmpsc_softc *sc = device_private(self);
    437       1.1      matt 	gtmpsc_poll_sdma_t *vmps;
    438       1.1      matt 	gtmpsc_poll_sdma_t *pmps;
    439       1.1      matt 	struct tty *tp;
    440       1.1      matt 	caddr_t kva;
    441       1.1      matt 	int rsegs;
    442       1.1      matt 	int err;
    443       1.1      matt 	int s;
    444       1.5      matt 	int is_console = 0;
    445       1.1      matt 
    446       1.1      matt 	DPRINTF(("mpscattach\n"));
    447       1.3      matt 
    448       1.3      matt 	GT_MPSCFOUND(gt, ga);
    449       1.1      matt 
    450       1.1      matt 	s = splhigh();
    451       1.1      matt 
    452       1.1      matt 	sc->gtmpsc_memt = ga->ga_memt;
    453       1.3      matt 	sc->gtmpsc_memh = ga->ga_memh;
    454       1.1      matt 	sc->gtmpsc_dmat = ga->ga_dmat;
    455       1.1      matt 	sc->gtmpsc_unit = ga->ga_unit;
    456       1.1      matt 
    457       1.4      matt 	aprint_normal(": SDMA");
    458       1.6   thorpej 	err = bus_dmamem_alloc(sc->gtmpsc_dmat, PAGE_SIZE, PAGE_SIZE, PAGE_SIZE,
    459       1.4      matt 	    sc->gtmpsc_dma_segs, 1, &rsegs, BUS_DMA_NOWAIT|BUS_DMA_ALLOCNOW);
    460       1.1      matt 	if (err) {
    461       1.1      matt 		PRINTF(("mpscattach: bus_dmamem_alloc error 0x%x\n", err));
    462       1.1      matt 		splx(s);
    463       1.1      matt 		return;
    464       1.1      matt 	}
    465       1.1      matt #ifndef SDMA_COHERENT
    466       1.6   thorpej 	err = bus_dmamem_map(sc->gtmpsc_dmat, sc->gtmpsc_dma_segs, 1, PAGE_SIZE,
    467       1.4      matt 	    &kva, BUS_DMA_NOWAIT);
    468       1.1      matt #else
    469       1.6   thorpej 	err = bus_dmamem_map(sc->gtmpsc_dmat, sc->gtmpsc_dma_segs, 1, PAGE_SIZE,
    470       1.4      matt 	    &kva, BUS_DMA_NOWAIT|BUS_DMA_NOCACHE);
    471       1.1      matt #endif
    472       1.1      matt 	if (err) {
    473       1.1      matt 		PRINTF(("mpscattach: bus_dmamem_map error 0x%x\n", err));
    474       1.1      matt 		splx(s);
    475       1.1      matt 		return;
    476       1.1      matt 	}
    477       1.1      matt 
    478       1.6   thorpej 	err = bus_dmamap_create(sc->gtmpsc_dmat, PAGE_SIZE, 1, PAGE_SIZE,
    479       1.6   thorpej 	    PAGE_SIZE, BUS_DMA_NOWAIT|BUS_DMA_ALLOCNOW, &sc->gtmpsc_dma_map);
    480       1.4      matt 	if (err) {
    481       1.4      matt 		PRINTF(("mpscattach: bus_dmamap_create error 0x%x\n", err));
    482       1.4      matt 		splx(s);
    483       1.4      matt 		return;
    484       1.4      matt 	}
    485       1.4      matt 
    486       1.6   thorpej 	err = bus_dmamap_load(sc->gtmpsc_dmat, sc->gtmpsc_dma_map, kva,
    487       1.6   thorpej 	    PAGE_SIZE, NULL, 0);
    488       1.4      matt 	if (err) {
    489       1.4      matt 		PRINTF(("mpscattach: bus_dmamap_load error 0x%x\n", err));
    490       1.4      matt 		splx(s);
    491       1.4      matt 		return;
    492       1.4      matt 	}
    493       1.6   thorpej 	memset(kva, 0, PAGE_SIZE);	/* paranoid/superfluous */
    494       1.1      matt 
    495       1.1      matt 	vmps = (gtmpsc_poll_sdma_t *)kva;				    /* KVA */
    496       1.4      matt 	pmps = (gtmpsc_poll_sdma_t *)sc->gtmpsc_dma_map->dm_segs[0].ds_addr;    /* PA */
    497       1.5      matt #if defined(DEBUG)
    498       1.1      matt 	printf(" at %p/%p", vmps, pmps);
    499       1.1      matt #endif
    500       1.1      matt 	gtmpsc_txdesc_init(vmps, pmps);
    501       1.1      matt 	gtmpsc_rxdesc_init(vmps, pmps);
    502       1.1      matt 	sc->gtmpsc_poll_sdmapage = vmps;
    503       1.1      matt 
    504       1.1      matt 	if (gtmpsc_scp[sc->gtmpsc_unit] != NULL)
    505       1.1      matt 		gtmpsc_txflush(gtmpsc_scp[sc->gtmpsc_unit]);
    506       1.1      matt 
    507       1.1      matt 	sc->gtmpsc_tty = tp = ttymalloc();
    508       1.1      matt 	tp->t_oproc = gtmpscstart;
    509       1.1      matt 	tp->t_param = gtmpscparam;
    510       1.1      matt 	tty_attach(tp);
    511       1.1      matt 
    512       1.3      matt 	if (gtmpsc_sdma_ih == NULL) {
    513       1.3      matt 		gtmpsc_sdma_ih = intr_establish(IRQ_SDMA, IST_LEVEL, IPL_SERIAL,
    514       1.1      matt 			gtmpsc_intr, &sc);
    515       1.3      matt 		if (gtmpsc_sdma_ih == NULL)
    516       1.1      matt 			panic("mpscattach: cannot intr_establish IRQ_SDMA");
    517       1.3      matt 	}
    518       1.1      matt 
    519       1.3      matt 	sc->sc_si = softintr_establish(IPL_SOFTSERIAL, gtmpsc_softintr, sc);
    520       1.3      matt 	if (sc->sc_si == NULL)
    521       1.3      matt 		panic("mpscattach: cannot softintr_establish IPL_SOFTSERIAL");
    522       1.1      matt 
    523       1.1      matt 	shutdownhook_establish(gtmpsc_shutdownhook, sc);
    524       1.1      matt 
    525       1.5      matt 	gtmpsc_scp[sc->gtmpsc_unit] = sc;
    526       1.5      matt 	gtmpscinit(sc);
    527       1.5      matt 
    528       1.5      matt 	if (cn_tab == &gtmpsc_consdev &&
    529       1.5      matt 	    cn_tab->cn_dev == makedev(0, sc->gtmpsc_unit)) {
    530       1.5      matt 		cn_tab->cn_dev = makedev(cdevsw_lookup_major(&gtmpsc_cdevsw),
    531  1.14.4.1    rpaulo 		    device_unit(&sc->gtmpsc_dev));
    532       1.5      matt 		is_console = 1;
    533       1.5      matt 	}
    534       1.5      matt 
    535       1.5      matt 	aprint_normal(" irq %s%s\n",
    536       1.5      matt 	    intr_string(IRQ_SDMA),
    537       1.5      matt 	    (gt_reva_gtmpsc_bug) ? " [Rev A. bug]" : "");
    538       1.5      matt 
    539       1.5      matt 	if (is_console)
    540       1.5      matt 		aprint_normal("%s: console\n", sc->gtmpsc_dev.dv_xname);
    541       1.5      matt 
    542       1.1      matt #ifdef DDB
    543       1.5      matt 	if (is_console == 0)
    544       1.3      matt 		SDMA_IMASK_ENABLE(sc, SDMA_INTR_RXBUF(sc->gtmpsc_unit));
    545       1.1      matt #endif	/* DDB */
    546       1.1      matt 
    547       1.1      matt 	splx(s);
    548       1.1      matt #ifdef KGDB
    549       1.1      matt 	/*
    550       1.1      matt 	 * Allow kgdb to "take over" this port.  If this is
    551       1.1      matt 	 * the kgdb device, it has exclusive use.
    552       1.1      matt 	 */
    553       1.1      matt 	if (sc->gtmpsc_unit == comkgdbport) {
    554       1.1      matt 		if (comkgdbport == 0) { /* FIXME */
    555       1.1      matt 			printf("%s(kgdb): cannot share with console\n",
    556       1.1      matt 				sc->gtmpsc_dev.dv_xname);
    557       1.1      matt 			return;
    558       1.1      matt 		}
    559       1.1      matt 
    560       1.1      matt 		sc->gtmpsc_flags |= GTMPSCF_KGDB;
    561       1.1      matt 		printf("%s: kgdb\n", sc->gtmpsc_dev.dv_xname);
    562       1.1      matt 		gtmpsc_txflush(gtmpsc_scp[0]);
    563       1.1      matt 		kgdb_attach(gtmpsc_kgdb_getc, gtmpsc_kgdb_putc, NULL);
    564       1.1      matt 		kgdb_dev = 123; /* unneeded, only to satisfy some tests */
    565       1.1      matt 		gtmpsc_kgdb_attached = 1;
    566       1.3      matt 		SDMA_IMASK_ENABLE(sc, SDMA_INTR_RXBUF(sc->gtmpsc_unit));
    567       1.1      matt 		kgdb_connect(1);
    568       1.1      matt 	}
    569       1.1      matt #endif /* KGDB */
    570       1.1      matt }
    571       1.1      matt 
    572       1.1      matt STATIC void
    573       1.1      matt gtmpscshutdown(struct gtmpsc_softc *sc)
    574       1.1      matt {
    575       1.1      matt 	struct tty *tp;
    576       1.1      matt 	int     s;
    577       1.1      matt 
    578       1.1      matt #ifdef KGDB
    579       1.1      matt 	if (sc->gtmpsc_flags & GTMPSCF_KGDB != 0)
    580       1.1      matt 		return;
    581       1.1      matt #endif
    582       1.1      matt 	tp = sc->gtmpsc_tty;
    583       1.1      matt 	s = splserial();
    584       1.1      matt 	/* Fake carrier off */
    585       1.1      matt 	(void) (*tp->t_linesw->l_modem)(tp, 0);
    586       1.3      matt 	SDMA_IMASK_DISABLE(sc, SDMA_INTR_RXBUF(sc->gtmpsc_unit));
    587       1.1      matt 	splx(s);
    588       1.1      matt }
    589       1.1      matt 
    590       1.1      matt int
    591      1.13  christos gtmpscopen(dev_t dev, int flag, int mode, struct lwp *l)
    592       1.1      matt {
    593       1.1      matt 	struct gtmpsc_softc *sc;
    594       1.1      matt 	int unit = GTMPSCUNIT(dev);
    595       1.1      matt 	struct tty *tp;
    596       1.1      matt 	int s;
    597       1.1      matt 	int s2;
    598       1.1      matt 	int error;
    599      1.10     perry 
    600       1.1      matt 	if (unit >= gtmpsc_cd.cd_ndevs)
    601       1.1      matt 		return ENXIO;
    602       1.1      matt 	sc = gtmpsc_cd.cd_devs[unit];
    603       1.1      matt 	if (!sc)
    604       1.1      matt 		return ENXIO;
    605       1.1      matt #ifdef KGDB
    606       1.1      matt 	/*
    607       1.1      matt 	 * If this is the kgdb port, no other use is permitted.
    608       1.1      matt 	 */
    609       1.1      matt 	if (sc->gtmpsc_flags & GTMPSCF_KGDB != 0)
    610       1.1      matt 		return (EBUSY);
    611       1.1      matt #endif
    612       1.1      matt 	tp = sc->gtmpsc_tty;
    613       1.1      matt 	if (ISSET(tp->t_state, TS_ISOPEN) &&
    614       1.1      matt 	    ISSET(tp->t_state, TS_XCLUDE) &&
    615  1.14.4.1    rpaulo 	    kauth_authorize_generic(l->l_cred,
    616  1.14.4.1    rpaulo 	    KAUTH_GENERIC_ISSUSER, &l->l_acflag) != 0)
    617       1.1      matt 		return (EBUSY);
    618       1.1      matt 
    619       1.1      matt 	s = spltty();
    620       1.1      matt 
    621       1.1      matt 	if (!(tp->t_state & TS_ISOPEN)) {
    622       1.1      matt 		struct termios t;
    623       1.1      matt 
    624       1.1      matt 		tp->t_dev = dev;
    625       1.1      matt 		s2 = splserial();
    626       1.3      matt 		SDMA_IMASK_ENABLE(sc, SDMA_INTR_RXBUF(unit));
    627       1.1      matt 		splx(s2);
    628       1.1      matt 		t.c_ispeed = 0;
    629       1.1      matt #if 0
    630       1.1      matt 		t.c_ospeed = TTYDEF_SPEED;
    631       1.1      matt #else
    632       1.1      matt 		t.c_ospeed = GT_MPSC_DEFAULT_BAUD_RATE;
    633       1.1      matt #endif
    634       1.1      matt 		t.c_cflag = TTYDEF_CFLAG;
    635       1.1      matt 		/* Make sure gtmpscparam() will do something. */
    636       1.1      matt 		tp->t_ospeed = 0;
    637       1.1      matt 		(void) gtmpscparam(tp, &t);
    638       1.1      matt 		tp->t_iflag = TTYDEF_IFLAG;
    639       1.1      matt 		tp->t_oflag = TTYDEF_OFLAG;
    640       1.1      matt 		tp->t_lflag = TTYDEF_LFLAG;
    641       1.1      matt 		ttychars(tp);
    642       1.1      matt 		ttsetwater(tp);
    643       1.1      matt 		s2 = splserial();
    644       1.1      matt 		/* Clear the input ring */
    645       1.1      matt 		sc->gtmpsc_rxfifo_putix = 0;
    646       1.1      matt 		sc->gtmpsc_rxfifo_getix = 0;
    647       1.1      matt 		sc->gtmpsc_rxfifo_navail = GTMPSC_RXFIFOSZ;
    648       1.1      matt 		gtmpsc_iflush(sc);
    649       1.1      matt 		splx(s2);
    650       1.1      matt 	}
    651       1.1      matt 	splx(s);
    652       1.1      matt 	error = ttyopen(tp, GTMPSCDIALOUT(dev), ISSET(flag, O_NONBLOCK));
    653       1.1      matt 	if (error)
    654       1.1      matt 		goto bad;
    655       1.1      matt 
    656       1.1      matt 	error = (*tp->t_linesw->l_open)(dev, tp);
    657       1.1      matt 	if (error)
    658       1.1      matt 		goto bad;
    659       1.1      matt 
    660       1.1      matt 	return (0);
    661       1.1      matt 
    662       1.1      matt bad:
    663       1.1      matt 	if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
    664       1.1      matt 		/*
    665       1.1      matt 		 * We failed to open the device, and nobody else had it opened.
    666       1.1      matt 		 * Clean up the state as appropriate.
    667       1.1      matt 		 */
    668       1.1      matt 		gtmpscshutdown(sc);
    669       1.1      matt 	}
    670       1.1      matt 
    671       1.1      matt 	return (error);
    672       1.1      matt }
    673       1.1      matt 
    674       1.1      matt int
    675      1.13  christos gtmpscclose(dev_t dev, int flag, int mode, struct lwp *l)
    676       1.1      matt {
    677       1.1      matt 	int unit = GTMPSCUNIT(dev);
    678       1.1      matt 	struct gtmpsc_softc *sc = gtmpsc_cd.cd_devs[unit];
    679       1.1      matt 	struct tty *tp = sc->gtmpsc_tty;
    680       1.1      matt 	int s;
    681       1.1      matt 
    682       1.1      matt 	s = splserial();
    683       1.1      matt 	if (!ISSET(tp->t_state, TS_ISOPEN)) {
    684       1.1      matt 		splx(s);
    685       1.1      matt 		return (0);
    686       1.1      matt 	}
    687       1.1      matt 
    688       1.1      matt 	(*tp->t_linesw->l_close)(tp, flag);
    689       1.1      matt 	ttyclose(tp);
    690       1.1      matt 	if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
    691       1.1      matt 		/*
    692       1.1      matt 		 * Although we got a last close, the device may still be in
    693       1.1      matt 		 * use; e.g. if this was the dialout node, and there are still
    694       1.1      matt 		 * processes waiting for carrier on the non-dialout node.
    695       1.1      matt 		 */
    696       1.1      matt 		gtmpscshutdown(sc);
    697       1.1      matt 	}
    698       1.1      matt 
    699       1.1      matt 	splx(s);
    700       1.1      matt 	return (0);
    701       1.1      matt }
    702       1.1      matt 
    703       1.1      matt int
    704       1.1      matt gtmpscread(dev_t dev, struct uio *uio, int flag)
    705       1.1      matt {
    706       1.1      matt 	struct gtmpsc_softc *sc = gtmpsc_cd.cd_devs[GTMPSCUNIT(dev)];
    707       1.1      matt 	struct tty *tp = sc->gtmpsc_tty;
    708      1.10     perry 
    709       1.1      matt 	return (*tp->t_linesw->l_read)(tp, uio, flag);
    710       1.1      matt }
    711       1.1      matt 
    712       1.1      matt int
    713       1.1      matt gtmpscwrite(dev_t dev, struct uio *uio, int flag)
    714       1.1      matt {
    715       1.1      matt 	struct gtmpsc_softc *sc = gtmpsc_cd.cd_devs[GTMPSCUNIT(dev)];
    716       1.1      matt 	struct tty *tp = sc->gtmpsc_tty;
    717      1.10     perry 
    718       1.1      matt 	return (*tp->t_linesw->l_write)(tp, uio, flag);
    719       1.1      matt }
    720       1.1      matt 
    721       1.1      matt int
    722      1.13  christos gtmpscpoll(dev_t dev, int events, struct lwp *l)
    723       1.1      matt {
    724       1.1      matt 	struct gtmpsc_softc *sc = gtmpsc_cd.cd_devs[GTMPSCUNIT(dev)];
    725       1.1      matt 	struct tty *tp = sc->gtmpsc_tty;
    726       1.1      matt 
    727      1.13  christos 	return ((*tp->t_linesw->l_poll)(tp, events, l));
    728       1.1      matt }
    729       1.1      matt 
    730       1.1      matt int
    731      1.13  christos gtmpscioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct lwp *l)
    732       1.1      matt {
    733       1.1      matt 	struct gtmpsc_softc *sc = gtmpsc_cd.cd_devs[GTMPSCUNIT(dev)];
    734       1.1      matt 	struct tty *tp = sc->gtmpsc_tty;
    735       1.1      matt 	int error;
    736      1.10     perry 
    737      1.13  christos 	if ((error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, l)) >= 0)
    738       1.1      matt 		return error;
    739      1.13  christos 	if ((error = ttioctl(tp, cmd, data, flag, l)) >= 0)
    740       1.1      matt 		return error;
    741       1.1      matt 	return ENOTTY;
    742       1.1      matt }
    743       1.1      matt 
    744       1.1      matt struct tty *
    745       1.1      matt gtmpsctty(dev_t dev)
    746       1.1      matt {
    747       1.1      matt 	struct gtmpsc_softc *sc = gtmpsc_cd.cd_devs[GTMPSCUNIT(dev)];
    748       1.1      matt 
    749       1.1      matt 	return sc->gtmpsc_tty;
    750       1.1      matt }
    751       1.1      matt 
    752       1.1      matt void
    753       1.1      matt gtmpscstop(struct tty *tp, int flag)
    754       1.1      matt {
    755       1.1      matt }
    756       1.1      matt 
    757       1.1      matt STATIC void
    758       1.1      matt gtmpscstart(struct tty *tp)
    759       1.1      matt {
    760       1.4      matt 	struct gtmpsc_softc *sc;
    761       1.1      matt 	unsigned char *tba;
    762       1.1      matt 	unsigned int unit;
    763       1.1      matt 	int s, s2, tbc;
    764       1.1      matt 
    765       1.1      matt 	unit = GTMPSCUNIT(tp->t_dev);
    766       1.4      matt 	sc = gtmpsc_cd.cd_devs[unit];
    767       1.1      matt 	if (sc == NULL)
    768       1.1      matt 		return;
    769       1.1      matt 
    770       1.1      matt 	s = spltty();
    771       1.1      matt 	if (tp->t_state & (TS_TIMEOUT | TS_BUSY | TS_TTSTOP))
    772       1.1      matt 		goto out;
    773       1.1      matt 	if (sc->sc_tx_stopped)
    774       1.1      matt 		goto out;
    775       1.1      matt 	if (tp->t_outq.c_cc <= tp->t_lowat) {
    776       1.1      matt 		if ((tp->t_state & TS_ASLEEP) != 0) {
    777       1.1      matt 			tp->t_state &= ~TS_ASLEEP;
    778       1.1      matt 			wakeup(&tp->t_outq);
    779       1.1      matt 		}
    780       1.1      matt 		selwakeup(&tp->t_wsel);
    781       1.1      matt 		if (tp->t_outq.c_cc == 0)
    782       1.1      matt 			goto out;
    783       1.1      matt 	}
    784       1.1      matt 
    785       1.1      matt 	/* Grab the first contiguous region of buffer space. */
    786       1.1      matt 	tba = tp->t_outq.c_cf;
    787       1.1      matt 	tbc = ndqb(&tp->t_outq, 0);
    788       1.1      matt 
    789       1.1      matt 	s2 = splserial();
    790       1.1      matt 
    791       1.1      matt 	sc->sc_tba = tba;
    792       1.1      matt 	sc->sc_tbc = tbc;
    793       1.1      matt 	sc->cnt_tx_from_ldisc += tbc;
    794       1.3      matt 	SDMA_IMASK_ENABLE(sc, SDMA_INTR_TXBUF(unit));
    795       1.1      matt 	tp->t_state |= TS_BUSY;
    796       1.1      matt 	sc->sc_tx_busy = 1;
    797       1.1      matt 	gtmpsc_common_putn(sc);
    798       1.1      matt 
    799       1.1      matt 	splx(s2);
    800       1.1      matt out:
    801       1.1      matt 	splx(s);
    802       1.1      matt }
    803       1.1      matt 
    804       1.1      matt STATIC int
    805       1.1      matt gtmpscparam(struct tty *tp, struct termios *t)
    806       1.1      matt {
    807       1.1      matt 	struct gtmpsc_softc *sc = gtmpsc_cd.cd_devs[GTMPSCUNIT(tp->t_dev)];
    808       1.1      matt 	int ospeed = compute_cdv(t->c_ospeed);
    809       1.1      matt 	int s;
    810       1.1      matt 
    811       1.1      matt 	/* Check requested parameters. */
    812       1.1      matt 	if (ospeed < 0)
    813       1.1      matt 		return (EINVAL);
    814       1.1      matt 	if (t->c_ispeed && t->c_ispeed != t->c_ospeed)
    815       1.1      matt 		return (EINVAL);
    816       1.1      matt 
    817       1.1      matt 	/*
    818       1.1      matt 	 * If there were no changes, don't do anything.  This avoids dropping
    819       1.1      matt 	 * input and improves performance when all we did was frob things like
    820       1.1      matt 	 * VMIN and VTIME.
    821       1.1      matt 	 */
    822       1.1      matt 	if (tp->t_ospeed == t->c_ospeed &&
    823       1.1      matt 	    tp->t_cflag == t->c_cflag)
    824       1.1      matt 		return (0);
    825       1.1      matt 
    826       1.1      matt 	s = splserial();
    827       1.1      matt 
    828       1.4      matt 	sc->gtmpsc_brg_bcr = BRG_BCR_EN | GT_MPSC_CLOCK_SOURCE | ospeed;
    829       1.1      matt 	sc->gtmpsc_chr3 = GTMPSC_MAXIDLE(t->c_ospeed);
    830       1.1      matt 
    831       1.1      matt 	/* And copy to tty. */
    832       1.1      matt 	tp->t_ispeed = 0;
    833       1.1      matt 	tp->t_ospeed = t->c_ospeed;
    834       1.1      matt 	tp->t_cflag = t->c_cflag;
    835       1.1      matt 
    836       1.1      matt 	if (!sc->sc_heldchange) {
    837       1.1      matt 		if (sc->sc_tx_busy) {
    838       1.1      matt 			sc->sc_heldtbc = sc->sc_tbc;
    839       1.1      matt 			sc->sc_tbc = 0;
    840       1.1      matt 			sc->sc_heldchange = 1;
    841       1.1      matt 		} else
    842       1.1      matt 			gtmpsc_loadchannelregs(sc);
    843       1.1      matt 	}
    844       1.1      matt 
    845       1.1      matt 	splx(s);
    846       1.1      matt 
    847       1.1      matt 	/* Fake carrier on */
    848       1.1      matt 	(void) (*tp->t_linesw->l_modem)(tp, 1);
    849       1.1      matt 
    850       1.1      matt 	return 0;
    851       1.1      matt }
    852       1.1      matt 
    853       1.1      matt STATIC int
    854       1.1      matt gtmpsc_probe(void)
    855       1.1      matt {
    856       1.1      matt 	return 1;		/* XXX */
    857       1.1      matt }
    858       1.1      matt 
    859       1.1      matt STATIC unsigned int
    860       1.1      matt gtmpsc_get_causes(void)
    861       1.1      matt {
    862       1.1      matt 	int                     i;
    863       1.1      matt 	struct gtmpsc_softc       *sc;
    864       1.1      matt 	unsigned int            cause = 0;
    865       1.1      matt 	static unsigned int     bits[4] = {
    866       1.1      matt 				SDMA_INTR_RXBUF(0),
    867       1.1      matt 				SDMA_INTR_TXBUF(0),
    868       1.1      matt 				SDMA_INTR_RXBUF(1),
    869       1.1      matt 				SDMA_INTR_TXBUF(1),
    870       1.1      matt 	};
    871       1.1      matt 	sdma_desc_t             *desc_addr[4];
    872       1.1      matt 	static unsigned int     fake_once = SDMA_INTR_RXBUF(0)
    873       1.1      matt 						| SDMA_INTR_RXBUF(1);
    874       1.1      matt 
    875       1.1      matt 	desc_addr[0] = 0;
    876       1.1      matt 	desc_addr[1] = 0;
    877       1.1      matt 	desc_addr[2] = 0;
    878       1.1      matt 	desc_addr[3] = 0;
    879       1.1      matt 	sc = gtmpsc_cd.cd_devs[0];
    880       1.1      matt 	if (sc != 0) {
    881       1.1      matt 	    if (sdma_imask & SDMA_INTR_RXBUF(0)) {
    882       1.1      matt 		desc_addr[0] =
    883       1.1      matt 		    &sc->gtmpsc_poll_sdmapage->rx[sc->gtmpsc_poll_rxix].rxdesc;
    884       1.1      matt 		    GTMPSC_CACHE_INVALIDATE(desc_addr[0]);
    885      1.14     perry 		    __asm volatile ("dcbt 0,%0" :: "r"(desc_addr[0]));
    886       1.1      matt 	    }
    887       1.1      matt 	    if (sdma_imask & SDMA_INTR_TXBUF(0)) {
    888       1.1      matt 		desc_addr[1] =
    889       1.1      matt 		    &sc->gtmpsc_poll_sdmapage->tx[sc->gtmpsc_poll_txix].txdesc;
    890       1.1      matt 		    GTMPSC_CACHE_INVALIDATE(desc_addr[1]);
    891      1.14     perry 		    __asm volatile ("dcbt 0,%0" :: "r"(desc_addr[1]));
    892       1.1      matt 	    }
    893       1.1      matt 	}
    894       1.1      matt 	sc = gtmpsc_cd.cd_devs[1];
    895       1.1      matt 	if (sc != 0) {
    896       1.1      matt 	    if (sdma_imask & SDMA_INTR_RXBUF(1)) {
    897       1.1      matt 		desc_addr[2] =
    898       1.1      matt 		    &sc->gtmpsc_poll_sdmapage->rx[sc->gtmpsc_poll_rxix].rxdesc;
    899       1.1      matt 		    GTMPSC_CACHE_INVALIDATE(desc_addr[2]);
    900      1.14     perry 		    __asm volatile ("dcbt 0,%0" :: "r"(desc_addr[2]));
    901       1.1      matt 	    }
    902       1.1      matt 	    if (sdma_imask & SDMA_INTR_TXBUF(1)) {
    903       1.1      matt 		desc_addr[3] =
    904       1.1      matt 		    &sc->gtmpsc_poll_sdmapage->tx[sc->gtmpsc_poll_txix].txdesc;
    905       1.1      matt 		    GTMPSC_CACHE_INVALIDATE(desc_addr[3]);
    906      1.14     perry 		    __asm volatile ("dcbt 0,%0" :: "r"(desc_addr[3]));
    907       1.1      matt 	    }
    908       1.1      matt 	}
    909       1.1      matt 
    910       1.1      matt 	for (i = 0; i < 4; ++i)
    911       1.1      matt 		if ((sdma_imask & bits[i]) && desc_addr[i] != 0 &&
    912       1.1      matt 			    (desc_addr[i]->sdma_csr & SDMA_CSR_TX_OWN) == 0)
    913       1.1      matt 			cause |= bits[i];
    914       1.1      matt 	if (fake_once & sdma_imask) {
    915       1.1      matt 		cause |= fake_once & sdma_imask;
    916       1.1      matt 	/*	fake_once &= ~(cause & fake_once); */
    917       1.1      matt 	}
    918       1.1      matt 	return cause;
    919       1.1      matt }
    920       1.1      matt 
    921       1.1      matt STATIC int
    922       1.1      matt gtmpsc_intr(void *arg)
    923       1.1      matt {
    924       1.1      matt 	struct gtmpsc_softc       *sc;
    925       1.1      matt 	unsigned int            unit;
    926       1.1      matt 	int                     spurious = 1;
    927       1.1      matt 	unsigned int            r;
    928       1.1      matt 	unsigned int            cause=0;
    929       1.1      matt 
    930       1.1      matt 	if (gt_reva_gtmpsc_bug)
    931       1.1      matt 		cause = gtmpsc_get_causes();
    932       1.1      matt 
    933       1.1      matt #ifdef KGDB
    934       1.1      matt 	if (kgdb_break_immediate) {
    935       1.1      matt 		unit = comkgdbport;
    936       1.1      matt 		sc = gtmpsc_cd.cd_devs[unit];
    937       1.1      matt 		if (sc == 0 || (sc->gtmpsc_flags & GTMPSCF_KGDB) == 0)
    938       1.1      matt 			goto skip_kgdb;
    939       1.1      matt 		if (gt_reva_gtmpsc_bug)
    940       1.1      matt 			r = cause & sdma_imask;
    941       1.1      matt 		else {
    942       1.3      matt 			r = GT_READ(sc, SDMA_ICAUSE);
    943       1.3      matt 			r &= GT_READ(sc, SDMA_IMASK);
    944       1.1      matt 		}
    945       1.1      matt 		r &= SDMA_INTR_RXBUF(unit);
    946       1.1      matt 		if (r == 0)
    947       1.1      matt 			goto skip_kgdb;
    948       1.3      matt 		GT_WRITE(sc, SDMA_ICAUSE, ~r);
    949       1.1      matt 		spurious = 0;
    950       1.1      matt 		gtmpsc_kgdb_poll(sc);
    951       1.1      matt 	}
    952       1.1      matt skip_kgdb:
    953       1.1      matt #endif
    954       1.1      matt 	for (unit = 0; unit < GTMPSC_NCHAN; ++unit) {
    955       1.1      matt 		sc = gtmpsc_cd.cd_devs[unit];
    956       1.1      matt 		if (sc == 0)
    957       1.1      matt 			continue;
    958       1.1      matt 		if (gt_reva_gtmpsc_bug)
    959       1.1      matt 			r = cause & sdma_imask;
    960       1.1      matt 		else {
    961       1.3      matt 			r = GT_READ(sc, SDMA_ICAUSE);
    962       1.3      matt 			r &= GT_READ(sc, SDMA_IMASK);
    963       1.1      matt 		}
    964       1.1      matt 		r &= SDMA_U_INTR_MASK(unit);
    965       1.1      matt 		if (r == 0)
    966       1.1      matt 			continue;
    967       1.3      matt 		GT_WRITE(sc, SDMA_ICAUSE, ~r);
    968       1.1      matt 		spurious = 0;
    969       1.1      matt 		if (r & SDMA_INTR_RXBUF(unit)) {
    970       1.1      matt #ifdef KGDB
    971       1.1      matt 			if (sc->gtmpsc_flags & GTMPSCF_KGDB)
    972       1.1      matt 				gtmpsc_kgdb_poll(sc);
    973       1.1      matt 			else
    974       1.1      matt #endif
    975       1.1      matt 				gtmpsc_poll(sc);
    976       1.1      matt 		}
    977       1.1      matt 		if (r & SDMA_INTR_TXBUF(unit)) {
    978       1.1      matt 			/*
    979       1.1      matt 			 * If we've delayed a parameter change, do it now,
    980       1.1      matt 			 * and restart output.
    981       1.1      matt 			 */
    982       1.1      matt 			if (sc->sc_heldchange) {
    983       1.1      matt 				gtmpsc_loadchannelregs(sc);
    984       1.1      matt 				sc->sc_heldchange = 0;
    985       1.1      matt 				sc->sc_tbc = sc->sc_heldtbc;
    986       1.1      matt 				sc->sc_heldtbc = 0;
    987       1.1      matt 			}
    988       1.1      matt 
    989       1.1      matt 			/* Output the next chunk of the contiguous buffer,
    990       1.1      matt 								if any. */
    991       1.1      matt 			if (sc->sc_tbc > 0)
    992       1.1      matt 				gtmpsc_common_putn(sc);
    993       1.1      matt 			if (sc->sc_tbc == 0 && sc->sc_tx_busy) {
    994       1.1      matt 				sc->sc_tx_busy = 0;
    995       1.1      matt 				sc->sc_tx_done = 1;
    996       1.3      matt 				softintr_schedule(sc->sc_si);
    997       1.3      matt 				SDMA_IMASK_DISABLE(sc, SDMA_INTR_TXBUF(unit));
    998       1.1      matt 			}
    999       1.1      matt 		}
   1000       1.1      matt 	}
   1001       1.1      matt 	return 1;
   1002       1.1      matt 	/* return !spurious; */
   1003       1.1      matt }
   1004       1.1      matt 
   1005       1.3      matt STATIC void
   1006       1.3      matt gtmpsc_softintr(void *arg)
   1007       1.1      matt {
   1008       1.3      matt 	struct gtmpsc_softc	*sc = arg;
   1009       1.1      matt 	struct tty              *tp;
   1010       1.2      matt 	int                     (*rint)(int, struct tty *);
   1011       1.1      matt 	int                     jobs;
   1012       1.1      matt 	int                     s;
   1013       1.1      matt 
   1014       1.3      matt 	tp = sc->gtmpsc_tty;
   1015       1.3      matt 	rint = tp->t_linesw->l_rint;
   1016       1.3      matt 	do {
   1017       1.3      matt 		jobs = 0;
   1018       1.3      matt 		if (sc->gtmpsc_rxfifo_navail < GTMPSC_RXFIFOSZ) {
   1019       1.1      matt 			s = spltty();
   1020       1.1      matt 			rint(sc->gtmpsc_rxfifo[sc->gtmpsc_rxfifo_getix++],
   1021       1.1      matt 								tp);
   1022       1.1      matt 			if (sc->gtmpsc_rxfifo_getix >= GTMPSC_RXFIFOSZ)
   1023       1.1      matt 				sc->gtmpsc_rxfifo_getix = 0;
   1024       1.1      matt 			++sc->cnt_rx_from_fifo;
   1025       1.1      matt 			/* atomic_add() returns the previous value */
   1026       1.1      matt 			jobs += atomic_add(&sc->gtmpsc_rxfifo_navail, 1) + 1
   1027       1.1      matt 								< GTMPSC_RXFIFOSZ;
   1028       1.1      matt 			splx(s);
   1029       1.3      matt 		}
   1030       1.3      matt 		if (sc->sc_tx_done) {
   1031       1.1      matt 			++jobs;
   1032       1.1      matt 			sc->sc_tx_done = 0;
   1033       1.1      matt 			s = spltty();
   1034       1.1      matt 			tp->t_state &= ~TS_BUSY;
   1035       1.1      matt 			if ((tp->t_state & TS_FLUSH) != 0)
   1036       1.1      matt 			    tp->t_state &= ~TS_FLUSH;
   1037       1.1      matt 			else
   1038       1.1      matt 			    ndflush(&tp->t_outq, (int)(sc->sc_tba - tp->t_outq.c_cf));
   1039       1.1      matt 			(*tp->t_linesw->l_start)(tp);
   1040       1.1      matt 			splx(s);
   1041       1.3      matt 		}
   1042       1.3      matt 	} while (jobs);
   1043       1.1      matt }
   1044       1.1      matt 
   1045       1.1      matt /*
   1046       1.1      matt  * Console support functions
   1047       1.1      matt  */
   1048       1.1      matt void
   1049       1.1      matt gtmpsccnprobe(struct consdev *cd)
   1050       1.1      matt {
   1051       1.1      matt 	int maj;
   1052       1.1      matt /* {extern void return_to_dink(int); return_to_dink(gtbase);} */
   1053       1.1      matt 
   1054       1.1      matt 	if (!gtmpsc_probe())
   1055       1.1      matt 		return;
   1056       1.1      matt 
   1057       1.1      matt 	maj = cdevsw_lookup_major(&gtmpsc_cdevsw);
   1058       1.1      matt 	cd->cn_dev = makedev(maj, 0);
   1059       1.1      matt 	cd->cn_pri = CN_INTERNAL;
   1060       1.1      matt }
   1061       1.1      matt 
   1062       1.1      matt /*
   1063       1.1      matt  * gtmpsc_hackinit - hacks required to supprt GTMPSC console
   1064       1.1      matt  */
   1065       1.1      matt STATIC void
   1066       1.3      matt gtmpsc_hackinit(struct gtmpsc_softc *sc, bus_space_tag_t memt,
   1067       1.3      matt 	bus_space_handle_t memh, int unit)
   1068       1.1      matt {
   1069       1.1      matt 	gtmpsc_poll_sdma_t *vmps;
   1070       1.1      matt 	gtmpsc_poll_sdma_t *pmps;
   1071       1.1      matt 
   1072       1.1      matt 	DPRINTF(("hackinit\n"));
   1073       1.1      matt 
   1074       1.1      matt 	bzero(sc, sizeof(struct gtmpsc_softc));
   1075       1.3      matt 	sc->gtmpsc_memt = memt;
   1076       1.3      matt 	sc->gtmpsc_memh = memh;
   1077       1.3      matt 	sc->gtmpsc_unit = unit;
   1078       1.1      matt 	gtmpsc_scp[sc->gtmpsc_unit] = sc;
   1079       1.1      matt 
   1080       1.1      matt 	vmps = (gtmpsc_poll_sdma_t *)gtmpsc_fake_dmapage;	/* KVA */
   1081       1.1      matt 	pmps = (gtmpsc_poll_sdma_t *)gtmpsc_fake_dmapage;	/* PA */
   1082       1.1      matt 
   1083       1.1      matt 	gtmpsc_txdesc_init(vmps, pmps);
   1084       1.1      matt 	gtmpsc_rxdesc_init(vmps, pmps);
   1085       1.1      matt 
   1086       1.1      matt 	sc->gtmpsc_poll_sdmapage = vmps;
   1087       1.1      matt }
   1088       1.1      matt 
   1089       1.1      matt /*
   1090       1.1      matt  * gtmpsc_txflush - wait for output to drain
   1091       1.1      matt  */
   1092       1.1      matt STATIC void
   1093       1.1      matt gtmpsc_txflush(gtmpsc_softc_t *sc)
   1094       1.1      matt {
   1095       1.1      matt 	unsigned int csr;
   1096       1.1      matt 	unsigned int *csrp;
   1097       1.1      matt 	gtmpsc_polltx_t *vtxp;
   1098       1.1      matt 	int limit = 4000000;	/* 4 seconds */
   1099       1.1      matt 	int ix;
   1100       1.1      matt 
   1101       1.1      matt 	ix = sc->gtmpsc_poll_txix - 1;
   1102       1.1      matt 	if (ix < 0)
   1103       1.1      matt 		ix = GTMPSC_NTXDESC - 1;
   1104       1.1      matt 
   1105       1.1      matt 	vtxp = &sc->gtmpsc_poll_sdmapage->tx[ix];
   1106       1.1      matt 	csrp = &vtxp->txdesc.sdma_csr;
   1107       1.1      matt 	while (limit > 0) {
   1108       1.1      matt 		GTMPSC_CACHE_INVALIDATE(csrp);
   1109       1.1      matt 		csr = desc_read(csrp);
   1110       1.1      matt 		if ((csr & SDMA_CSR_TX_OWN) == 0)
   1111       1.1      matt 			break;
   1112       1.1      matt 		DELAY(GTMPSC_POLL_DELAY);
   1113       1.1      matt 		limit -= GTMPSC_POLL_DELAY;
   1114      1.10     perry 	}
   1115       1.1      matt }
   1116       1.1      matt 
   1117       1.1      matt STATIC void
   1118       1.1      matt gtmpsc_iflush(gtmpsc_softc_t *sc)
   1119       1.1      matt {
   1120       1.1      matt 	int     timo;
   1121       1.1      matt 	char    c;
   1122       1.1      matt 	int     stat;
   1123       1.1      matt 
   1124       1.1      matt 	for (timo = 50000; timo; timo--)
   1125       1.1      matt 		if (gtmpsc_common_pollc(sc->gtmpsc_unit, &c, &stat) == 0)
   1126       1.1      matt 			return;
   1127       1.1      matt #ifdef DIAGNOSTIC
   1128       1.1      matt 	printf("%s: gtmpsc_iflush timeout %02x\n", sc->gtmpsc_dev.dv_xname, c);
   1129       1.1      matt #endif
   1130       1.1      matt }
   1131       1.1      matt 
   1132       1.1      matt STATIC void
   1133       1.1      matt gtmpscinit_stop(struct gtmpsc_softc *sc, int once)
   1134       1.1      matt {
   1135       1.1      matt 	unsigned int r;
   1136       1.1      matt 	unsigned int unit = sc->gtmpsc_unit;
   1137       1.1      matt 
   1138       1.1      matt 	/*
   1139       1.1      matt 	 * XXX HACK FIXME
   1140       1.1      matt 	 * PMON output has not been flushed.  give him a chance
   1141       1.1      matt 	 */
   1142       1.1      matt #if 1
   1143       1.1      matt 	if (! once)
   1144       1.1      matt 		DELAY(100000);	/* XXX */
   1145       1.1      matt #endif
   1146       1.1      matt 
   1147       1.5      matt 	DPRINTF(("gtmpscinit_stop: unit 0x%x\n", unit));
   1148       1.1      matt 	if (unit >= GTMPSC_NCHAN) {
   1149       1.1      matt 		PRINTF(("mpscinit: undefined unit %d\n", sc->gtmpsc_unit));
   1150       1.1      matt 		return;
   1151       1.1      matt 	}
   1152       1.1      matt 
   1153       1.1      matt 	sc->gtmpsc_chr2 = 0;      /* Default value of CHR2 */
   1154       1.1      matt 
   1155       1.1      matt 	/*
   1156       1.1      matt 	 * stop GTMPSC unit
   1157       1.1      matt 	 */
   1158       1.1      matt 	r = sc->gtmpsc_chr2 | GTMPSC_CHR2_RXABORT|GTMPSC_CHR2_TXABORT;
   1159       1.3      matt 	GT_WRITE(sc, GTMPSC_U_CHRN(unit, 2), r);
   1160       1.1      matt 
   1161       1.1      matt 	DELAY(GTMPSC_RESET_DELAY);
   1162       1.1      matt 
   1163       1.1      matt 	/*
   1164       1.1      matt 	 * abort SDMA TX, RX for GTMPSC unit
   1165       1.1      matt 	 */
   1166       1.4      matt 	GT_WRITE(sc, SDMA_U_SDCM(unit), SDMA_SDCM_AR|SDMA_SDCM_AT);
   1167       1.1      matt 
   1168       1.1      matt 	if (once == 0) {
   1169       1.1      matt 		/*
   1170       1.1      matt 		 * Determine if this is the buggy GT-64260A case.
   1171       1.1      matt 		 * If this is, then most of GTMPSC and SDMA registers
   1172       1.1      matt 		 * are unreadable.
   1173       1.1      matt 		 * (They always yield -1).
   1174       1.1      matt 		 */
   1175       1.3      matt 		GT_WRITE(sc, SDMA_IMASK, 0);
   1176       1.3      matt 		r = GT_READ(sc, SDMA_IMASK);
   1177       1.1      matt 		gt_reva_gtmpsc_bug = r == ~0;
   1178       1.1      matt 		sdma_imask = 0;
   1179       1.1      matt 	}
   1180       1.7       scw 
   1181       1.7       scw 	/*
   1182       1.7       scw 	 * If Rx is disabled, we don't need to wait around for
   1183       1.7       scw 	 * abort completion.
   1184       1.7       scw 	 */
   1185       1.7       scw 	if ((GT_READ(sc, GTMPSC_U_MMCR_LO(unit)) & GTMPSC_MMCR_LO_ER) == 0)
   1186       1.7       scw 		return;
   1187       1.7       scw 
   1188       1.1      matt 	/*
   1189       1.1      matt 	 * poll for GTMPSC RX abort completion
   1190       1.1      matt 	 */
   1191       1.1      matt 	if (gt_reva_gtmpsc_bug) {
   1192       1.1      matt 		/* Sync up with the device first */
   1193       1.3      matt 		r = GT_READ(sc, GTMPSC_U_CHRN(unit, 2));
   1194       1.1      matt 		DELAY(GTMPSC_RESET_DELAY);
   1195       1.1      matt 	} else
   1196       1.1      matt 		for (;;) {
   1197       1.5      matt 			r = GT_READ(sc, GTMPSC_U_CHRN(unit, 2));
   1198       1.1      matt 			if (! (r & GTMPSC_CHR2_RXABORT))
   1199       1.1      matt 				break;
   1200       1.1      matt 		}
   1201       1.1      matt 
   1202       1.1      matt 	/*
   1203       1.1      matt 	 * poll for SDMA RX abort completion
   1204       1.1      matt 	 */
   1205       1.1      matt 	for (;;) {
   1206       1.3      matt 		r = GT_READ(sc, SDMA_U_SDCM(unit));
   1207       1.5      matt 		if (! (r & (SDMA_SDCM_AR|SDMA_SDCM_AT)))
   1208       1.1      matt 			break;
   1209       1.5      matt 		DELAY(50);
   1210       1.1      matt 	}
   1211       1.1      matt 
   1212       1.1      matt }
   1213       1.1      matt 
   1214       1.1      matt STATIC void
   1215       1.1      matt gtmpscinit_start(struct gtmpsc_softc *sc, int once)
   1216       1.1      matt {
   1217       1.1      matt 	unsigned int r;
   1218       1.1      matt 	unsigned int unit = sc->gtmpsc_unit;
   1219       1.1      matt 
   1220       1.1      matt 	/*
   1221       1.1      matt 	 * initialize softc's "current" transfer indicies & counts
   1222       1.1      matt 	 */
   1223       1.1      matt 	sc->gtmpsc_cx = 0;
   1224       1.1      matt 	sc->gtmpsc_nc = 0;
   1225       1.1      matt 	sc->gtmpsc_poll_txix = 0;
   1226       1.1      matt 	sc->gtmpsc_poll_rxix = 0;
   1227       1.1      matt 
   1228       1.1      matt 	/*
   1229       1.1      matt 	 * initialize softc's RX softintr FIFO
   1230       1.1      matt 	 */
   1231       1.1      matt 	sc->gtmpsc_rxfifo_putix = 0;
   1232       1.1      matt 	sc->gtmpsc_rxfifo_getix = 0;
   1233       1.1      matt 	sc->gtmpsc_rxfifo_navail = GTMPSC_RXFIFOSZ;
   1234       1.1      matt 	memset(&sc->gtmpsc_rxfifo[0], 0, GTMPSC_RXFIFOSZ);
   1235       1.1      matt 
   1236       1.1      matt 	/*
   1237       1.1      matt 	 * set SDMA unit port TX descriptor pointers
   1238       1.1      matt 	 * "next" pointer of last descriptor is start of ring
   1239       1.1      matt 	 */
   1240       1.1      matt 	r = desc_read(
   1241       1.5      matt 	    &sc->gtmpsc_poll_sdmapage->tx[GTMPSC_NTXDESC-1].txdesc.sdma_next);
   1242       1.3      matt 	GT_WRITE(sc, SDMA_U_SCTDP(unit), r);   /* current */
   1243       1.5      matt 	(void)GT_READ(sc, SDMA_U_SCTDP(unit));
   1244       1.3      matt 	GT_WRITE(sc, SDMA_U_SFTDP(unit), r);   /* first   */
   1245       1.5      matt 	(void)GT_READ(sc, SDMA_U_SFTDP(unit));
   1246       1.1      matt 	/*
   1247       1.1      matt 	 * set SDMA unit port RX descriptor pointer
   1248       1.1      matt 	 * "next" pointer of last descriptor is start of ring
   1249       1.1      matt 	 */
   1250       1.1      matt 	r = desc_read(
   1251       1.5      matt 	    &sc->gtmpsc_poll_sdmapage->rx[GTMPSC_NRXDESC-1].rxdesc.sdma_next);
   1252       1.3      matt 	GT_WRITE(sc, SDMA_U_SCRDP(unit), r);   /* current */
   1253       1.1      matt 
   1254       1.1      matt 	/*
   1255       1.1      matt 	 * initialize SDMA unit Configuration Register
   1256       1.1      matt 	 */
   1257       1.1      matt 	r = SDMA_SDC_BSZ_8x64|SDMA_SDC_SFM|SDMA_SDC_RFT;
   1258       1.3      matt 	GT_WRITE(sc, SDMA_U_SDC(unit), r);
   1259       1.1      matt 
   1260       1.1      matt 	/*
   1261       1.1      matt 	 * enable SDMA receive
   1262       1.1      matt 	 */
   1263       1.3      matt 	GT_WRITE(sc, SDMA_U_SDCM(unit), SDMA_SDCM_ERD);
   1264       1.1      matt 
   1265       1.5      matt 	if (once == 0) {
   1266       1.1      matt 		/*
   1267       1.1      matt 		 * GTMPSC Routing:
   1268       1.1      matt 		 *	MR0 --> Serial Port 0
   1269       1.1      matt 		 *	MR1 --> Serial Port 1
   1270       1.1      matt 		 */
   1271       1.3      matt 		GT_WRITE(sc, GTMPSC_MRR, GTMPSC_MRR_RES);
   1272      1.10     perry 
   1273       1.1      matt 		/*
   1274       1.1      matt 		 * RX and TX Clock Routing:
   1275       1.1      matt 		 *      CRR0 --> BRG0
   1276       1.1      matt 		 *      CRR1 --> BRG1
   1277       1.1      matt 		 */
   1278       1.1      matt 		r = GTMPSC_CRR_BRG0 | (GTMPSC_CRR_BRG1 << GTMPSC_CRR1_SHIFT);
   1279       1.3      matt 		GT_WRITE(sc, GTMPSC_RCRR, r);
   1280       1.3      matt 		GT_WRITE(sc, GTMPSC_TCRR, r);
   1281       1.1      matt 	}
   1282       1.4      matt 	sc->gtmpsc_brg_bcr = BRG_BCR_EN | GT_MPSC_CLOCK_SOURCE |
   1283       1.4      matt 	    compute_cdv(GT_MPSC_DEFAULT_BAUD_RATE);
   1284       1.1      matt 	sc->gtmpsc_chr3 = GTMPSC_MAXIDLE(GT_MPSC_DEFAULT_BAUD_RATE);
   1285       1.1      matt 	gtmpsc_loadchannelregs(sc);
   1286       1.1      matt 
   1287       1.1      matt 	/*
   1288       1.1      matt 	 * set MPSC Protocol configuration register for GTMPSC unit
   1289       1.1      matt 	 */
   1290       1.3      matt 	GT_WRITE(sc, GTMPSC_U_MPCR(unit), GTMPSC_MPCR_CL_8);
   1291       1.1      matt 
   1292       1.1      matt 	/*
   1293       1.1      matt 	 * set MPSC LO and HI port config registers for GTMPSC unit
   1294       1.1      matt  	 */
   1295       1.1      matt 	r = GTMPSC_MMCR_LO_MODE_UART
   1296       1.1      matt 	   |GTMPSC_MMCR_LO_ET
   1297       1.1      matt 	   |GTMPSC_MMCR_LO_ER
   1298       1.1      matt 	   |GTMPSC_MMCR_LO_NLM;
   1299       1.3      matt 	GT_WRITE(sc, GTMPSC_U_MMCR_LO(unit), r);
   1300       1.1      matt 
   1301       1.1      matt 	r =
   1302       1.1      matt 	    GTMPSC_MMCR_HI_TCDV_DEFAULT
   1303       1.1      matt 	   |GTMPSC_MMCR_HI_RDW
   1304       1.1      matt 	   |GTMPSC_MMCR_HI_RCDV_DEFAULT;
   1305       1.3      matt 	GT_WRITE(sc, GTMPSC_U_MMCR_HI(unit), r);
   1306       1.1      matt 
   1307       1.1      matt 	/*
   1308       1.1      matt 	 * tell MPSC receive the Enter Hunt
   1309       1.1      matt 	 */
   1310       1.1      matt 	r = sc->gtmpsc_chr2 | GTMPSC_CHR2_EH;
   1311       1.3      matt 	GT_WRITE(sc, GTMPSC_U_CHRN(unit, 2), r);
   1312       1.1      matt 
   1313       1.1      matt 	/*
   1314       1.1      matt 	 * clear any pending SDMA interrupts for this unit
   1315       1.1      matt 	 */
   1316       1.3      matt 	r = GT_READ(sc, SDMA_ICAUSE);
   1317       1.1      matt 	r &= ~SDMA_U_INTR_MASK(unit);
   1318       1.3      matt 	GT_WRITE(sc, SDMA_ICAUSE, r);	/* ??? */
   1319       1.1      matt 
   1320       1.1      matt 	DPRINTF(("gtmpscinit: OK\n"));
   1321       1.1      matt }
   1322       1.1      matt 
   1323       1.1      matt /*
   1324       1.1      matt  * gtmpscinit - prepare MPSC for operation
   1325       1.1      matt  *
   1326       1.1      matt  *	assumes we are called at ipl >= IPL_SERIAL
   1327       1.1      matt  */
   1328       1.1      matt STATIC void
   1329       1.1      matt gtmpscinit(struct gtmpsc_softc *sc)
   1330       1.1      matt {
   1331       1.1      matt 	static int once = 0;
   1332       1.1      matt 
   1333       1.1      matt 	gtmpscinit_stop(sc, once);
   1334       1.1      matt 	gtmpscinit_start(sc, once);
   1335       1.5      matt 	once = 1;
   1336       1.1      matt }
   1337       1.1      matt 
   1338       1.1      matt /*
   1339       1.1      matt  * gtmpsccninit - initialize the driver and the mpsc device
   1340       1.1      matt  */
   1341       1.1      matt void
   1342       1.1      matt gtmpsccninit(struct consdev *cd)
   1343       1.1      matt {
   1344       1.1      matt }
   1345       1.1      matt 
   1346       1.1      matt int
   1347       1.1      matt gtmpsccngetc(dev_t dev)
   1348       1.1      matt {
   1349       1.4      matt 	unsigned int unit = 0;
   1350       1.1      matt 	int c;
   1351      1.10     perry 
   1352       1.1      matt 	unit = GTMPSCUNIT(dev);
   1353       1.4      matt 	if (major(dev) != 0) {
   1354       1.4      matt 		struct gtmpsc_softc *sc = device_lookup(&gtmpsc_cd, unit);
   1355       1.4      matt 		if (sc == NULL)
   1356       1.4      matt 			return 0;
   1357       1.4      matt 		unit = sc->gtmpsc_unit;
   1358       1.4      matt 	}
   1359       1.1      matt 	if (unit >= GTMPSC_NCHAN)
   1360       1.1      matt 		return 0;
   1361       1.1      matt 	c = gtmpsc_common_getc(unit);
   1362       1.1      matt 
   1363       1.1      matt 	return c;
   1364       1.1      matt }
   1365       1.1      matt 
   1366       1.1      matt void
   1367       1.1      matt gtmpsccnputc(dev_t dev, int c)
   1368       1.1      matt {
   1369       1.4      matt 	unsigned int unit = 0;
   1370       1.1      matt 	char ch = c;
   1371       1.1      matt 	static int ix = 0;
   1372      1.10     perry 
   1373       1.1      matt 	if (gtmpsccninit_done == 0) {
   1374       1.1      matt 		if ((minor(dev) == 0) && (ix < sizeof(gtmpsc_earlybuf)))
   1375       1.1      matt 			gtmpsc_earlybuf[ix++] = (unsigned char)c;
   1376       1.1      matt 		return;
   1377       1.1      matt 	}
   1378       1.1      matt 
   1379       1.1      matt 	unit = GTMPSCUNIT(dev);
   1380       1.4      matt 	if (major(dev) != 0) {
   1381       1.4      matt 		struct gtmpsc_softc *sc = device_lookup(&gtmpsc_cd, unit);
   1382       1.4      matt 		if (sc == NULL)
   1383       1.4      matt 			return;
   1384       1.4      matt 		unit = sc->gtmpsc_unit;
   1385       1.4      matt 	}
   1386       1.1      matt 
   1387       1.1      matt 	if (unit >= GTMPSC_NCHAN)
   1388       1.1      matt 		return;
   1389       1.4      matt 
   1390       1.1      matt 	gtmpsc_common_putc(unit, ch);
   1391       1.1      matt }
   1392       1.1      matt 
   1393       1.1      matt void
   1394       1.1      matt gtmpsccnpollc(dev_t dev, int on)
   1395       1.1      matt {
   1396       1.1      matt }
   1397       1.1      matt 
   1398       1.3      matt int
   1399       1.3      matt gtmpsccnattach(bus_space_tag_t memt, bus_space_handle_t memh, int unit,
   1400       1.3      matt 	int speed, tcflag_t tcflag)
   1401       1.3      matt {
   1402       1.3      matt 	struct gtmpsc_softc *sc = &gtmpsc_fake_softc;
   1403       1.3      matt 	unsigned char *cp;
   1404       1.3      matt 	unsigned char c;
   1405       1.3      matt 	unsigned int i;
   1406       1.3      matt 
   1407       1.4      matt 	if (gtmpsccninit_done)
   1408       1.4      matt 		return 0;
   1409       1.4      matt 
   1410       1.4      matt 	DPRINTF(("gtmpsccnattach\n"));
   1411       1.3      matt 	gtmpsc_hackinit(sc, memt, memh, unit);
   1412       1.4      matt 	DPRINTF(("gtmpscinit\n"));
   1413       1.3      matt 	gtmpscinit(sc);
   1414       1.3      matt 	gtmpsccninit_done = 1;
   1415       1.3      matt 	cp = gtmpsc_earlybuf;
   1416       1.4      matt 	strcpy(gtmpsc_earlybuf, "\r\nMPSC Lives!\r\n");
   1417       1.3      matt 	for (i=0; i < sizeof(gtmpsc_earlybuf); i++) {
   1418       1.3      matt 		c = *cp++;
   1419       1.3      matt 		if (c == 0)
   1420       1.3      matt 			break;
   1421       1.4      matt 		gtmpsc_common_putc(unit, c);
   1422       1.3      matt 	}
   1423       1.4      matt 	DPRINTF(("switching cn_tab\n"));
   1424       1.4      matt 	gtmpsc_consdev.cn_dev = makedev(0, unit);
   1425       1.4      matt 	cn_tab = &gtmpsc_consdev;
   1426       1.4      matt 	DPRINTF(("switched cn_tab!\n"));
   1427       1.3      matt 	return 0;
   1428       1.3      matt }
   1429       1.3      matt 
   1430       1.1      matt /*
   1431       1.1      matt  * gtmpsc_common_pollc - non-blocking console read
   1432       1.1      matt  *
   1433       1.1      matt  *	if there is an RX char, return it in *cp
   1434       1.1      matt  *	set *statp if Break detected
   1435       1.1      matt  *
   1436       1.1      matt  *	assumes we are called at ipl >= IPL_SERIAL
   1437       1.1      matt  *
   1438       1.1      matt  * return 1 if there is RX data
   1439       1.1      matt  * otherwise return 0
   1440       1.1      matt  */
   1441       1.1      matt STATIC int
   1442       1.1      matt gtmpsc_common_pollc(unsigned int unit, char *cp, int *statp)
   1443       1.1      matt {
   1444       1.1      matt 	struct gtmpsc_softc *sc = gtmpsc_scp[unit];
   1445       1.1      matt 	gtmpsc_pollrx_t *vrxp;
   1446       1.1      matt 	unsigned int ix;
   1447       1.1      matt 	unsigned int cx;
   1448       1.1      matt 	unsigned int nc;
   1449       1.1      matt 
   1450       1.1      matt 	*statp = GTMPSC_STAT_NONE;
   1451       1.1      matt 	ix = sc->gtmpsc_poll_rxix;
   1452       1.1      matt 	nc = sc->gtmpsc_nc;
   1453       1.1      matt 	cx = sc->gtmpsc_cx;
   1454       1.1      matt 	if (nc == 0) {
   1455       1.1      matt 		unsigned int *csrp;
   1456       1.1      matt 		unsigned int csr;
   1457       1.1      matt 
   1458       1.1      matt 		vrxp = &sc->gtmpsc_poll_sdmapage->rx[ix];
   1459       1.1      matt 		csrp = &vrxp->rxdesc.sdma_csr;
   1460       1.1      matt 		cx = 0;
   1461       1.1      matt 
   1462       1.1      matt 		GTMPSC_CACHE_INVALIDATE(csrp);
   1463       1.1      matt 		csr = desc_read(csrp);
   1464       1.1      matt 		if (csr & SDMA_CSR_RX_OWN)
   1465       1.1      matt 			return 0;
   1466       1.1      matt 		if (csr & SDMA_CSR_RX_BR)
   1467       1.1      matt 			*statp = GTMPSC_STAT_BREAK;
   1468       1.1      matt 		if (csr & SDMA_CSR_RX_ES)
   1469       1.1      matt 			PRINTF(("mpsc 0 RX error, rxdesc csr 0x%x\n", csr));
   1470       1.1      matt 
   1471       1.1      matt 		nc = desc_read(&vrxp->rxdesc.sdma_cnt);
   1472       1.1      matt 		nc &= SDMA_RX_CNT_BCNT_MASK;
   1473       1.1      matt 		csr = SDMA_CSR_RX_L|SDMA_CSR_RX_F|SDMA_CSR_RX_OWN
   1474       1.1      matt 							      |SDMA_CSR_RX_EI;
   1475       1.1      matt 		if (nc == 0) {
   1476       1.1      matt 			if ((++ix) >= GTMPSC_NRXDESC)
   1477       1.1      matt 				ix = 0;
   1478       1.1      matt 			sc->gtmpsc_poll_rxix = ix;
   1479       1.1      matt 			desc_write(csrp, csr);
   1480       1.1      matt 			GTMPSC_CACHE_FLUSH(csrp);
   1481       1.1      matt 			return 0;
   1482       1.1      matt 		}
   1483       1.1      matt 		bcopy(vrxp->rxbuf, sc->gtmpsc_rxbuf, nc);
   1484       1.1      matt 		desc_write(csrp, csr);
   1485       1.1      matt 		GTMPSC_CACHE_FLUSH(csrp);
   1486       1.1      matt 	}
   1487       1.1      matt 	gtmpsc_poll_pollc_cnt++;
   1488       1.1      matt 	nc--;
   1489       1.1      matt 	*cp = sc->gtmpsc_rxbuf[cx++];
   1490       1.1      matt 	if (nc == 0) {
   1491       1.1      matt 		if ((++ix) >= GTMPSC_NRXDESC)
   1492       1.1      matt 			ix = 0;
   1493       1.1      matt 		sc->gtmpsc_poll_rxix = ix;
   1494       1.1      matt 	}
   1495       1.1      matt 	sc->gtmpsc_cx = cx;
   1496       1.1      matt 	sc->gtmpsc_nc = nc;
   1497       1.1      matt 	return 1;
   1498       1.1      matt }
   1499       1.1      matt 
   1500       1.1      matt /*
   1501       1.1      matt  * gtmpsc_common_getc - polled console read
   1502       1.1      matt  *
   1503       1.1      matt  *	We copy data from the DMA buffers into a buffer in the softc
   1504       1.1      matt  *	to reduce descriptor ownership turnaround time
   1505       1.1      matt  *	MPSC can crater if it wraps descriptor rings,
   1506       1.1      matt  *	which is asynchronous and throttled only by line speed.
   1507       1.1      matt  *
   1508       1.1      matt  *	This code assumes the buffer PA==KVA
   1509       1.1      matt  *	and assumes we are called at ipl >= IPL_SERIAL
   1510       1.1      matt  */
   1511       1.1      matt STATIC int
   1512       1.1      matt gtmpsc_common_getc(unsigned int unit)
   1513       1.1      matt {
   1514       1.1      matt 	struct gtmpsc_softc *sc = gtmpsc_scp[unit];
   1515       1.1      matt 	gtmpsc_pollrx_t *vrxp;
   1516       1.1      matt 	unsigned int ix;
   1517       1.1      matt 	unsigned int cx;
   1518       1.1      matt 	unsigned int nc;
   1519       1.8       scw 	unsigned int wdog_interval;
   1520       1.1      matt 	int c;
   1521       1.1      matt 
   1522       1.1      matt 	ix = sc->gtmpsc_poll_rxix;
   1523       1.1      matt 	nc = sc->gtmpsc_nc;
   1524       1.1      matt 	cx = sc->gtmpsc_cx;
   1525       1.8       scw 	wdog_interval = 0;
   1526       1.1      matt 	while (nc == 0) {
   1527       1.1      matt 		unsigned int *csrp;
   1528       1.1      matt 		unsigned int csr;
   1529       1.1      matt 		unsigned int r;
   1530       1.1      matt 
   1531       1.1      matt 		vrxp = &sc->gtmpsc_poll_sdmapage->rx[ix];
   1532       1.1      matt 		csrp = &vrxp->rxdesc.sdma_csr;
   1533       1.1      matt 		cx = 0;
   1534       1.1      matt 
   1535       1.1      matt 		GTMPSC_CACHE_INVALIDATE(csrp);
   1536       1.1      matt 		csr = desc_read(csrp);
   1537       1.1      matt 		if (csr & SDMA_CSR_RX_OWN) {
   1538       1.1      matt 			r = sc->gtmpsc_chr2 | GTMPSC_CHR2_CRD;
   1539       1.4      matt 			GT_WRITE(sc, GTMPSC_U_CHRN(unit, 2), r);
   1540       1.1      matt 			do {
   1541       1.8       scw 				if (wdog_interval++ % 32)
   1542       1.8       scw 					gt_watchdog_service();
   1543       1.1      matt 				gtmpsc_poll_getc_miss++;
   1544       1.1      matt 				GTMPSC_CACHE_INVALIDATE(csrp);
   1545       1.4      matt 				DELAY(50);
   1546       1.1      matt 				csr = desc_read(csrp);
   1547       1.1      matt 			} while (csr & SDMA_CSR_RX_OWN);
   1548       1.8       scw 		} else
   1549       1.8       scw 		if (wdog_interval++ % 32)
   1550       1.8       scw 			gt_watchdog_service();
   1551       1.1      matt 		if (csr & SDMA_CSR_RX_ES)
   1552       1.1      matt 			PRINTF(("mpsc 0 RX error, rxdesc csr 0x%x\n", csr));
   1553       1.1      matt 
   1554       1.1      matt 		nc = desc_read(&vrxp->rxdesc.sdma_cnt);
   1555       1.1      matt 		nc &= SDMA_RX_CNT_BCNT_MASK;
   1556       1.1      matt 		if (nc) {
   1557       1.1      matt 			bcopy(vrxp->rxbuf, sc->gtmpsc_rxbuf, nc);
   1558       1.1      matt 		} else {
   1559       1.1      matt 			if ((++ix) >= GTMPSC_NRXDESC)
   1560       1.1      matt 				ix = 0;
   1561       1.1      matt 			sc->gtmpsc_poll_rxix = ix;
   1562       1.1      matt 		}
   1563       1.1      matt 		csr = SDMA_CSR_RX_L|SDMA_CSR_RX_F|SDMA_CSR_RX_OWN
   1564       1.1      matt 							|SDMA_CSR_RX_EI;
   1565       1.1      matt 		desc_write(csrp, csr);
   1566       1.1      matt 		GTMPSC_CACHE_FLUSH(csrp);
   1567       1.1      matt #ifdef KGDB
   1568       1.1      matt 		if (unit == comkgdbport && gt_reva_gtmpsc_bug)
   1569       1.4      matt 			GT_WRITE(sc, SDMA_ICAUSE, ~SDMA_INTR_RXBUF(unit));
   1570       1.1      matt #endif
   1571       1.1      matt 	}
   1572       1.1      matt 	gtmpsc_poll_getc_cnt++;
   1573       1.1      matt 	nc--;
   1574       1.1      matt 	c = (int)sc->gtmpsc_rxbuf[cx++];
   1575       1.1      matt 	if (nc == 0) {
   1576       1.1      matt 		if ((++ix) >= GTMPSC_NRXDESC)
   1577       1.1      matt 			ix = 0;
   1578       1.1      matt 		sc->gtmpsc_poll_rxix = ix;
   1579       1.1      matt 	}
   1580       1.1      matt 	sc->gtmpsc_cx = cx;
   1581       1.1      matt 	sc->gtmpsc_nc = nc;
   1582       1.8       scw 	gt_watchdog_service();
   1583       1.1      matt 	return c;
   1584       1.1      matt }
   1585       1.1      matt 
   1586       1.1      matt /*
   1587       1.1      matt  * gtmpsc_common_putn - write a buffer into the hardware
   1588       1.1      matt  *
   1589       1.1      matt  *	assumes we are called at ipl >= IPL_SERIAL
   1590       1.1      matt  */
   1591       1.1      matt STATIC void
   1592       1.1      matt gtmpsc_common_putn(struct gtmpsc_softc *sc)
   1593       1.1      matt 
   1594       1.1      matt {
   1595       1.1      matt 	int     unit = sc->gtmpsc_unit;
   1596       1.1      matt 	int     n;
   1597       1.1      matt 	int     kick;
   1598       1.1      matt 	gtmpsc_polltx_t *vtxp;
   1599       1.1      matt 	unsigned int *csrp;
   1600       1.1      matt 	unsigned int csr;
   1601       1.1      matt 	unsigned int ix;
   1602       1.1      matt 	unsigned int sdcm;
   1603       1.1      matt 
   1604       1.1      matt 	kick = 0;
   1605       1.1      matt 	for (ix = sc->gtmpsc_poll_txix; sc->sc_tbc;) {
   1606       1.1      matt 		vtxp = &sc->gtmpsc_poll_sdmapage->tx[ix];
   1607       1.1      matt 		csrp = &vtxp->txdesc.sdma_csr;
   1608       1.1      matt 		GTMPSC_CACHE_INVALIDATE(csrp);
   1609       1.1      matt 		csr = desc_read(csrp);
   1610       1.1      matt 		if ((csr & SDMA_CSR_TX_OWN) != 0)
   1611       1.1      matt 			break;
   1612       1.1      matt 		n = sc->sc_tbc;
   1613       1.1      matt 		if (n > GTMPSC_TXBUFSZ)
   1614       1.1      matt 			n = GTMPSC_TXBUFSZ;
   1615       1.1      matt 		bcopy(sc->sc_tba, vtxp->txbuf, n);
   1616       1.1      matt 		csr = SDMA_CSR_TX_L | SDMA_CSR_TX_F
   1617       1.1      matt 					| SDMA_CSR_TX_EI | SDMA_CSR_TX_OWN;
   1618       1.1      matt 		desc_write(&vtxp->txdesc.sdma_cnt,
   1619       1.1      matt 				(n << SDMA_TX_CNT_BCNT_SHIFT) | n);
   1620       1.1      matt 		desc_write(csrp, csr);
   1621       1.1      matt 		GTMPSC_CACHE_FLUSH(csrp);
   1622       1.1      matt 		sc->sc_tbc -= n;
   1623       1.1      matt 		sc->sc_tba += n;
   1624       1.1      matt 		gtmpsc_poll_putn_cnt += n;
   1625       1.1      matt 		sc->cnt_tx_to_sdma += n;
   1626       1.1      matt 		kick = 1;
   1627       1.1      matt 
   1628       1.1      matt 		if (++ix >= GTMPSC_NTXDESC)
   1629       1.1      matt 			ix = 0;
   1630       1.1      matt 	}
   1631       1.1      matt 	if (kick) {
   1632       1.1      matt 		sc->gtmpsc_poll_txix = ix;
   1633       1.1      matt 
   1634       1.1      matt 		/*
   1635       1.1      matt 		 * now kick some SDMA
   1636       1.1      matt 		 */
   1637       1.3      matt 		sdcm = GT_READ(sc, SDMA_U_SDCM(unit));
   1638       1.1      matt 
   1639       1.1      matt 		if ((sdcm & SDMA_SDCM_TXD) == 0) {
   1640       1.4      matt 			GT_WRITE(sc, SDMA_U_SDCM(unit), SDMA_SDCM_TXD);
   1641       1.1      matt 		}
   1642       1.1      matt 	}
   1643       1.1      matt }
   1644       1.1      matt 
   1645       1.1      matt /*
   1646       1.1      matt  * gtmpsc_common_putc - polled console putc
   1647       1.1      matt  *
   1648       1.1      matt  *	assumes we are called at ipl >= IPL_SERIAL
   1649       1.1      matt  */
   1650       1.1      matt STATIC void
   1651       1.1      matt gtmpsc_common_putc(unsigned int unit, unsigned char c)
   1652       1.1      matt {
   1653       1.1      matt 	struct gtmpsc_softc *sc = gtmpsc_scp[unit];
   1654       1.1      matt 	gtmpsc_polltx_t *vtxp;
   1655       1.1      matt 	unsigned int *csrp;
   1656       1.1      matt 	unsigned int csr;
   1657       1.1      matt 	unsigned int ix;
   1658       1.1      matt 	unsigned int nix;
   1659       1.8       scw 	unsigned int wdog_interval = 0;
   1660       1.1      matt 
   1661       1.5      matt 	DPRINTF(("gtmpsc_common_putc(%d, '%c'): cur=%#x, first=%#x", unit, c,
   1662       1.5      matt 	    GT_READ(sc, SDMA_U_SCTDP(unit)),   /* current */
   1663       1.5      matt 	    GT_READ(sc, SDMA_U_SFTDP(unit))));   /* first   */
   1664       1.1      matt 	ix = sc->gtmpsc_poll_txix;
   1665       1.1      matt 	nix = ix + 1;
   1666       1.1      matt 	if (nix >= GTMPSC_NTXDESC)
   1667       1.1      matt 		nix = 0;
   1668       1.1      matt 	sc->gtmpsc_poll_txix = nix;
   1669       1.1      matt 	vtxp = &sc->gtmpsc_poll_sdmapage->tx[ix];
   1670       1.1      matt 	csrp = &vtxp->txdesc.sdma_csr;
   1671       1.1      matt 
   1672       1.5      matt 
   1673       1.1      matt 	for (;;) {
   1674       1.1      matt 		GTMPSC_CACHE_INVALIDATE(csrp);
   1675       1.1      matt 		csr = desc_read(csrp);
   1676       1.1      matt 		if ((csr & SDMA_CSR_TX_OWN) == 0)
   1677       1.1      matt 			break;
   1678       1.1      matt 		gtmpsc_poll_putc_miss++;
   1679       1.5      matt 		DELAY(40);
   1680       1.5      matt 		DPRINTF(("."));
   1681       1.8       scw 		if (wdog_interval++ % 32)
   1682       1.8       scw 			gt_watchdog_service();
   1683       1.1      matt 	}
   1684       1.1      matt 	if (csr & SDMA_CSR_TX_ES)
   1685       1.5      matt 		PRINTF(("mpsc %d TX error, txdesc csr 0x%x\n", unit, csr));
   1686       1.1      matt 
   1687       1.1      matt 	gtmpsc_poll_putc_cnt++;
   1688       1.1      matt 	vtxp->txbuf[0] = c;
   1689       1.5      matt 	csr = SDMA_CSR_TX_L | SDMA_CSR_TX_F | SDMA_CSR_TX_EI | SDMA_CSR_TX_OWN;
   1690       1.1      matt 	desc_write(&vtxp->txdesc.sdma_cnt, (1 << SDMA_TX_CNT_BCNT_SHIFT) | 1);
   1691       1.1      matt 	desc_write(csrp, csr);
   1692       1.1      matt 	GTMPSC_CACHE_FLUSH(csrp);
   1693       1.1      matt 
   1694       1.1      matt 	/*
   1695       1.1      matt 	 * now kick some SDMA
   1696       1.1      matt 	 */
   1697       1.5      matt 	GT_WRITE(sc, SDMA_U_SDCM(unit), SDMA_SDCM_TXD);
   1698       1.8       scw 	gt_watchdog_service();
   1699       1.1      matt }
   1700       1.1      matt 
   1701       1.1      matt 
   1702       1.1      matt STATIC void
   1703       1.1      matt gtmpsc_poll(void *arg)
   1704       1.1      matt {
   1705       1.1      matt 	struct gtmpsc_softc *sc = (struct gtmpsc_softc *)arg;
   1706       1.1      matt 	int kick;
   1707       1.1      matt 	char ch;
   1708       1.1      matt 	int stat;
   1709       1.1      matt 	static struct timeval   msg_time = {0,0};
   1710       1.1      matt 	static struct timeval   cur_time;
   1711       1.1      matt 	static int fifo_full = 0;
   1712       1.1      matt 
   1713       1.1      matt 	kick = 0;
   1714       1.1      matt 	while (gtmpsc_common_pollc(sc->gtmpsc_unit, &ch, &stat)) {
   1715       1.1      matt #ifdef DDB
   1716       1.1      matt 		if (stat)
   1717       1.1      matt 			break;
   1718       1.1      matt #endif
   1719       1.1      matt 		++sc->cnt_rx_from_sdma;
   1720       1.1      matt 		if (sc->gtmpsc_rxfifo_navail != 0) {
   1721       1.1      matt 			sc->gtmpsc_rxfifo[sc->gtmpsc_rxfifo_putix++] = ch;
   1722       1.1      matt 			if (sc->gtmpsc_rxfifo_putix == GTMPSC_RXFIFOSZ)
   1723       1.1      matt 				sc->gtmpsc_rxfifo_putix = 0;
   1724       1.1      matt 			atomic_add(&sc->gtmpsc_rxfifo_navail, -1);
   1725       1.1      matt 			++sc->cnt_rx_to_fifo;
   1726       1.1      matt 			fifo_full = 0;
   1727       1.1      matt 			kick = 1;
   1728       1.1      matt 		} else {
   1729       1.1      matt 			if (fifo_full == 0) {
   1730       1.1      matt 				fifo_full = 1;
   1731       1.1      matt 				microtime(&cur_time);
   1732       1.1      matt 				if (cur_time.tv_sec - msg_time.tv_sec >= 5) {
   1733       1.1      matt 					/* Only do this once in 5 sec */
   1734       1.1      matt 					msg_time = cur_time;
   1735       1.1      matt 					printf("mpsc%d: input FIFO full, "
   1736       1.1      matt 					       "dropping incoming characters\n",
   1737       1.1      matt 					       sc->gtmpsc_unit);
   1738       1.1      matt 				}
   1739       1.1      matt 			}
   1740       1.1      matt 		}
   1741       1.1      matt 	}
   1742       1.1      matt #ifdef DDB
   1743       1.1      matt 	if (stat) {
   1744       1.4      matt 		if (cn_tab == &gtmpsc_consdev) {
   1745       1.1      matt 			Debugger();
   1746       1.4      matt 		}
   1747       1.1      matt 	}
   1748       1.1      matt #endif
   1749       1.1      matt 	if (kick)
   1750       1.3      matt 		softintr_schedule(sc->sc_si);
   1751       1.1      matt }
   1752       1.1      matt 
   1753       1.1      matt #ifdef KGDB
   1754       1.1      matt /* ARGSUSED */
   1755       1.1      matt STATIC int
   1756       1.1      matt gtmpsc_kgdb_getc(arg)
   1757       1.1      matt 	void *arg;
   1758       1.1      matt {
   1759       1.1      matt 
   1760       1.1      matt 	return (gtmpsc_common_getc(comkgdbport));
   1761       1.1      matt }
   1762       1.1      matt 
   1763       1.1      matt /* ARGSUSED */
   1764       1.1      matt STATIC void
   1765       1.1      matt gtmpsc_kgdb_putc(arg, c)
   1766       1.1      matt 	void *arg;
   1767       1.1      matt 	int c;
   1768       1.1      matt {
   1769       1.1      matt 
   1770       1.1      matt 	return (gtmpsc_common_putc(comkgdbport, c));
   1771       1.1      matt }
   1772       1.1      matt 
   1773       1.1      matt STATIC void
   1774       1.1      matt gtmpsc_kgdb_poll(void *arg)
   1775       1.1      matt {
   1776       1.1      matt 	struct gtmpsc_softc       *sc = (struct gtmpsc_softc *)arg;
   1777       1.1      matt 	int                     s;
   1778       1.1      matt 	char                    c;
   1779       1.1      matt 	int                     brk;
   1780       1.1      matt 
   1781      1.10     perry 	s = splserial();
   1782       1.1      matt 	if (kgdb_recover == 0) { /* gdb is not currently talking to its agent */
   1783       1.1      matt 		while (gtmpsc_common_pollc(sc->gtmpsc_unit, &c, &brk)) {
   1784       1.1      matt 			if (c == CTRL('c'))
   1785       1.1      matt 				brk = GTMPSC_STAT_BREAK;
   1786       1.1      matt 			if (brk == GTMPSC_STAT_BREAK)
   1787       1.1      matt 				break;
   1788       1.1      matt 		}
   1789       1.1      matt 		if (brk == GTMPSC_STAT_BREAK) {
   1790       1.1      matt 			if (kgdb_break_immediate)
   1791       1.1      matt 				breakpoint();
   1792       1.1      matt 			else {
   1793       1.1      matt 				printf("connecting to kgdb\n");
   1794       1.1      matt 				kgdb_connect(1);
   1795       1.1      matt 			}
   1796       1.1      matt 		}
   1797       1.1      matt 	}
   1798       1.1      matt 	splx(s);
   1799       1.1      matt }
   1800       1.1      matt 
   1801       1.1      matt #endif /* KGDB */
   1802       1.1      matt 
   1803       1.2      matt #if 0
   1804       1.1      matt void
   1805       1.1      matt gtmpsc_printf(const char *fmt, ...)
   1806       1.1      matt {
   1807       1.1      matt 	struct consdev *ocd;
   1808       1.1      matt 	int s;
   1809       1.1      matt 	va_list ap;
   1810       1.1      matt 
   1811       1.1      matt 	s = splserial();
   1812       1.1      matt 	ocd = cn_tab;
   1813       1.1      matt 	cn_tab = &constab[0];
   1814       1.1      matt 	va_start(ap, fmt);
   1815       1.1      matt 	printf(fmt, ap);
   1816       1.1      matt 	va_end(ap);
   1817       1.1      matt 	cn_tab = ocd;
   1818       1.1      matt 	splx(s);
   1819       1.1      matt }
   1820       1.2      matt #endif
   1821       1.1      matt 
   1822       1.1      matt void
   1823       1.1      matt gtmpsc_mem_printf(const char *fmt, ...)
   1824       1.1      matt {
   1825       1.1      matt 	va_list ap;
   1826       1.1      matt 	static unsigned char *p = gtmpsc_print_buf;
   1827       1.1      matt 
   1828       1.1      matt 	if (p >= &gtmpsc_print_buf[GTMPSC_PRINT_BUF_SIZE - 128]) {
   1829       1.1      matt 		bzero(gtmpsc_print_buf, GTMPSC_PRINT_BUF_SIZE);
   1830       1.1      matt 		p = gtmpsc_print_buf;
   1831       1.1      matt 	}
   1832       1.1      matt 	va_start(ap, fmt);
   1833       1.1      matt 	p += vsprintf(p, fmt, ap);
   1834       1.1      matt 	va_end(ap);
   1835       1.1      matt }
   1836       1.1      matt 
   1837       1.1      matt void
   1838       1.1      matt gtmpsc_shutdownhook(void *arg)
   1839       1.1      matt {
   1840       1.1      matt 	gtmpsc_softc_t *sc = (gtmpsc_softc_t *)arg;
   1841       1.1      matt 
   1842       1.1      matt 	gtmpsc_txflush(sc);
   1843       1.1      matt }
   1844       1.1      matt 
   1845       1.1      matt void
   1846       1.1      matt gtmpsccnhalt(dev_t dev)
   1847       1.1      matt {
   1848       1.1      matt 	unsigned int unit;
   1849       1.1      matt 	u_int32_t r;
   1850       1.1      matt 
   1851       1.1      matt 	for (unit = 0; unit < GTMPSC_NCHAN; unit++) {
   1852       1.4      matt 		gtmpsc_softc_t *sc = gtmpsc_scp[unit];
   1853       1.1      matt 		if (sc == NULL)
   1854       1.1      matt 			continue;
   1855       1.1      matt 
   1856       1.1      matt 		/*
   1857       1.1      matt 		 * flush TX buffers
   1858       1.1      matt 		 */
   1859       1.1      matt 		gtmpsc_txflush(sc);
   1860       1.1      matt 
   1861       1.1      matt 		/*
   1862      1.10     perry 		 * stop MPSC unit RX
   1863       1.1      matt 		 */
   1864       1.3      matt 		r = GT_READ(sc, GTMPSC_U_CHRN(unit, 2));
   1865       1.1      matt 		r &= ~GTMPSC_CHR2_EH;
   1866       1.1      matt 		r |= GTMPSC_CHR2_RXABORT;
   1867       1.3      matt 		GT_WRITE(sc, GTMPSC_U_CHRN(unit, 2), r);
   1868       1.1      matt 
   1869       1.1      matt 		DELAY(GTMPSC_RESET_DELAY);
   1870       1.1      matt 
   1871       1.1      matt 		/*
   1872       1.1      matt 		 * abort SDMA RX for MPSC unit
   1873       1.1      matt 		 */
   1874       1.4      matt 		GT_WRITE(sc, SDMA_U_SDCM(unit), SDMA_SDCM_AR);
   1875       1.1      matt 	}
   1876       1.1      matt }
   1877       1.1      matt 
   1878       1.1      matt void
   1879       1.1      matt gtmpsc_puts(char *str)
   1880       1.1      matt {
   1881       1.1      matt 	char c;
   1882       1.1      matt 
   1883       1.1      matt 	if (str == NULL)
   1884       1.1      matt 		return;
   1885       1.1      matt 	while ((c = *str++) != 0)
   1886       1.1      matt 		gtmpsccnputc(0, c);
   1887       1.1      matt }
   1888