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