Home | History | Annotate | Line # | Download | only in windermere
      1  1.10    andvar /*      $NetBSD: wmcom.c,v 1.10 2023/09/01 08:53:52 andvar Exp $      */
      2   1.1  kiyohara /*
      3   1.1  kiyohara  * Copyright (c) 2012 KIYOHARA Takashi
      4   1.1  kiyohara  * All rights reserved.
      5   1.1  kiyohara  *
      6   1.1  kiyohara  * Redistribution and use in source and binary forms, with or without
      7   1.1  kiyohara  * modification, are permitted provided that the following conditions
      8   1.1  kiyohara  * are met:
      9   1.1  kiyohara  * 1. Redistributions of source code must retain the above copyright
     10   1.1  kiyohara  *    notice, this list of conditions and the following disclaimer.
     11   1.1  kiyohara  * 2. Redistributions in binary form must reproduce the above copyright
     12   1.1  kiyohara  *    notice, this list of conditions and the following disclaimer in the
     13   1.1  kiyohara  *    documentation and/or other materials provided with the distribution.
     14   1.1  kiyohara  *
     15   1.1  kiyohara  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16   1.1  kiyohara  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     17   1.1  kiyohara  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     18   1.1  kiyohara  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     19   1.1  kiyohara  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     20   1.1  kiyohara  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     21   1.1  kiyohara  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     22   1.1  kiyohara  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     23   1.1  kiyohara  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     24   1.1  kiyohara  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     25   1.1  kiyohara  * POSSIBILITY OF SUCH DAMAGE.
     26   1.1  kiyohara  */
     27   1.1  kiyohara #include <sys/cdefs.h>
     28  1.10    andvar __KERNEL_RCSID(0, "$NetBSD: wmcom.c,v 1.10 2023/09/01 08:53:52 andvar Exp $");
     29   1.1  kiyohara 
     30   1.1  kiyohara #include "rnd.h"
     31   1.1  kiyohara 
     32   1.1  kiyohara #include <sys/param.h>
     33   1.1  kiyohara #include <sys/bus.h>
     34   1.1  kiyohara #include <sys/conf.h>
     35   1.1  kiyohara #include <sys/device.h>
     36   1.1  kiyohara #include <sys/errno.h>
     37   1.1  kiyohara #include <sys/fcntl.h>
     38   1.1  kiyohara #include <sys/intr.h>
     39   1.1  kiyohara #include <sys/kauth.h>
     40   1.1  kiyohara #include <sys/lwp.h>
     41   1.1  kiyohara #include <sys/malloc.h>
     42   1.1  kiyohara #include <sys/systm.h>
     43   1.1  kiyohara #include <sys/termios.h>
     44   1.1  kiyohara #include <sys/tty.h>
     45   1.1  kiyohara #include <sys/types.h>
     46   1.1  kiyohara 
     47   1.9  riastrad #include <ddb/db_active.h>
     48   1.9  riastrad 
     49   1.1  kiyohara #include <epoc32/windermere/windermerereg.h>
     50   1.1  kiyohara #include <epoc32/windermere/windermerevar.h>
     51   1.1  kiyohara 
     52   1.1  kiyohara #include <dev/cons.h>
     53   1.1  kiyohara 
     54   1.1  kiyohara #ifdef RND_COM
     55   1.6  riastrad #include <sys/rndsource.h>
     56   1.1  kiyohara #endif
     57   1.1  kiyohara 
     58   1.1  kiyohara #include "ioconf.h"
     59   1.1  kiyohara #include "locators.h"
     60   1.1  kiyohara 
     61   1.5  christos #define COMUNIT(x)	TTUNIT(x)
     62   1.5  christos #define COMDIALOUT(x)	TTDIALOUT(x)
     63   1.1  kiyohara 
     64   1.1  kiyohara #define WMCOM_RING_SIZE	2048
     65   1.1  kiyohara 
     66   1.1  kiyohara struct wmcom_softc {
     67   1.1  kiyohara 	device_t sc_dev;
     68   1.1  kiyohara 	bus_space_tag_t sc_iot;
     69   1.1  kiyohara 	bus_space_handle_t sc_ioh;
     70   1.1  kiyohara 
     71   1.1  kiyohara 	void *sc_si;
     72   1.1  kiyohara 
     73   1.1  kiyohara 	struct tty *sc_tty;
     74   1.1  kiyohara 
     75   1.1  kiyohara 	u_char *sc_tba;
     76   1.1  kiyohara 	u_int sc_tbc;
     77   1.1  kiyohara 	u_char *sc_rbuf;
     78   1.1  kiyohara 	char *volatile sc_rbget;
     79   1.1  kiyohara 	char *volatile sc_rbput;
     80   1.1  kiyohara 	volatile int sc_rbavail;
     81   1.1  kiyohara 
     82   1.1  kiyohara 	int sc_tx_done;
     83   1.1  kiyohara 	int sc_rx_ready;
     84   1.1  kiyohara 
     85   1.1  kiyohara 	int sc_hwflags;
     86   1.1  kiyohara #define COM_HW_CONSOLE	(1 << 0)
     87   1.1  kiyohara #define COM_HW_DEV_OK	(1 << 1)
     88   1.1  kiyohara #define COM_HW_KGDB	(1 << 2)
     89   1.1  kiyohara 	int sc_swflags;
     90   1.1  kiyohara 
     91   1.1  kiyohara 	int sc_flags;
     92   1.1  kiyohara #define WMCOM_IRDA	(1 << 0)
     93   1.1  kiyohara 
     94   1.1  kiyohara #ifdef RND_COM
     95  1.10    andvar 	krndsource_t rnd_source;
     96   1.1  kiyohara #endif
     97   1.1  kiyohara };
     98   1.1  kiyohara 
     99   1.1  kiyohara static int wmcom_match(device_t, cfdata_t, void *);
    100   1.1  kiyohara static void wmcom_attach(device_t, device_t, void *);
    101   1.1  kiyohara 
    102   1.1  kiyohara static int wmcom_intr(void *);
    103   1.1  kiyohara static void wmcom_soft(void *);
    104   1.1  kiyohara 
    105   1.1  kiyohara static void wmcom_start(struct tty *);
    106   1.1  kiyohara static int wmcom_param(struct tty *, struct termios *);
    107   1.1  kiyohara static int wmcom_hwiflow(struct tty *, int);
    108   1.1  kiyohara 
    109   1.1  kiyohara dev_type_open(wmcomopen);
    110   1.1  kiyohara dev_type_close(wmcomclose);
    111   1.1  kiyohara dev_type_read(wmcomread);
    112   1.1  kiyohara dev_type_write(wmcomwrite);
    113   1.1  kiyohara dev_type_ioctl(wmcomioctl);
    114   1.1  kiyohara dev_type_stop(wmcomstop);
    115   1.1  kiyohara dev_type_tty(wmcomtty);
    116   1.1  kiyohara dev_type_poll(wmcompoll);
    117   1.1  kiyohara 
    118   1.1  kiyohara static void wmcom_iflush(struct wmcom_softc *);
    119   1.1  kiyohara static void wmcom_shutdown(struct wmcom_softc *);
    120   1.1  kiyohara static void wmcom_break(struct wmcom_softc *, int);
    121   1.1  kiyohara 
    122   1.1  kiyohara static void wmcom_rxsoft(struct wmcom_softc *, struct tty *);
    123   1.1  kiyohara 
    124   1.1  kiyohara static inline uint32_t wmcom_rate2lcr(int);
    125   1.1  kiyohara static uint8_t wmcom_cflag2fcr(tcflag_t);
    126   1.1  kiyohara 
    127   1.1  kiyohara static int wmcom_cngetc(dev_t);
    128   1.1  kiyohara static void wmcom_cnputc(dev_t, int);
    129   1.1  kiyohara static void wmcom_cnpollc(dev_t, int);
    130   1.1  kiyohara 
    131   1.1  kiyohara CFATTACH_DECL_NEW(wmcom, sizeof(struct wmcom_softc),
    132   1.1  kiyohara     wmcom_match, wmcom_attach, NULL, NULL);
    133   1.1  kiyohara 
    134   1.1  kiyohara const struct cdevsw wmcom_cdevsw = {
    135   1.2  dholland 	.d_open = wmcomopen,
    136   1.2  dholland 	.d_close = wmcomclose,
    137   1.2  dholland 	.d_read = wmcomread,
    138   1.2  dholland 	.d_write = wmcomwrite,
    139   1.2  dholland 	.d_ioctl = wmcomioctl,
    140   1.2  dholland 	.d_stop = wmcomstop,
    141   1.2  dholland 	.d_tty = wmcomtty,
    142   1.2  dholland 	.d_poll = wmcompoll,
    143   1.2  dholland 	.d_mmap = nommap,
    144   1.2  dholland 	.d_kqfilter = ttykqfilter,
    145   1.3  dholland 	.d_discard = nodiscard,
    146   1.2  dholland 	.d_flag = D_TTY
    147   1.1  kiyohara };
    148   1.1  kiyohara 
    149   1.1  kiyohara static struct cnm_state wmcom_cnm_state;
    150   1.1  kiyohara static vaddr_t wmcom_cnaddr;
    151   1.1  kiyohara static int wmcom_cnrate;
    152   1.1  kiyohara static tcflag_t wmcom_cncflag;
    153   1.1  kiyohara 
    154   1.1  kiyohara 
    155   1.1  kiyohara /* ARGSUSED */
    156   1.1  kiyohara static int
    157   1.1  kiyohara wmcom_match(device_t parent, cfdata_t match, void *aux)
    158   1.1  kiyohara {
    159   1.1  kiyohara 	struct windermere_attach_args *aa = aux;
    160   1.1  kiyohara 
    161   1.1  kiyohara 	/* Wildcard not accept */
    162   1.1  kiyohara 	if (aa->aa_offset == WINDERMERECF_OFFSET_DEFAULT ||
    163   1.1  kiyohara 	    aa->aa_irq == WINDERMERECF_IRQ_DEFAULT)
    164   1.1  kiyohara 		return 0;
    165   1.1  kiyohara 
    166   1.1  kiyohara 	aa->aa_size = UART_SIZE;
    167   1.1  kiyohara 	return 1;
    168   1.1  kiyohara }
    169   1.1  kiyohara 
    170   1.1  kiyohara /* ARGSUSED */
    171   1.1  kiyohara static void
    172   1.1  kiyohara wmcom_attach(device_t parent, device_t self, void *aux)
    173   1.1  kiyohara {
    174   1.1  kiyohara 	struct wmcom_softc *sc = device_private(self);
    175   1.1  kiyohara 	struct windermere_attach_args *aa = aux;
    176   1.1  kiyohara 
    177   1.1  kiyohara 	aprint_naive("\n");
    178   1.1  kiyohara 	aprint_normal("\n");
    179   1.1  kiyohara 
    180   1.1  kiyohara 	sc->sc_dev = self;
    181   1.1  kiyohara 	if (windermere_bus_space_subregion(aa->aa_iot, *aa->aa_ioh,
    182   1.1  kiyohara 				aa->aa_offset, aa->aa_size, &sc->sc_ioh) != 0) {
    183   1.1  kiyohara 		aprint_error_dev(self, "can't map registers\n");
    184   1.1  kiyohara 		return;
    185   1.1  kiyohara 	}
    186   1.1  kiyohara 	sc->sc_iot = aa->aa_iot;
    187   1.1  kiyohara 	if (intr_establish(aa->aa_irq, IPL_SERIAL, 0, wmcom_intr, sc) == NULL) {
    188   1.1  kiyohara 		aprint_error_dev(self, "can't establish interrupt\n");
    189   1.1  kiyohara 		return;
    190   1.1  kiyohara 	}
    191   1.1  kiyohara 
    192   1.1  kiyohara 	if (aa->aa_offset == (wmcom_cnaddr & 0xfff))
    193   1.1  kiyohara 		SET(sc->sc_hwflags, COM_HW_CONSOLE);
    194   1.1  kiyohara 
    195   1.1  kiyohara 	if (aa->aa_offset == WINDERMERE_COM0_OFFSET)
    196   1.1  kiyohara 		SET(sc->sc_flags, WMCOM_IRDA);
    197   1.1  kiyohara 
    198   1.1  kiyohara 	sc->sc_tty = tty_alloc();
    199   1.1  kiyohara 	sc->sc_tty->t_oproc = wmcom_start;
    200   1.1  kiyohara 	sc->sc_tty->t_param = wmcom_param;
    201   1.1  kiyohara 	sc->sc_tty->t_hwiflow = wmcom_hwiflow;
    202   1.1  kiyohara 
    203   1.1  kiyohara 	sc->sc_tbc = 0;
    204   1.8       chs 	sc->sc_rbuf = malloc(WMCOM_RING_SIZE << 1, M_DEVBUF, M_WAITOK);
    205   1.1  kiyohara 	sc->sc_rbput = sc->sc_rbget = sc->sc_rbuf;
    206   1.1  kiyohara 	sc->sc_rbavail = WMCOM_RING_SIZE;
    207   1.1  kiyohara 
    208   1.1  kiyohara 	tty_attach(sc->sc_tty);
    209   1.1  kiyohara 
    210   1.1  kiyohara 	if (ISSET(sc->sc_hwflags, COM_HW_CONSOLE)) {
    211   1.1  kiyohara 		int maj = cdevsw_lookup_major(&wmcom_cdevsw);
    212   1.1  kiyohara 
    213   1.1  kiyohara 		sc->sc_tty->t_dev = makedev(maj, device_unit(sc->sc_dev));
    214   1.1  kiyohara 		cn_tab->cn_dev = sc->sc_tty->t_dev;
    215   1.1  kiyohara 
    216   1.1  kiyohara 		aprint_normal_dev(self, "console\n");
    217   1.1  kiyohara 	}
    218   1.1  kiyohara 
    219   1.1  kiyohara 	sc->sc_si = softint_establish(SOFTINT_SERIAL, wmcom_soft, sc);
    220   1.1  kiyohara 
    221   1.1  kiyohara #ifdef RND_COM
    222   1.1  kiyohara 	rnd_attach_source(&sc->rnd_source, device_xname(sc->sc_dev),
    223   1.4       tls 	    RND_TYPE_TTY, RND_FLAG_DEFAULT);
    224   1.1  kiyohara #endif
    225   1.1  kiyohara 
    226   1.1  kiyohara 	SET(sc->sc_hwflags, COM_HW_DEV_OK);
    227   1.1  kiyohara }
    228   1.1  kiyohara 
    229   1.1  kiyohara static int
    230   1.1  kiyohara wmcom_intr(void *arg)
    231   1.1  kiyohara {
    232   1.1  kiyohara 	struct wmcom_softc *sc = arg;
    233   1.1  kiyohara 	bus_space_tag_t iot = sc->sc_iot;
    234   1.1  kiyohara 	bus_space_handle_t ioh = sc->sc_ioh;
    235   1.1  kiyohara 	int cc;
    236   1.1  kiyohara 	uint32_t data;
    237   1.1  kiyohara 	uint8_t fr, intm;
    238   1.1  kiyohara 	u_char *put;
    239   1.1  kiyohara 
    240   1.1  kiyohara 	if (!device_is_active(sc->sc_dev))
    241   1.1  kiyohara 		return 0;
    242   1.1  kiyohara 
    243   1.1  kiyohara 	fr = bus_space_read_1(iot, ioh, UARTFR);
    244   1.1  kiyohara 	intm = bus_space_read_1(iot, ioh, UARTINTM);
    245   1.1  kiyohara 	if (bus_space_read_1(iot, ioh, UARTINT) & INT_RXINT) {
    246   1.1  kiyohara 		put = sc->sc_rbput;
    247   1.1  kiyohara 		cc = sc->sc_rbavail;
    248   1.1  kiyohara 		while (cc > 0) {
    249   1.1  kiyohara 			if (ISSET(fr, FR_RXFE))
    250   1.1  kiyohara 				break;
    251   1.1  kiyohara 			data = bus_space_read_4(iot, ioh, UARTDR);
    252   1.1  kiyohara 			cn_check_magic(sc->sc_tty->t_dev, data & 0xff,
    253   1.1  kiyohara 			    wmcom_cnm_state);
    254   1.1  kiyohara 
    255   1.1  kiyohara 			put[0] = data & 0xff;
    256   1.1  kiyohara 			put[1] = (data >> 8) & 0xff;
    257   1.1  kiyohara 			put += 2;
    258   1.1  kiyohara 			if (put >= sc->sc_rbuf + (WMCOM_RING_SIZE << 1))
    259   1.1  kiyohara 				put = sc->sc_rbuf;
    260   1.1  kiyohara 			cc--;
    261   1.1  kiyohara 			sc->sc_rx_ready = 1;
    262   1.1  kiyohara 
    263   1.1  kiyohara 			fr = bus_space_read_1(iot, ioh, UARTFR);
    264   1.1  kiyohara 		}
    265   1.1  kiyohara 
    266   1.1  kiyohara 		/*
    267   1.1  kiyohara 		 * Current string of incoming characters ended because
    268   1.1  kiyohara 		 * no more data was available or we ran out of space.
    269   1.1  kiyohara 		 * Schedule a receive event if any data was received.
    270   1.1  kiyohara 		 * If we're out of space, turn off receive interrupts.
    271   1.1  kiyohara 		 */
    272   1.1  kiyohara 		sc->sc_rbput = put;
    273   1.1  kiyohara 		sc->sc_rbavail = cc;
    274   1.1  kiyohara 
    275   1.1  kiyohara 		/*
    276   1.1  kiyohara 		 * See if we are in danger of overflowing a buffer. If
    277   1.1  kiyohara 		 * so, use hardware flow control to ease the pressure.
    278   1.1  kiyohara 		 */
    279   1.1  kiyohara 
    280   1.1  kiyohara 		/* but wmcom cannot. X-( */
    281   1.1  kiyohara 
    282   1.1  kiyohara 		/*
    283   1.1  kiyohara 		 * If we're out of space, disable receive interrupts
    284   1.1  kiyohara 		 * until the queue has drained a bit.
    285   1.1  kiyohara 		 */
    286   1.1  kiyohara 		if (cc <= 0)
    287   1.1  kiyohara 			CLR(intm, INT_RXINT);
    288   1.1  kiyohara 	}
    289   1.1  kiyohara 
    290   1.1  kiyohara 	/*
    291   1.1  kiyohara 	 * Done handling any receive interrupts. See if data can be
    292   1.1  kiyohara 	 * transmitted as well. Schedule tx done event if no data left
    293   1.1  kiyohara 	 * and tty was marked busy.
    294   1.1  kiyohara 	 */
    295   1.1  kiyohara 
    296   1.1  kiyohara 	if (!ISSET(fr, FR_TXFF)) {
    297   1.1  kiyohara 		/* Output the next chunk of the contiguous buffer, if any. */
    298   1.1  kiyohara 		if (sc->sc_tbc > 0) {
    299   1.1  kiyohara 			while (sc->sc_tbc > 0 && !ISSET(fr, FR_TXFF)) {
    300   1.1  kiyohara 				bus_space_write_1(iot, ioh, UARTDR,
    301   1.1  kiyohara 				    *sc->sc_tba);
    302   1.1  kiyohara 				sc->sc_tba++;
    303   1.1  kiyohara 				sc->sc_tbc--;
    304   1.1  kiyohara 				fr = bus_space_read_1(iot, ioh, UARTFR);
    305   1.1  kiyohara 			}
    306   1.1  kiyohara 		} else if (!ISSET(fr, FR_BUSY) && ISSET(intm, INT_TXINT)) {
    307   1.1  kiyohara 			CLR(intm, INT_TXINT);
    308   1.1  kiyohara 			sc->sc_tx_done = 1;
    309   1.1  kiyohara 		}
    310   1.1  kiyohara 	}
    311   1.1  kiyohara 
    312   1.1  kiyohara 	bus_space_write_1(iot, ioh, UARTINTM, intm);
    313   1.1  kiyohara 
    314   1.1  kiyohara 	/* Wake up the poller. */
    315   1.1  kiyohara 	softint_schedule(sc->sc_si);
    316   1.1  kiyohara 
    317   1.1  kiyohara 	return 1;
    318   1.1  kiyohara }
    319   1.1  kiyohara 
    320   1.1  kiyohara static void
    321   1.1  kiyohara wmcom_soft(void *arg)
    322   1.1  kiyohara {
    323   1.1  kiyohara 	struct wmcom_softc *sc = arg;
    324   1.1  kiyohara 	struct tty *tp = sc->sc_tty;
    325   1.1  kiyohara 
    326   1.1  kiyohara 	if (!device_is_active(sc->sc_dev))
    327   1.1  kiyohara 		return;
    328   1.1  kiyohara 
    329   1.1  kiyohara 	if (sc->sc_rx_ready) {
    330   1.1  kiyohara 		sc->sc_rx_ready = 0;
    331   1.1  kiyohara 		wmcom_rxsoft(sc, tp);
    332   1.1  kiyohara 	}
    333   1.1  kiyohara 	if (sc->sc_tx_done) {
    334   1.1  kiyohara 		sc->sc_tx_done = 0;
    335   1.1  kiyohara 		CLR(tp->t_state, TS_BUSY);
    336   1.1  kiyohara 		if (ISSET(tp->t_state, TS_FLUSH))
    337   1.1  kiyohara 			CLR(tp->t_state, TS_FLUSH);
    338   1.1  kiyohara 		else
    339   1.1  kiyohara 			ndflush(&tp->t_outq,
    340   1.1  kiyohara 			    (int)(sc->sc_tba - tp->t_outq.c_cf));
    341   1.1  kiyohara 		(*tp->t_linesw->l_start)(tp);
    342   1.1  kiyohara 	}
    343   1.1  kiyohara }
    344   1.1  kiyohara 
    345   1.1  kiyohara static void
    346   1.1  kiyohara wmcom_start(struct tty *tp)
    347   1.1  kiyohara {
    348   1.1  kiyohara 	struct wmcom_softc *sc
    349   1.1  kiyohara 		= device_lookup_private(&wmcom_cd, COMUNIT(tp->t_dev));
    350   1.1  kiyohara 	bus_space_tag_t iot = sc->sc_iot;
    351   1.1  kiyohara 	bus_space_handle_t ioh = sc->sc_ioh;
    352   1.1  kiyohara 	int s, n;
    353   1.1  kiyohara 	uint8_t intm;
    354   1.1  kiyohara 
    355   1.1  kiyohara 	if (!device_is_active(sc->sc_dev))
    356   1.1  kiyohara 		return;
    357   1.1  kiyohara 
    358   1.1  kiyohara 	s = spltty();
    359   1.1  kiyohara 	if (ISSET(tp->t_state, TS_BUSY | TS_TIMEOUT | TS_TTSTOP))
    360   1.1  kiyohara 		goto out;
    361   1.1  kiyohara 	if (!ttypull(tp))
    362   1.1  kiyohara 		goto out;
    363   1.1  kiyohara 
    364   1.1  kiyohara 	/* Grab the first contiguous region of buffer space. */
    365   1.1  kiyohara 	{
    366   1.1  kiyohara 		u_char *tba;
    367   1.1  kiyohara 		int tbc;
    368   1.1  kiyohara 
    369   1.1  kiyohara 		tba = tp->t_outq.c_cf;
    370   1.1  kiyohara 		tbc = ndqb(&tp->t_outq, 0);
    371   1.1  kiyohara 
    372   1.1  kiyohara 		(void)splserial();
    373   1.1  kiyohara 
    374   1.1  kiyohara 		sc->sc_tba = tba;
    375   1.1  kiyohara 		sc->sc_tbc = tbc;
    376   1.1  kiyohara 	}
    377   1.1  kiyohara 
    378   1.1  kiyohara 	SET(tp->t_state, TS_BUSY);
    379   1.1  kiyohara 
    380   1.1  kiyohara 	intm = bus_space_read_1(iot, ioh, UARTINTM);
    381   1.1  kiyohara 	if (!ISSET(intm, INT_TXINT)) {
    382   1.1  kiyohara 		bus_space_write_1(iot, ioh, UARTINTM, intm | INT_TXINT);
    383   1.1  kiyohara 
    384   1.1  kiyohara 		/* Output the first chunk of the contiguous buffer. */
    385   1.7  riastrad 		n = uimin(sc->sc_tbc, UART_FIFO_SIZE);
    386   1.1  kiyohara 		bus_space_write_multi_1(iot, ioh, UARTDR, sc->sc_tba, n);
    387   1.1  kiyohara 		sc->sc_tba += n;
    388   1.1  kiyohara 		sc->sc_tbc -= n;
    389   1.1  kiyohara 	}
    390   1.1  kiyohara out:
    391   1.1  kiyohara 	splx(s);
    392   1.1  kiyohara 	return;
    393   1.1  kiyohara }
    394   1.1  kiyohara 
    395   1.1  kiyohara static int
    396   1.1  kiyohara wmcom_param(struct tty *tp, struct termios *t)
    397   1.1  kiyohara {
    398   1.1  kiyohara 	struct wmcom_softc *sc =
    399   1.1  kiyohara 	    device_lookup_private(&wmcom_cd, COMUNIT(tp->t_dev));
    400   1.1  kiyohara 	bus_space_tag_t iot = sc->sc_iot;
    401   1.1  kiyohara 	bus_space_handle_t ioh = sc->sc_ioh;
    402   1.1  kiyohara 	int s;
    403   1.1  kiyohara 
    404   1.1  kiyohara 	if (!device_is_active(sc->sc_dev))
    405   1.1  kiyohara 		return ENXIO;
    406   1.1  kiyohara 	if (t->c_ispeed && t->c_ispeed != t->c_ospeed)
    407   1.1  kiyohara 		return EINVAL;
    408   1.1  kiyohara 
    409   1.1  kiyohara 	/*
    410   1.1  kiyohara 	 * For the console, always force CLOCAL and !HUPCL, so that the port
    411   1.1  kiyohara 	 * is always active.
    412   1.1  kiyohara 	 */
    413   1.1  kiyohara 	if (ISSET(sc->sc_swflags, TIOCFLAG_SOFTCAR) ||
    414   1.1  kiyohara 	    ISSET(sc->sc_hwflags, COM_HW_CONSOLE)) {
    415   1.1  kiyohara 		SET(t->c_cflag, CLOCAL);
    416   1.1  kiyohara 		CLR(t->c_cflag, HUPCL);
    417   1.1  kiyohara 	}
    418   1.1  kiyohara 
    419   1.1  kiyohara 	/*
    420   1.1  kiyohara 	 * If there were no changes, don't do anything.  This avoids dropping
    421   1.1  kiyohara 	 * input and improves performance when all we did was frob things like
    422   1.1  kiyohara 	 * VMIN and VTIME.
    423   1.1  kiyohara 	 */
    424   1.1  kiyohara 	if (tp->t_ospeed == t->c_ospeed &&
    425   1.1  kiyohara 	    tp->t_cflag == t->c_cflag)
    426   1.1  kiyohara 		return 0;
    427   1.1  kiyohara 
    428   1.1  kiyohara 	s = splserial();
    429   1.1  kiyohara 	bus_space_write_4(iot, ioh, UARTLCR, wmcom_rate2lcr(t->c_ospeed));
    430   1.1  kiyohara 	bus_space_write_1(iot, ioh, UARTFCR, wmcom_cflag2fcr(t->c_cflag));
    431   1.1  kiyohara 
    432   1.1  kiyohara 	/* And copy to tty. */
    433   1.1  kiyohara 	tp->t_ispeed = 0;
    434   1.1  kiyohara 	tp->t_ospeed = t->c_ospeed;
    435   1.1  kiyohara 	tp->t_cflag = t->c_cflag;
    436   1.1  kiyohara 	splx(s);
    437   1.1  kiyohara 
    438   1.1  kiyohara 	/*
    439   1.1  kiyohara 	 * Update the tty layer's idea of the carrier bit.
    440   1.1  kiyohara 	 * We tell tty the carrier is always on.
    441   1.1  kiyohara 	 */
    442   1.1  kiyohara 	(*tp->t_linesw->l_modem)(tp, 1);
    443   1.1  kiyohara 
    444   1.1  kiyohara 	return 0;
    445   1.1  kiyohara }
    446   1.1  kiyohara 
    447   1.1  kiyohara static int
    448   1.1  kiyohara wmcom_hwiflow(struct tty *tp, int block)
    449   1.1  kiyohara {
    450   1.1  kiyohara 	/* Nothing */
    451   1.1  kiyohara 	return 0;
    452   1.1  kiyohara }
    453   1.1  kiyohara 
    454   1.1  kiyohara /* ARGSUSED */
    455   1.1  kiyohara int
    456   1.1  kiyohara wmcomopen(dev_t dev, int flag, int mode, struct lwp *l)
    457   1.1  kiyohara {
    458   1.1  kiyohara 	struct wmcom_softc *sc;
    459   1.1  kiyohara 	struct tty *tp;
    460   1.1  kiyohara 	int error, s, s2;
    461   1.1  kiyohara 	uint8_t con;
    462   1.1  kiyohara 
    463   1.1  kiyohara 	sc = device_lookup_private(&wmcom_cd, COMUNIT(dev));
    464   1.1  kiyohara 	if (sc == NULL || !ISSET(sc->sc_hwflags, COM_HW_DEV_OK))
    465   1.1  kiyohara 		return ENXIO;
    466   1.1  kiyohara 	if (!device_is_active(sc->sc_dev))
    467   1.1  kiyohara 		return ENXIO;
    468   1.1  kiyohara 
    469   1.1  kiyohara #ifdef KGDB
    470   1.1  kiyohara 	/*
    471   1.1  kiyohara 	 * If this is the kgdb port, no other use is permitted.
    472   1.1  kiyohara 	 */
    473   1.1  kiyohara 	if (ISSET(sc->sc_hwflags, COM_HW_KGDB))
    474   1.1  kiyohara 		return EBUSY;
    475   1.1  kiyohara #endif
    476   1.1  kiyohara 
    477   1.1  kiyohara 	tp = sc->sc_tty;
    478   1.1  kiyohara 
    479   1.1  kiyohara 	if (kauth_authorize_device_tty(l->l_cred, KAUTH_DEVICE_TTY_OPEN, tp))
    480   1.1  kiyohara 		return EBUSY;
    481   1.1  kiyohara 
    482   1.1  kiyohara 	s = spltty();
    483   1.1  kiyohara 
    484   1.1  kiyohara 	/*
    485   1.1  kiyohara 	 * Do the following iff this is a first open.
    486   1.1  kiyohara 	 */
    487   1.1  kiyohara 	if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
    488   1.1  kiyohara 		struct termios t;
    489   1.1  kiyohara 
    490   1.1  kiyohara 		tp->t_dev = dev;
    491   1.1  kiyohara 
    492   1.1  kiyohara 		/* Enable and turn on interrupt */
    493   1.1  kiyohara 		con = CON_UARTEN;
    494   1.1  kiyohara 		if (ISSET(sc->sc_flags, WMCOM_IRDA))
    495   1.1  kiyohara 			con |= CON_IRTXM;
    496   1.1  kiyohara 		bus_space_write_1(sc->sc_iot, sc->sc_ioh, UARTCON, con);
    497   1.1  kiyohara 		bus_space_write_1(sc->sc_iot, sc->sc_ioh, UARTINTM, INT_RXINT);
    498   1.1  kiyohara 
    499   1.1  kiyohara 		/*
    500   1.1  kiyohara 		 * Initialize the termios status to the defaults.  Add in the
    501   1.1  kiyohara 		 * sticky bits from TIOCSFLAGS.
    502   1.1  kiyohara 		 */
    503   1.1  kiyohara 		t.c_ispeed = 0;
    504   1.1  kiyohara 		if (ISSET(sc->sc_hwflags, COM_HW_CONSOLE)) {
    505   1.1  kiyohara 			t.c_ospeed = wmcom_cnrate;
    506   1.1  kiyohara 			t.c_cflag = wmcom_cncflag;
    507   1.1  kiyohara 		} else {
    508   1.1  kiyohara 			t.c_ospeed = TTYDEF_SPEED;
    509   1.1  kiyohara 			t.c_cflag = TTYDEF_CFLAG;
    510   1.1  kiyohara 		}
    511   1.1  kiyohara 		if (ISSET(sc->sc_swflags, TIOCFLAG_CLOCAL))
    512   1.1  kiyohara 			SET(t.c_cflag, CLOCAL);
    513   1.1  kiyohara 		if (ISSET(sc->sc_swflags, TIOCFLAG_CRTSCTS))
    514   1.1  kiyohara 			SET(t.c_cflag, CRTSCTS);
    515   1.1  kiyohara 		if (ISSET(sc->sc_swflags, TIOCFLAG_MDMBUF))
    516   1.1  kiyohara 			SET(t.c_cflag, MDMBUF);
    517   1.1  kiyohara 		/* Make sure wmcom_param() we do something */
    518   1.1  kiyohara 		tp->t_ospeed = 0;
    519   1.1  kiyohara 		wmcom_param(tp, &t);
    520   1.1  kiyohara 		tp->t_iflag = TTYDEF_IFLAG;
    521   1.1  kiyohara 		tp->t_oflag = TTYDEF_OFLAG;
    522   1.1  kiyohara 		tp->t_lflag = TTYDEF_LFLAG;
    523   1.1  kiyohara 		ttychars(tp);
    524   1.1  kiyohara 		ttsetwater(tp);
    525   1.1  kiyohara 
    526   1.1  kiyohara 		s2 = splserial();
    527   1.1  kiyohara 
    528   1.1  kiyohara 		/* Clear the input ring. */
    529   1.1  kiyohara 		sc->sc_rbput = sc->sc_rbget = sc->sc_rbuf;
    530   1.1  kiyohara 		sc->sc_rbavail = WMCOM_RING_SIZE;
    531   1.1  kiyohara 		wmcom_iflush(sc);
    532   1.1  kiyohara 
    533   1.1  kiyohara 		splx(s2);
    534   1.1  kiyohara 	}
    535   1.1  kiyohara 
    536   1.1  kiyohara 	splx(s);
    537   1.1  kiyohara 
    538   1.1  kiyohara 	error = ttyopen(tp, COMDIALOUT(dev), ISSET(flag, O_NONBLOCK));
    539   1.1  kiyohara 	if (error)
    540   1.1  kiyohara 		goto bad;
    541   1.1  kiyohara 
    542   1.1  kiyohara 	error = (*tp->t_linesw->l_open)(dev, tp);
    543   1.1  kiyohara 	if (error)
    544   1.1  kiyohara 		goto bad;
    545   1.1  kiyohara 	return 0;
    546   1.1  kiyohara 
    547   1.1  kiyohara bad:
    548   1.1  kiyohara 	if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
    549   1.1  kiyohara 		/*
    550   1.1  kiyohara 		 * We failed to open the device, and nobody else had it opened.
    551   1.1  kiyohara 		 * Clean up the state as appropriate.
    552   1.1  kiyohara 		 */
    553   1.1  kiyohara 		wmcom_shutdown(sc);
    554   1.1  kiyohara 
    555   1.1  kiyohara 		/* Disable UART */
    556   1.1  kiyohara 		if (!ISSET(sc->sc_hwflags, COM_HW_CONSOLE))
    557   1.1  kiyohara 			bus_space_write_1(sc->sc_iot, sc->sc_ioh, UARTCON, 0);
    558   1.1  kiyohara 	}
    559   1.1  kiyohara 
    560   1.1  kiyohara 	return error;
    561   1.1  kiyohara }
    562   1.1  kiyohara 
    563   1.1  kiyohara /* ARGSUSED */
    564   1.1  kiyohara int
    565   1.1  kiyohara wmcomclose(dev_t dev, int flag, int mode, struct lwp *l)
    566   1.1  kiyohara {
    567   1.1  kiyohara 	struct wmcom_softc *sc = device_lookup_private(&wmcom_cd, COMUNIT(dev));
    568   1.1  kiyohara 	struct tty *tp = sc->sc_tty;
    569   1.1  kiyohara 
    570   1.1  kiyohara 	/* XXXX This is for cons.c. */
    571   1.1  kiyohara 	if (!ISSET(tp->t_state, TS_ISOPEN))
    572   1.1  kiyohara 		return 0;
    573   1.1  kiyohara 
    574   1.1  kiyohara 	(*tp->t_linesw->l_close)(tp, flag);
    575   1.1  kiyohara 	ttyclose(tp);
    576   1.1  kiyohara 
    577   1.1  kiyohara 	if (!device_is_active(sc->sc_dev))
    578   1.1  kiyohara 		return 0;
    579   1.1  kiyohara 
    580   1.1  kiyohara 	if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
    581   1.1  kiyohara 		/*
    582   1.1  kiyohara 		 * Although we got a last close, the device may still be in
    583   1.1  kiyohara 		 * use; e.g. if this was the dialout node, and there are still
    584   1.1  kiyohara 		 * processes waiting for carrier on the non-dialout node.
    585   1.1  kiyohara 		 */
    586   1.1  kiyohara 		wmcom_shutdown(sc);
    587   1.1  kiyohara 
    588   1.1  kiyohara 		/* Disable UART */
    589   1.1  kiyohara 		if (!ISSET(sc->sc_hwflags, COM_HW_CONSOLE))
    590   1.1  kiyohara 			bus_space_write_1(sc->sc_iot, sc->sc_ioh, UARTCON, 0);
    591   1.1  kiyohara 	}
    592   1.1  kiyohara 
    593   1.1  kiyohara 	return 0;
    594   1.1  kiyohara }
    595   1.1  kiyohara 
    596   1.1  kiyohara int
    597   1.1  kiyohara wmcomread(dev_t dev, struct uio *uio, int flag)
    598   1.1  kiyohara {
    599   1.1  kiyohara 	struct wmcom_softc *sc = device_lookup_private(&wmcom_cd, COMUNIT(dev));
    600   1.1  kiyohara 	struct tty *tp = sc->sc_tty;
    601   1.1  kiyohara 
    602   1.1  kiyohara 	if (!device_is_active(sc->sc_dev))
    603   1.1  kiyohara 		return EIO;
    604   1.1  kiyohara 
    605   1.1  kiyohara 	return (*tp->t_linesw->l_read)(tp, uio, flag);
    606   1.1  kiyohara }
    607   1.1  kiyohara 
    608   1.1  kiyohara int
    609   1.1  kiyohara wmcomwrite(dev_t dev, struct uio *uio, int flag)
    610   1.1  kiyohara {
    611   1.1  kiyohara 	struct wmcom_softc *sc = device_lookup_private(&wmcom_cd, COMUNIT(dev));
    612   1.1  kiyohara 	struct tty *tp = sc->sc_tty;
    613   1.1  kiyohara 
    614   1.1  kiyohara 	if (!device_is_active(sc->sc_dev))
    615   1.1  kiyohara 		return EIO;
    616   1.1  kiyohara 
    617   1.1  kiyohara 	return (*tp->t_linesw->l_write)(tp, uio, flag);
    618   1.1  kiyohara }
    619   1.1  kiyohara 
    620   1.1  kiyohara int
    621   1.1  kiyohara wmcomioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
    622   1.1  kiyohara {
    623   1.1  kiyohara 	struct wmcom_softc *sc = device_lookup_private(&wmcom_cd, COMUNIT(dev));
    624   1.1  kiyohara 	struct tty *tp = sc->sc_tty;
    625   1.1  kiyohara 	int error, s;
    626   1.1  kiyohara 
    627   1.1  kiyohara 	if (!device_is_active(sc->sc_dev))
    628   1.1  kiyohara 		return EIO;
    629   1.1  kiyohara 
    630   1.1  kiyohara 	error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, l);
    631   1.1  kiyohara 	if (error != EPASSTHROUGH)
    632   1.1  kiyohara 		return error;
    633   1.1  kiyohara 
    634   1.1  kiyohara 	error = ttioctl(tp, cmd, data, flag, l);
    635   1.1  kiyohara 	if (error != EPASSTHROUGH)
    636   1.1  kiyohara 		return error;
    637   1.1  kiyohara 
    638   1.1  kiyohara 	switch (cmd) {
    639   1.1  kiyohara 	case TIOCSFLAGS:
    640   1.1  kiyohara 		error = kauth_authorize_device_tty(l->l_cred,
    641   1.1  kiyohara 		    KAUTH_DEVICE_TTY_PRIVSET, tp);
    642   1.1  kiyohara 		break;
    643   1.1  kiyohara 	default:
    644   1.1  kiyohara 		break;
    645   1.1  kiyohara 	}
    646   1.1  kiyohara 	if (error)
    647   1.1  kiyohara 		return error;
    648   1.1  kiyohara 
    649   1.1  kiyohara 	s = splserial();
    650   1.1  kiyohara 	error = 0;
    651   1.1  kiyohara 	switch (cmd) {
    652   1.1  kiyohara 	case TIOCSBRK:
    653   1.1  kiyohara 		wmcom_break(sc, 1);
    654   1.1  kiyohara 		break;
    655   1.1  kiyohara 
    656   1.1  kiyohara 	case TIOCCBRK:
    657   1.1  kiyohara 		wmcom_break(sc, 0);
    658   1.1  kiyohara 		break;
    659   1.1  kiyohara 
    660   1.1  kiyohara 	case TIOCGFLAGS:
    661   1.1  kiyohara 		*(int *)data = sc->sc_swflags;
    662   1.1  kiyohara 		break;
    663   1.1  kiyohara 
    664   1.1  kiyohara 	case TIOCSFLAGS:
    665   1.1  kiyohara 		sc->sc_swflags = *(int *)data;
    666   1.1  kiyohara 		break;
    667   1.1  kiyohara 
    668   1.1  kiyohara 	default:
    669   1.1  kiyohara 		error = EPASSTHROUGH;
    670   1.1  kiyohara 		break;
    671   1.1  kiyohara 	}
    672   1.1  kiyohara 	splx(s);
    673   1.1  kiyohara 	return error;
    674   1.1  kiyohara }
    675   1.1  kiyohara 
    676   1.1  kiyohara int
    677   1.1  kiyohara wmcompoll(dev_t dev, int events, struct lwp *l)
    678   1.1  kiyohara {
    679   1.1  kiyohara 	struct wmcom_softc *sc = device_lookup_private(&wmcom_cd, COMUNIT(dev));
    680   1.1  kiyohara 	struct tty *tp = sc->sc_tty;
    681   1.1  kiyohara 
    682   1.1  kiyohara 	if (!device_is_active(sc->sc_dev))
    683   1.1  kiyohara 		return EIO;
    684   1.1  kiyohara 
    685   1.1  kiyohara 	return (*tp->t_linesw->l_poll)(tp, events, l);
    686   1.1  kiyohara }
    687   1.1  kiyohara 
    688   1.1  kiyohara struct tty *
    689   1.1  kiyohara wmcomtty(dev_t dev)
    690   1.1  kiyohara {
    691   1.1  kiyohara 	struct wmcom_softc *sc = device_lookup_private(&wmcom_cd, COMUNIT(dev));
    692   1.1  kiyohara 
    693   1.1  kiyohara 	return sc->sc_tty;
    694   1.1  kiyohara }
    695   1.1  kiyohara 
    696   1.1  kiyohara void
    697   1.1  kiyohara wmcomstop(struct tty *tp, int flag)
    698   1.1  kiyohara {
    699   1.1  kiyohara 	int s;
    700   1.1  kiyohara 
    701   1.1  kiyohara 	s = splserial();
    702   1.1  kiyohara 	if (ISSET(tp->t_state, TS_BUSY)) {
    703   1.1  kiyohara 		/* Stop transmitting at the next chunk. */
    704   1.1  kiyohara 		if (!ISSET(tp->t_state, TS_TTSTOP))
    705   1.1  kiyohara 			SET(tp->t_state, TS_FLUSH);
    706   1.1  kiyohara 	}
    707   1.1  kiyohara 	splx(s);
    708   1.1  kiyohara }
    709   1.1  kiyohara 
    710   1.1  kiyohara 
    711   1.1  kiyohara static void
    712   1.1  kiyohara wmcom_iflush(struct wmcom_softc *sc)
    713   1.1  kiyohara {
    714   1.1  kiyohara 	bus_space_tag_t iot = sc->sc_iot;
    715   1.1  kiyohara 	bus_space_handle_t ioh = sc->sc_ioh;
    716   1.1  kiyohara 	int timo;
    717   1.1  kiyohara 
    718   1.1  kiyohara 	timo = 50000;
    719   1.1  kiyohara 	while ((bus_space_read_1(iot, ioh, UARTFR) & FR_RXFE) == 0 &&
    720   1.1  kiyohara 	    timo--)
    721   1.1  kiyohara 		bus_space_read_1(iot, ioh, UARTDR);
    722   1.1  kiyohara 	if (timo == 0)
    723   1.1  kiyohara 		printf("%s: iflush timeout\n", device_xname(sc->sc_dev));
    724   1.1  kiyohara }
    725   1.1  kiyohara 
    726   1.1  kiyohara static void
    727   1.1  kiyohara wmcom_shutdown(struct wmcom_softc *sc)
    728   1.1  kiyohara {
    729   1.1  kiyohara 	int s;
    730   1.1  kiyohara 
    731   1.1  kiyohara 	s = splserial();
    732   1.1  kiyohara 
    733   1.1  kiyohara 	/* Turn off interrupt */
    734   1.1  kiyohara 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, UARTINTM, 0);
    735   1.1  kiyohara 
    736   1.1  kiyohara 	/* Clear any break condition set with TIOCSBRK. */
    737   1.1  kiyohara 	wmcom_break(sc, 0);
    738   1.1  kiyohara 
    739   1.1  kiyohara 	splx(s);
    740   1.1  kiyohara }
    741   1.1  kiyohara 
    742   1.1  kiyohara static void
    743   1.1  kiyohara wmcom_break(struct wmcom_softc *sc, int onoff)
    744   1.1  kiyohara {
    745   1.1  kiyohara 	int s;
    746   1.1  kiyohara 	uint8_t fcr;
    747   1.1  kiyohara 
    748   1.1  kiyohara 	s = splserial();
    749   1.1  kiyohara 	fcr = bus_space_read_1(sc->sc_iot, sc->sc_ioh, UARTFCR);
    750   1.1  kiyohara 	if (onoff)
    751   1.1  kiyohara 		SET(fcr, FCR_BREAK);
    752   1.1  kiyohara 	else
    753   1.1  kiyohara 		CLR(fcr, FCR_BREAK);
    754   1.1  kiyohara 	bus_space_write_1(sc->sc_iot, sc->sc_ioh, UARTFCR, fcr);
    755   1.1  kiyohara 	splx(s);
    756   1.1  kiyohara }
    757   1.1  kiyohara 
    758   1.1  kiyohara static void
    759   1.1  kiyohara wmcom_rxsoft(struct wmcom_softc *sc, struct tty *tp)
    760   1.1  kiyohara {
    761   1.1  kiyohara 	bus_space_tag_t iot = sc->sc_iot;
    762   1.1  kiyohara 	bus_space_handle_t ioh = sc->sc_ioh;
    763   1.1  kiyohara 	int code, s;
    764   1.1  kiyohara 	u_int cc, scc;
    765   1.1  kiyohara 	uint8_t intm;
    766   1.1  kiyohara 	u_char sts, *get;
    767   1.1  kiyohara 
    768   1.1  kiyohara 	get = sc->sc_rbget;
    769   1.1  kiyohara 	scc = cc = WMCOM_RING_SIZE - sc->sc_rbavail;
    770   1.1  kiyohara 	while (cc) {
    771   1.1  kiyohara 		code = get[0];
    772   1.1  kiyohara 		sts = get[1];
    773   1.1  kiyohara 		if (ISSET(sts, RSR_FE | RSR_PE | RSR_OE)) {
    774   1.1  kiyohara 			if (ISSET(sts, (RSR_FE)))
    775   1.1  kiyohara 				SET(code, TTY_FE);
    776   1.1  kiyohara 			if (ISSET(sts, RSR_PE))
    777   1.1  kiyohara 				SET(code, TTY_PE);
    778   1.1  kiyohara 			if (ISSET(sts, RSR_OE))
    779   1.1  kiyohara 				;		/* XXXXX: Overrun */
    780   1.1  kiyohara 		}
    781   1.1  kiyohara 		if ((*tp->t_linesw->l_rint)(code, tp) == -1) {
    782   1.1  kiyohara 			/*
    783   1.1  kiyohara 			 * The line discipline's buffer is out of space.
    784   1.1  kiyohara 			 */
    785   1.1  kiyohara 			/*
    786   1.1  kiyohara 			 * We're either not using flow control, or the
    787   1.1  kiyohara 			 * line discipline didn't tell us to block for
    788   1.1  kiyohara 			 * some reason.  Either way, we have no way to
    789   1.1  kiyohara 			 * know when there's more space available, so
    790   1.1  kiyohara 			 * just drop the rest of the data.
    791   1.1  kiyohara 			 */
    792   1.1  kiyohara 			get += cc << 1;
    793   1.1  kiyohara 			if (get >= sc->sc_rbuf + (WMCOM_RING_SIZE << 1))
    794   1.1  kiyohara 				get -= (WMCOM_RING_SIZE << 1);
    795   1.1  kiyohara 			cc = 0;
    796   1.1  kiyohara 			break;
    797   1.1  kiyohara 		}
    798   1.1  kiyohara 		get += 2;
    799   1.1  kiyohara 		if (get >= sc->sc_rbuf + (WMCOM_RING_SIZE << 1))
    800   1.1  kiyohara 			get = sc->sc_rbuf;
    801   1.1  kiyohara 		cc--;
    802   1.1  kiyohara 	}
    803   1.1  kiyohara 
    804   1.1  kiyohara 	if (cc != scc) {
    805   1.1  kiyohara 		sc->sc_rbget = get;
    806   1.1  kiyohara 		s = splserial();
    807   1.1  kiyohara 
    808   1.1  kiyohara 		cc = sc->sc_rbavail += scc - cc;
    809   1.1  kiyohara 		/* Buffers should be ok again, release possible block. */
    810   1.1  kiyohara 		if (cc >= 1) {
    811   1.1  kiyohara 			intm = bus_space_read_1(iot, ioh, UARTINTM);
    812   1.1  kiyohara 			SET(intm, INT_RXINT);
    813   1.1  kiyohara 			bus_space_write_1(iot, ioh, UARTINTM, intm);
    814   1.1  kiyohara 		}
    815   1.1  kiyohara 		splx(s);
    816   1.1  kiyohara 	}
    817   1.1  kiyohara }
    818   1.1  kiyohara 
    819   1.1  kiyohara static inline uint32_t
    820   1.1  kiyohara wmcom_rate2lcr(int rate)
    821   1.1  kiyohara {
    822   1.1  kiyohara 
    823   1.1  kiyohara 	return 7372800 / (16 * rate) - 1;
    824   1.1  kiyohara }
    825   1.1  kiyohara 
    826   1.1  kiyohara static uint8_t
    827   1.1  kiyohara wmcom_cflag2fcr(tcflag_t cflag)
    828   1.1  kiyohara {
    829   1.1  kiyohara 	int8_t fcr = FCR_UFIFOEN;
    830   1.1  kiyohara 
    831   1.1  kiyohara 	switch (cflag & CSIZE) {
    832   1.1  kiyohara 	case CS5: SET(fcr, FCR_WLEN_5); break;
    833   1.1  kiyohara 	case CS6: SET(fcr, FCR_WLEN_6); break;
    834   1.1  kiyohara 	case CS7: SET(fcr, FCR_WLEN_7); break;
    835   1.1  kiyohara 	case CS8: SET(fcr, FCR_WLEN_8); break;
    836   1.1  kiyohara 	default:  SET(fcr, FCR_WLEN_8); break;
    837   1.1  kiyohara 	}
    838   1.1  kiyohara 	if (cflag & CSTOPB)
    839   1.1  kiyohara 		SET(fcr, FCR_XSTOP);
    840   1.1  kiyohara 	if (cflag & PARENB) {
    841   1.1  kiyohara 		SET(fcr, (FCR_PRTEN | FCR_EVENPRT));
    842   1.1  kiyohara 		if (cflag & PARODD)
    843   1.1  kiyohara 			CLR(fcr, FCR_EVENPRT);
    844   1.1  kiyohara 	}
    845   1.1  kiyohara 	return fcr;
    846   1.1  kiyohara }
    847   1.1  kiyohara 
    848   1.1  kiyohara #define WMCOM_CNREAD_1(offset) \
    849   1.1  kiyohara 	(*(volatile uint8_t *)(wmcom_cnaddr + ((offset) << 2)))
    850   1.1  kiyohara #define WMCOM_CNREAD_4(offset) \
    851   1.1  kiyohara 	(*(volatile uint32_t *)(wmcom_cnaddr + ((offset) << 2)))
    852   1.1  kiyohara #define WMCOM_CNWRITE_1(offset, val) \
    853   1.1  kiyohara 	(*(volatile uint8_t *)(wmcom_cnaddr + ((offset) << 2)) = val)
    854   1.1  kiyohara #define WMCOM_CNWRITE_4(offset, val) \
    855   1.1  kiyohara 	(*(volatile uint32_t *)(wmcom_cnaddr + ((offset) << 2)) = val)
    856   1.1  kiyohara 
    857   1.1  kiyohara static struct consdev wmcomcons = {
    858   1.1  kiyohara 	NULL, NULL, wmcom_cngetc, wmcom_cnputc, wmcom_cnpollc, NULL, NULL, NULL,
    859   1.1  kiyohara 	NODEV, CN_NORMAL
    860   1.1  kiyohara };
    861   1.1  kiyohara 
    862   1.1  kiyohara int
    863   1.1  kiyohara wmcom_cnattach(vaddr_t addr, int rate, tcflag_t cflag, int irda)
    864   1.1  kiyohara {
    865   1.1  kiyohara 
    866   1.1  kiyohara 	wmcom_cnaddr = addr;
    867   1.1  kiyohara 	wmcom_cnrate = rate;
    868   1.1  kiyohara 	wmcom_cncflag = cflag;
    869   1.1  kiyohara 	WMCOM_CNWRITE_4(UARTLCR, wmcom_rate2lcr(rate));
    870   1.1  kiyohara 	WMCOM_CNWRITE_1(UARTFCR, wmcom_cflag2fcr(cflag));
    871   1.1  kiyohara 	if (irda)
    872   1.1  kiyohara 		WMCOM_CNWRITE_1(UARTCON, CON_UARTEN | CON_IRTXM);
    873   1.1  kiyohara 	else
    874   1.1  kiyohara 		WMCOM_CNWRITE_1(UARTCON, CON_UARTEN);
    875   1.1  kiyohara 
    876   1.1  kiyohara 	cn_tab = &wmcomcons;
    877   1.1  kiyohara 	cn_init_magic(&wmcom_cnm_state);
    878   1.1  kiyohara 	cn_set_magic("\047\001");	/* default magic is BREAK */
    879   1.1  kiyohara 
    880   1.1  kiyohara 	return 0;
    881   1.1  kiyohara }
    882   1.1  kiyohara 
    883   1.1  kiyohara /* ARGSUSED */
    884   1.1  kiyohara static int
    885   1.1  kiyohara wmcom_cngetc(dev_t dev)
    886   1.1  kiyohara {
    887   1.1  kiyohara 	int s = splserial();
    888   1.1  kiyohara 	char ch;
    889   1.1  kiyohara 
    890   1.1  kiyohara 	while (WMCOM_CNREAD_1(UARTFR) & FR_RXFE);
    891   1.1  kiyohara 
    892   1.1  kiyohara 	ch = WMCOM_CNREAD_4(UARTDR);
    893   1.1  kiyohara 
    894   1.1  kiyohara 	{
    895   1.1  kiyohara 		if (!db_active)
    896   1.1  kiyohara 			cn_check_magic(dev, ch, wmcom_cnm_state);
    897   1.1  kiyohara 	}
    898   1.1  kiyohara 
    899   1.1  kiyohara 	splx(s);
    900   1.1  kiyohara 	return ch;
    901   1.1  kiyohara }
    902   1.1  kiyohara 
    903   1.1  kiyohara /* ARGSUSED */
    904   1.1  kiyohara static void
    905   1.1  kiyohara wmcom_cnputc(dev_t dev, int c)
    906   1.1  kiyohara {
    907   1.1  kiyohara 	int s = splserial();
    908   1.1  kiyohara 
    909   1.1  kiyohara 	while (WMCOM_CNREAD_1(UARTFR) & FR_TXFF);
    910   1.1  kiyohara 
    911   1.1  kiyohara 	WMCOM_CNWRITE_1(UARTDR, c);
    912   1.1  kiyohara 
    913   1.1  kiyohara 	/* Make sure output. */
    914   1.1  kiyohara 	while (WMCOM_CNREAD_1(UARTFR) & FR_BUSY);
    915   1.1  kiyohara 
    916   1.1  kiyohara 	splx(s);
    917   1.1  kiyohara }
    918   1.1  kiyohara 
    919   1.1  kiyohara /* ARGSUSED */
    920   1.1  kiyohara static void
    921   1.1  kiyohara wmcom_cnpollc(dev_t dev, int on)
    922   1.1  kiyohara {
    923   1.1  kiyohara 	/* Nothing */
    924   1.1  kiyohara }
    925