| File: | dev/ic/cy.c |
| Warning: | line 1289, column 5 Access to field 't_state' results in a dereference of a null pointer (loaded from variable 'tp') |
Press '?' to see keyboard shortcuts
Keyboard shortcuts:
| 1 | /* $OpenBSD: cy.c,v 1.42 2023/09/11 08:41:26 mvs Exp $ */ | |||
| 2 | /* | |||
| 3 | * Copyright (c) 1996 Timo Rossi. | |||
| 4 | * All rights reserved. | |||
| 5 | * | |||
| 6 | * Redistribution and use in source and binary forms, with or without | |||
| 7 | * modification, are permitted provided that the following conditions | |||
| 8 | * are met: | |||
| 9 | * 1. Redistributions of source code must retain the above copyright | |||
| 10 | * notice, this list of conditions and the following disclaimer. | |||
| 11 | * 2. Redistributions in binary form must reproduce the above copyright | |||
| 12 | * notice, this list of conditions and the following disclaimer in the | |||
| 13 | * documentation and/or other materials provided with the distribution. | |||
| 14 | * 3. Neither the name of the author nor the names of contributors | |||
| 15 | * may be used to endorse or promote products derived from this software | |||
| 16 | * without specific prior written permission. | |||
| 17 | * | |||
| 18 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND | |||
| 19 | * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE | |||
| 20 | * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE | |||
| 21 | * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE | |||
| 22 | * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL | |||
| 23 | * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS | |||
| 24 | * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) | |||
| 25 | * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT | |||
| 26 | * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY | |||
| 27 | * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF | |||
| 28 | * SUCH DAMAGE. | |||
| 29 | */ | |||
| 30 | ||||
| 31 | /* | |||
| 32 | * cy.c | |||
| 33 | * | |||
| 34 | * Driver for Cyclades Cyclom-8/16/32 multiport serial cards | |||
| 35 | * (currently not tested with Cyclom-32 cards) | |||
| 36 | * | |||
| 37 | * Timo Rossi, 1996 | |||
| 38 | * | |||
| 39 | * Supports both ISA and PCI Cyclom cards | |||
| 40 | * | |||
| 41 | * Uses CD1400 automatic CTS flow control, and | |||
| 42 | * if CY_HW_RTS is defined, uses CD1400 automatic input flow control. | |||
| 43 | * This requires a special cable that exchanges the RTS and DTR lines. | |||
| 44 | * | |||
| 45 | * Lots of debug output can be enabled by defining CY_DEBUG | |||
| 46 | * Some debugging counters (number of receive/transmit interrupts etc.) | |||
| 47 | * can be enabled by defining CY_DEBUG1 | |||
| 48 | * | |||
| 49 | * This version uses the bus_space/io_??() stuff | |||
| 50 | * | |||
| 51 | */ | |||
| 52 | ||||
| 53 | #include <sys/param.h> | |||
| 54 | #include <sys/ioctl.h> | |||
| 55 | #include <sys/syslog.h> | |||
| 56 | #include <sys/fcntl.h> | |||
| 57 | #include <sys/tty.h> | |||
| 58 | #include <sys/conf.h> | |||
| 59 | #include <sys/device.h> | |||
| 60 | #include <sys/malloc.h> | |||
| 61 | #include <sys/systm.h> | |||
| 62 | ||||
| 63 | #include <machine/bus.h> | |||
| 64 | #include <machine/intr.h> | |||
| 65 | ||||
| 66 | #include <dev/ic/cd1400reg.h> | |||
| 67 | #include <dev/ic/cyreg.h> | |||
| 68 | ||||
| 69 | ||||
| 70 | int cy_intr(void *); | |||
| 71 | int cyparam(struct tty *, struct termios *); | |||
| 72 | void cystart(struct tty *); | |||
| 73 | void cy_poll(void *); | |||
| 74 | int cy_modem_control(struct cy_port *, int, int); | |||
| 75 | void cy_enable_transmitter(struct cy_port *); | |||
| 76 | void cd1400_channel_cmd(struct cy_port *, int); | |||
| 77 | int cy_speed(speed_t, int *, int *, int); | |||
| 78 | ||||
| 79 | struct cfdriver cy_cd = { | |||
| 80 | NULL((void *)0), "cy", DV_TTY | |||
| 81 | }; | |||
| 82 | ||||
| 83 | /* | |||
| 84 | * Common probe routine | |||
| 85 | * | |||
| 86 | * returns the number of chips found. | |||
| 87 | */ | |||
| 88 | int | |||
| 89 | cy_probe_common(bus_space_tag_t memt, bus_space_handle_t memh, int bustype) | |||
| 90 | { | |||
| 91 | int cy_chip, chip_offs; | |||
| 92 | u_char firmware_ver; | |||
| 93 | int nchips; | |||
| 94 | ||||
| 95 | /* Cyclom card hardware reset */ | |||
| 96 | bus_space_write_1(memt, memh, CY16_RESET<<bustype, 0)((memt)->write_1((memh), (0x1400<<bustype), (0))); | |||
| 97 | DELAY(500)(*delay_func)(500); /* wait for reset to complete */ | |||
| 98 | bus_space_write_1(memt, memh, CY_CLEAR_INTR<<bustype, 0)((memt)->write_1((memh), (0x1800<<bustype), (0))); | |||
| 99 | ||||
| 100 | #ifdef CY_DEBUG | |||
| 101 | printf("cy: card reset done\n"); | |||
| 102 | #endif | |||
| 103 | ||||
| 104 | nchips = 0; | |||
| 105 | ||||
| 106 | for (cy_chip = 0, chip_offs = 0; | |||
| 107 | cy_chip < CY_MAX_CD1400s8; | |||
| 108 | cy_chip++, chip_offs += (CY_CD1400_MEMSPACING0x400 << bustype)) { | |||
| 109 | int i; | |||
| 110 | ||||
| 111 | /* the last 4 cd1400s are 'interleaved' | |||
| 112 | with the first 4 on 32-port boards */ | |||
| 113 | if (cy_chip == 4) | |||
| 114 | chip_offs -= (CY32_ADDR_FIX0xe00 << bustype); | |||
| 115 | ||||
| 116 | #ifdef CY_DEBUG | |||
| 117 | printf("cy: probe chip %d offset 0x%x ... ", | |||
| 118 | cy_chip, chip_offs); | |||
| 119 | #endif | |||
| 120 | ||||
| 121 | /* wait until the chip is ready for command */ | |||
| 122 | DELAY(1000)(*delay_func)(1000); | |||
| 123 | if (bus_space_read_1(memt, memh, chip_offs +((memt)->read_1((memh), (chip_offs + ((0x05 << 1) << bustype)))) | |||
| 124 | ((CD1400_CCR << 1) << bustype))((memt)->read_1((memh), (chip_offs + ((0x05 << 1) << bustype)))) != 0) { | |||
| 125 | #ifdef CY_DEBUG | |||
| 126 | printf("not ready for command\n"); | |||
| 127 | #endif | |||
| 128 | break; | |||
| 129 | } | |||
| 130 | ||||
| 131 | /* clear the firmware version reg. */ | |||
| 132 | bus_space_write_1(memt, memh, chip_offs +((memt)->write_1((memh), (chip_offs + ((0x40 << 1) << bustype)), (0))) | |||
| 133 | ((CD1400_GFRCR << 1) << bustype), 0)((memt)->write_1((memh), (chip_offs + ((0x40 << 1) << bustype)), (0))); | |||
| 134 | ||||
| 135 | /* | |||
| 136 | * On Cyclom-16 references to non-existent chip 4 | |||
| 137 | * actually access chip 0 (address line 9 not decoded). | |||
| 138 | * Here we check if the clearing of chip 4 GFRCR actually | |||
| 139 | * cleared chip 0 GFRCR. In that case we have a 16 port card. | |||
| 140 | */ | |||
| 141 | if (cy_chip == 4 && | |||
| 142 | bus_space_read_1(memt, memh, chip_offs +((memt)->read_1((memh), (chip_offs + ((0x40 << 1) << bustype)))) | |||
| 143 | ((CD1400_GFRCR << 1) << bustype))((memt)->read_1((memh), (chip_offs + ((0x40 << 1) << bustype)))) == 0) | |||
| 144 | break; | |||
| 145 | ||||
| 146 | /* reset the chip */ | |||
| 147 | bus_space_write_1(memt, memh, chip_offs +((memt)->write_1((memh), (chip_offs + ((0x05 << 1) << bustype)), ((1<<7) | (1<<0)))) | |||
| 148 | ((CD1400_CCR << 1) << bustype),((memt)->write_1((memh), (chip_offs + ((0x05 << 1) << bustype)), ((1<<7) | (1<<0)))) | |||
| 149 | CD1400_CCR_CMDRESET | CD1400_CCR_FULLRESET)((memt)->write_1((memh), (chip_offs + ((0x05 << 1) << bustype)), ((1<<7) | (1<<0)))); | |||
| 150 | ||||
| 151 | /* wait for the chip to initialize itself */ | |||
| 152 | for (i = 0; i < 200; i++) { | |||
| 153 | DELAY(50)(*delay_func)(50); | |||
| 154 | firmware_ver = bus_space_read_1(memt, memh, chip_offs +((memt)->read_1((memh), (chip_offs + ((0x40 << 1) << bustype)))) | |||
| 155 | ((CD1400_GFRCR << 1) << bustype))((memt)->read_1((memh), (chip_offs + ((0x40 << 1) << bustype)))); | |||
| 156 | if ((firmware_ver & 0xf0) == 0x40) /* found a CD1400 */ | |||
| 157 | break; | |||
| 158 | } | |||
| 159 | #ifdef CY_DEBUG | |||
| 160 | printf("firmware version 0x%x\n", firmware_ver); | |||
| 161 | #endif | |||
| 162 | ||||
| 163 | if ((firmware_ver & 0xf0) != 0x40) | |||
| 164 | break; | |||
| 165 | ||||
| 166 | /* firmware version OK, CD1400 found */ | |||
| 167 | nchips++; | |||
| 168 | } | |||
| 169 | ||||
| 170 | if (nchips == 0) { | |||
| 171 | #ifdef CY_DEBUG | |||
| 172 | printf("no CD1400s found\n"); | |||
| 173 | #endif | |||
| 174 | return (0); | |||
| 175 | } | |||
| 176 | ||||
| 177 | #ifdef CY_DEBUG | |||
| 178 | printf("found %d CD1400s\n", nchips); | |||
| 179 | #endif | |||
| 180 | ||||
| 181 | return (nchips); | |||
| 182 | } | |||
| 183 | ||||
| 184 | void | |||
| 185 | cy_attach(struct device *parent, struct device *self) | |||
| 186 | { | |||
| 187 | int card, port, cy_chip, num_chips, cdu, chip_offs, cy_clock; | |||
| 188 | struct cy_softc *sc = (void *)self; | |||
| 189 | ||||
| 190 | card = sc->sc_dev.dv_unit; | |||
| 191 | num_chips = sc->sc_nr_cd1400s; | |||
| 192 | if (num_chips == 0) | |||
| 193 | return; | |||
| 194 | ||||
| 195 | timeout_set(&sc->sc_poll_to, cy_poll, sc); | |||
| 196 | bzero(sc->sc_ports, sizeof(sc->sc_ports))__builtin_bzero((sc->sc_ports), (sizeof(sc->sc_ports))); | |||
| 197 | sc->sc_nports = num_chips * CD1400_NO_OF_CHANNELS4; | |||
| 198 | ||||
| 199 | port = 0; | |||
| 200 | for (cy_chip = 0, chip_offs = 0; | |||
| 201 | cy_chip < num_chips; | |||
| 202 | cy_chip++, chip_offs += (CY_CD1400_MEMSPACING0x400<<sc->sc_bustype)) { | |||
| 203 | if (cy_chip == 4) | |||
| 204 | chip_offs -= (CY32_ADDR_FIX0xe00<<sc->sc_bustype); | |||
| 205 | ||||
| 206 | #ifdef CY_DEBUG | |||
| 207 | printf("attach CD1400 #%d offset 0x%x\n", cy_chip, chip_offs); | |||
| 208 | #endif | |||
| 209 | sc->sc_cd1400_offs[cy_chip] = chip_offs; | |||
| 210 | ||||
| 211 | /* configure port 0 as serial port | |||
| 212 | (should already be after reset) */ | |||
| 213 | cd_write_reg_sc(sc, cy_chip, CD1400_GCR, 0)((sc->sc_memt)->write_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x4B<<1))<<sc->sc_bustype)), ((0 )))); | |||
| 214 | ||||
| 215 | /* Set cy_clock depending on firmware version */ | |||
| 216 | if (cd_read_reg_sc(sc, cy_chip, CD1400_GFRCR)((sc->sc_memt)->read_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x40<<1))<<sc->sc_bustype)))) <= 0x46) | |||
| 217 | cy_clock = CY_CLOCK25000000; | |||
| 218 | else | |||
| 219 | cy_clock = CY_CLOCK_6060000000; | |||
| 220 | ||||
| 221 | /* set up a receive timeout period (1ms) */ | |||
| 222 | cd_write_reg_sc(sc, cy_chip, CD1400_PPR,((sc->sc_memt)->write_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x7E<<1))<<sc->sc_bustype)), ((( cy_clock / 512 / 1000) + 1)))) | |||
| 223 | (cy_clock / CD1400_PPR_PRESCALER / 1000) + 1)((sc->sc_memt)->write_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x7E<<1))<<sc->sc_bustype)), ((( cy_clock / 512 / 1000) + 1)))); | |||
| 224 | ||||
| 225 | for (cdu = 0; cdu < CD1400_NO_OF_CHANNELS4; cdu++) { | |||
| 226 | sc->sc_ports[port].cy_port_num = port; | |||
| 227 | sc->sc_ports[port].cy_memt = sc->sc_memt; | |||
| 228 | sc->sc_ports[port].cy_memh = sc->sc_memh; | |||
| 229 | sc->sc_ports[port].cy_chip_offs = chip_offs; | |||
| 230 | sc->sc_ports[port].cy_bustype = sc->sc_bustype; | |||
| 231 | sc->sc_ports[port].cy_clock = cy_clock; | |||
| 232 | ||||
| 233 | /* should we initialize anything else here? */ | |||
| 234 | port++; | |||
| 235 | } /* for(each port on one CD1400...) */ | |||
| 236 | ||||
| 237 | } /* for(each CD1400 on a card... ) */ | |||
| 238 | ||||
| 239 | printf(": %d ports\n", port); | |||
| 240 | ||||
| 241 | /* ensure an edge for the next interrupt */ | |||
| 242 | bus_space_write_1(sc->sc_memt, sc->sc_memh,((sc->sc_memt)->write_1((sc->sc_memh), (0x1800<< sc->sc_bustype), (0))) | |||
| 243 | CY_CLEAR_INTR<<sc->sc_bustype, 0)((sc->sc_memt)->write_1((sc->sc_memh), (0x1800<< sc->sc_bustype), (0))); | |||
| 244 | } | |||
| 245 | ||||
| 246 | /* | |||
| 247 | * open routine. returns zero if successful, else error code | |||
| 248 | */ | |||
| 249 | int cyopen(dev_t, int, int, struct proc *); | |||
| 250 | int cyclose(dev_t, int, int, struct proc *); | |||
| 251 | int cyread(dev_t, struct uio *, int); | |||
| 252 | int cywrite(dev_t, struct uio *, int); | |||
| 253 | struct tty *cytty(dev_t); | |||
| 254 | int cyioctl(dev_t, u_long, caddr_t, int, struct proc *); | |||
| 255 | int cystop(struct tty *, int flag); | |||
| 256 | ||||
| 257 | int | |||
| 258 | cyopen(dev_t dev, int flag, int mode, struct proc *p) | |||
| 259 | { | |||
| 260 | int card = CY_CARD(dev)((((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) >> 5) & 3); | |||
| 261 | int port = CY_PORT(dev)(((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) & 0xf); | |||
| 262 | struct cy_softc *sc; | |||
| 263 | struct cy_port *cy; | |||
| 264 | struct tty *tp; | |||
| 265 | int s, error; | |||
| 266 | ||||
| 267 | if (card >= cy_cd.cd_ndevs || | |||
| 268 | (sc = cy_cd.cd_devs[card]) == NULL((void *)0)) { | |||
| 269 | return (ENXIO6); | |||
| 270 | } | |||
| 271 | ||||
| 272 | #ifdef CY_DEBUG | |||
| 273 | printf("%s open port %d flag 0x%x mode 0x%x\n", sc->sc_dev.dv_xname, | |||
| 274 | port, flag, mode); | |||
| 275 | #endif | |||
| 276 | ||||
| 277 | cy = &sc->sc_ports[port]; | |||
| 278 | ||||
| 279 | s = spltty()splraise(0x9); | |||
| 280 | if (cy->cy_tty == NULL((void *)0)) { | |||
| 281 | cy->cy_tty = ttymalloc(0); | |||
| 282 | } | |||
| 283 | splx(s)spllower(s); | |||
| 284 | ||||
| 285 | tp = cy->cy_tty; | |||
| 286 | tp->t_oproc = cystart; | |||
| 287 | tp->t_param = cyparam; | |||
| 288 | tp->t_dev = dev; | |||
| 289 | ||||
| 290 | if (!ISSET(tp->t_state, TS_ISOPEN)((tp->t_state) & (0x00020))) { | |||
| 291 | SET(tp->t_state, TS_WOPEN)((tp->t_state) |= (0x00200)); | |||
| 292 | ttychars(tp); | |||
| 293 | tp->t_iflagt_termios.c_iflag = TTYDEF_IFLAG(0x00000002 | 0x00000100 | 0x00002000 | 0x00000200 | 0x00000800 ); | |||
| 294 | tp->t_oflagt_termios.c_oflag = TTYDEF_OFLAG(0x00000001 | 0x00000002); | |||
| 295 | tp->t_cflagt_termios.c_cflag = TTYDEF_CFLAG(0x00000800 | 0x00000300 | 0x00004000); | |||
| 296 | if (ISSET(cy->cy_openflags, TIOCFLAG_CLOCAL)((cy->cy_openflags) & (0x02))) | |||
| 297 | SET(tp->t_cflag, CLOCAL)((tp->t_termios.c_cflag) |= (0x00008000)); | |||
| 298 | if (ISSET(cy->cy_openflags, TIOCFLAG_CRTSCTS)((cy->cy_openflags) & (0x04))) | |||
| 299 | SET(tp->t_cflag, CRTSCTS)((tp->t_termios.c_cflag) |= (0x00010000)); | |||
| 300 | if (ISSET(cy->cy_openflags, TIOCFLAG_MDMBUF)((cy->cy_openflags) & (0x08))) | |||
| 301 | SET(tp->t_cflag, MDMBUF)((tp->t_termios.c_cflag) |= (0x00100000)); | |||
| 302 | tp->t_lflagt_termios.c_lflag = TTYDEF_LFLAG(0x00000008 | 0x00000100 | 0x00000080 | 0x00000400 | 0x00000002 |0x00000001|0x00000040); | |||
| 303 | tp->t_ispeedt_termios.c_ispeed = tp->t_ospeedt_termios.c_ospeed = TTYDEF_SPEED(9600); | |||
| 304 | ||||
| 305 | s = spltty()splraise(0x9); | |||
| 306 | ||||
| 307 | /* | |||
| 308 | * Allocate input ring buffer if we don't already have one | |||
| 309 | */ | |||
| 310 | if (cy->cy_ibuf == NULL((void *)0)) { | |||
| 311 | cy->cy_ibuf = malloc(IBUF_SIZE(2*512), M_DEVBUF2, M_NOWAIT0x0002); | |||
| 312 | if (cy->cy_ibuf == NULL((void *)0)) { | |||
| 313 | printf("%s: (port %d) can't allocate input buffer\n", | |||
| 314 | sc->sc_dev.dv_xname, port); | |||
| 315 | splx(s)spllower(s); | |||
| 316 | return (ENOMEM12); | |||
| 317 | } | |||
| 318 | cy->cy_ibuf_end = cy->cy_ibuf + IBUF_SIZE(2*512); | |||
| 319 | } | |||
| 320 | ||||
| 321 | /* mark the ring buffer as empty */ | |||
| 322 | cy->cy_ibuf_rd_ptr = cy->cy_ibuf_wr_ptr = cy->cy_ibuf; | |||
| 323 | ||||
| 324 | /* select CD1400 channel */ | |||
| 325 | cd_write_reg(cy, CD1400_CAR, port & CD1400_CAR_CHAN)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x68<<1))<<cy->cy_bustype)), ((port & ( 3<<0))))); | |||
| 326 | /* reset the channel */ | |||
| 327 | cd1400_channel_cmd(cy, CD1400_CCR_CMDRESET(1<<7)); | |||
| 328 | /* encode unit (port) number in LIVR */ | |||
| 329 | /* there is just enough space for 5 bits (32 ports) */ | |||
| 330 | cd_write_reg(cy, CD1400_LIVR, port << 3)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x18<<1))<<cy->cy_bustype)), ((port << 3)))); | |||
| 331 | ||||
| 332 | cy->cy_channel_control = 0; | |||
| 333 | ||||
| 334 | if (!timeout_pending(&sc->sc_poll_to)((&sc->sc_poll_to)->to_flags & 0x02)) | |||
| 335 | timeout_add(&sc->sc_poll_to, 1); | |||
| 336 | ||||
| 337 | /* this sets parameters and raises DTR */ | |||
| 338 | cyparam(tp, &tp->t_termios); | |||
| 339 | ||||
| 340 | ttsetwater(tp); | |||
| 341 | ||||
| 342 | /* raise RTS too */ | |||
| 343 | cy_modem_control(cy, TIOCM_RTS0004, DMBIS1); | |||
| 344 | ||||
| 345 | cy->cy_carrier_stat = cd_read_reg(cy, CD1400_MSVR2)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6D<<1))<<cy->cy_bustype)))); | |||
| 346 | ||||
| 347 | /* enable receiver and modem change interrupts */ | |||
| 348 | cd_write_reg(cy, CD1400_SRER,((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x06<<1))<<cy->cy_bustype)), (((1<<7 ) | (1<<4))))) | |||
| 349 | CD1400_SRER_MDMCH | CD1400_SRER_RXDATA)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x06<<1))<<cy->cy_bustype)), (((1<<7 ) | (1<<4))))); | |||
| 350 | ||||
| 351 | if (CY_DIALOUT(dev)((((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) & 0x80) != 0) || | |||
| 352 | ISSET(cy->cy_openflags, TIOCFLAG_SOFTCAR)((cy->cy_openflags) & (0x01)) || | |||
| 353 | ISSET(tp->t_cflag, MDMBUF)((tp->t_termios.c_cflag) & (0x00100000)) || | |||
| 354 | ISSET(cy->cy_carrier_stat, CD1400_MSVR2_CD)((cy->cy_carrier_stat) & ((1<<4)))) | |||
| 355 | SET(tp->t_state, TS_CARR_ON)((tp->t_state) |= (0x00008)); | |||
| 356 | else | |||
| 357 | CLR(tp->t_state, TS_CARR_ON)((tp->t_state) &= ~(0x00008)); | |||
| 358 | } else if (ISSET(tp->t_state, TS_XCLUDE)((tp->t_state) & (0x00400)) && suser(p) != 0) { | |||
| 359 | return (EBUSY16); | |||
| 360 | } else { | |||
| 361 | s = spltty()splraise(0x9); | |||
| 362 | } | |||
| 363 | ||||
| 364 | /* wait for carrier if necessary */ | |||
| 365 | if (!ISSET(flag, O_NONBLOCK)((flag) & (0x0004))) { | |||
| 366 | while (!ISSET(tp->t_cflag, CLOCAL)((tp->t_termios.c_cflag) & (0x00008000)) && | |||
| 367 | !ISSET(tp->t_state, TS_CARR_ON)((tp->t_state) & (0x00008))) { | |||
| 368 | SET(tp->t_state, TS_WOPEN)((tp->t_state) |= (0x00200)); | |||
| 369 | error = ttysleep(tp, &tp->t_rawq, TTIPRI25 | PCATCH0x100, | |||
| 370 | ttopen); | |||
| 371 | if (error != 0) { | |||
| 372 | splx(s)spllower(s); | |||
| 373 | CLR(tp->t_state, TS_WOPEN)((tp->t_state) &= ~(0x00200)); | |||
| 374 | return (error); | |||
| 375 | } | |||
| 376 | } | |||
| 377 | } | |||
| 378 | ||||
| 379 | splx(s)spllower(s); | |||
| 380 | ||||
| 381 | return (*linesw[tp->t_line].l_open)(dev, tp, p); | |||
| 382 | } | |||
| 383 | ||||
| 384 | /* | |||
| 385 | * close routine. returns zero if successful, else error code | |||
| 386 | */ | |||
| 387 | int | |||
| 388 | cyclose(dev_t dev, int flag, int mode, struct proc *p) | |||
| 389 | { | |||
| 390 | int card = CY_CARD(dev)((((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) >> 5) & 3); | |||
| 391 | int port = CY_PORT(dev)(((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) & 0xf); | |||
| 392 | struct cy_softc *sc = cy_cd.cd_devs[card]; | |||
| 393 | struct cy_port *cy = &sc->sc_ports[port]; | |||
| 394 | struct tty *tp = cy->cy_tty; | |||
| 395 | int s; | |||
| 396 | ||||
| 397 | #ifdef CY_DEBUG | |||
| 398 | printf("%s close port %d, flag 0x%x, mode 0x%x\n", sc->sc_dev.dv_xname, | |||
| 399 | port, flag, mode); | |||
| 400 | #endif | |||
| 401 | ||||
| 402 | (*linesw[tp->t_line].l_close)(tp, flag, p); | |||
| 403 | s = spltty()splraise(0x9); | |||
| 404 | ||||
| 405 | if (ISSET(tp->t_cflag, HUPCL)((tp->t_termios.c_cflag) & (0x00004000)) && | |||
| 406 | !ISSET(cy->cy_openflags, TIOCFLAG_SOFTCAR)((cy->cy_openflags) & (0x01))) { | |||
| 407 | /* drop DTR and RTS | |||
| 408 | (should we wait for output buffer to become empty first?) */ | |||
| 409 | cy_modem_control(cy, 0, DMSET0); | |||
| 410 | } | |||
| 411 | ||||
| 412 | /* | |||
| 413 | * XXX should we disable modem change and | |||
| 414 | * receive interrupts here or somewhere ? | |||
| 415 | */ | |||
| 416 | CLR(tp->t_state, TS_BUSY | TS_FLUSH)((tp->t_state) &= ~(0x00004 | 0x00010)); | |||
| 417 | ||||
| 418 | splx(s)spllower(s); | |||
| 419 | ttyclose(tp); | |||
| 420 | ||||
| 421 | return (0); | |||
| 422 | } | |||
| 423 | ||||
| 424 | /* | |||
| 425 | * Read routine | |||
| 426 | */ | |||
| 427 | int | |||
| 428 | cyread(dev_t dev, struct uio *uio, int flag) | |||
| 429 | { | |||
| 430 | int card = CY_CARD(dev)((((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) >> 5) & 3); | |||
| 431 | int port = CY_PORT(dev)(((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) & 0xf); | |||
| 432 | struct cy_softc *sc = cy_cd.cd_devs[card]; | |||
| 433 | struct cy_port *cy = &sc->sc_ports[port]; | |||
| 434 | struct tty *tp = cy->cy_tty; | |||
| 435 | ||||
| 436 | #ifdef CY_DEBUG | |||
| 437 | printf("%s read port %d uio %p flag 0x%x\n", sc->sc_dev.dv_xname, | |||
| 438 | port, uio, flag); | |||
| 439 | #endif | |||
| 440 | ||||
| 441 | return ((*linesw[tp->t_line].l_read)(tp, uio, flag)); | |||
| 442 | } | |||
| 443 | ||||
| 444 | /* | |||
| 445 | * Write routine | |||
| 446 | */ | |||
| 447 | int | |||
| 448 | cywrite(dev_t dev, struct uio *uio, int flag) | |||
| 449 | { | |||
| 450 | int card = CY_CARD(dev)((((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) >> 5) & 3); | |||
| 451 | int port = CY_PORT(dev)(((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) & 0xf); | |||
| 452 | struct cy_softc *sc = cy_cd.cd_devs[card]; | |||
| 453 | struct cy_port *cy = &sc->sc_ports[port]; | |||
| 454 | struct tty *tp = cy->cy_tty; | |||
| 455 | ||||
| 456 | #ifdef CY_DEBUG | |||
| 457 | printf("%s write port %d uio %p flag 0x%x\n", sc->sc_dev.dv_xname, | |||
| 458 | port, uio, flag); | |||
| 459 | #endif | |||
| 460 | ||||
| 461 | return ((*linesw[tp->t_line].l_write)(tp, uio, flag)); | |||
| 462 | } | |||
| 463 | ||||
| 464 | /* | |||
| 465 | * return tty pointer | |||
| 466 | */ | |||
| 467 | struct tty * | |||
| 468 | cytty(dev_t dev) | |||
| 469 | { | |||
| 470 | int card = CY_CARD(dev)((((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) >> 5) & 3); | |||
| 471 | int port = CY_PORT(dev)(((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) & 0xf); | |||
| 472 | struct cy_softc *sc = cy_cd.cd_devs[card]; | |||
| 473 | struct cy_port *cy = &sc->sc_ports[port]; | |||
| 474 | struct tty *tp = cy->cy_tty; | |||
| 475 | ||||
| 476 | return (tp); | |||
| 477 | } | |||
| 478 | ||||
| 479 | /* | |||
| 480 | * ioctl routine | |||
| 481 | */ | |||
| 482 | int | |||
| 483 | cyioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p) | |||
| 484 | { | |||
| 485 | int card = CY_CARD(dev)((((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) >> 5) & 3); | |||
| 486 | int port = CY_PORT(dev)(((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) & 0xf); | |||
| 487 | struct cy_softc *sc = cy_cd.cd_devs[card]; | |||
| 488 | struct cy_port *cy = &sc->sc_ports[port]; | |||
| 489 | struct tty *tp = cy->cy_tty; | |||
| 490 | int error; | |||
| 491 | ||||
| 492 | #ifdef CY_DEBUG | |||
| 493 | printf("%s port %d ioctl cmd 0x%lx data %p flag 0x%x\n", | |||
| 494 | sc->sc_dev.dv_xname, port, cmd, data, flag); | |||
| 495 | #endif | |||
| 496 | ||||
| 497 | error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, p); | |||
| 498 | if (error >= 0) | |||
| 499 | return (error); | |||
| 500 | ||||
| 501 | error = ttioctl(tp, cmd, data, flag, p); | |||
| 502 | if (error >= 0) | |||
| 503 | return (error); | |||
| 504 | ||||
| 505 | /* XXX should not allow dropping DTR when dialin? */ | |||
| 506 | ||||
| 507 | switch (cmd) { | |||
| 508 | case TIOCSBRK((unsigned long)0x20000000 | ((0 & 0x1fff) << 16) | ((('t')) << 8) | ((123))): /* start break */ | |||
| 509 | SET(cy->cy_flags, CYF_START_BREAK)((cy->cy_flags) |= (0x02)); | |||
| 510 | cy_enable_transmitter(cy); | |||
| 511 | break; | |||
| 512 | ||||
| 513 | case TIOCCBRK((unsigned long)0x20000000 | ((0 & 0x1fff) << 16) | ((('t')) << 8) | ((122))): /* stop break */ | |||
| 514 | SET(cy->cy_flags, CYF_END_BREAK)((cy->cy_flags) |= (0x04)); | |||
| 515 | cy_enable_transmitter(cy); | |||
| 516 | break; | |||
| 517 | ||||
| 518 | case TIOCSDTR((unsigned long)0x20000000 | ((0 & 0x1fff) << 16) | ((('t')) << 8) | ((121))): /* DTR on */ | |||
| 519 | cy_modem_control(cy, TIOCM_DTR0002, DMBIS1); | |||
| 520 | break; | |||
| 521 | ||||
| 522 | case TIOCCDTR((unsigned long)0x20000000 | ((0 & 0x1fff) << 16) | ((('t')) << 8) | ((120))): /* DTR off */ | |||
| 523 | cy_modem_control(cy, TIOCM_DTR0002, DMBIC2); | |||
| 524 | break; | |||
| 525 | ||||
| 526 | case TIOCMSET((unsigned long)0x80000000 | ((sizeof(int) & 0x1fff) << 16) | ((('t')) << 8) | ((109))): /* set new modem control line values */ | |||
| 527 | cy_modem_control(cy, *((int *)data), DMSET0); | |||
| 528 | break; | |||
| 529 | ||||
| 530 | case TIOCMBIS((unsigned long)0x80000000 | ((sizeof(int) & 0x1fff) << 16) | ((('t')) << 8) | ((108))): /* turn modem control bits on */ | |||
| 531 | cy_modem_control(cy, *((int *)data), DMBIS1); | |||
| 532 | break; | |||
| 533 | ||||
| 534 | case TIOCMBIC((unsigned long)0x80000000 | ((sizeof(int) & 0x1fff) << 16) | ((('t')) << 8) | ((107))): /* turn modem control bits off */ | |||
| 535 | cy_modem_control(cy, *((int *)data), DMBIC2); | |||
| 536 | break; | |||
| 537 | ||||
| 538 | case TIOCMGET((unsigned long)0x40000000 | ((sizeof(int) & 0x1fff) << 16) | ((('t')) << 8) | ((106))): /* get modem control/status line state */ | |||
| 539 | *((int *)data) = cy_modem_control(cy, 0, DMGET3); | |||
| 540 | break; | |||
| 541 | ||||
| 542 | case TIOCGFLAGS((unsigned long)0x40000000 | ((sizeof(int) & 0x1fff) << 16) | ((('t')) << 8) | ((93))): | |||
| 543 | *((int *)data) = cy->cy_openflags | | |||
| 544 | (CY_DIALOUT(dev)((((unsigned)((dev) & 0xff) | (((dev) & 0xffff0000) >> 8)) & 0x80) != 0) ? TIOCFLAG_SOFTCAR0x01 : 0); | |||
| 545 | break; | |||
| 546 | ||||
| 547 | case TIOCSFLAGS((unsigned long)0x80000000 | ((sizeof(int) & 0x1fff) << 16) | ((('t')) << 8) | ((92))): | |||
| 548 | error = suser(p); | |||
| 549 | if (error != 0) | |||
| 550 | return (EPERM1); | |||
| 551 | ||||
| 552 | cy->cy_openflags = *((int *)data) & | |||
| 553 | (TIOCFLAG_SOFTCAR0x01 | TIOCFLAG_CLOCAL0x02 | | |||
| 554 | TIOCFLAG_CRTSCTS0x04 | TIOCFLAG_MDMBUF0x08); | |||
| 555 | break; | |||
| 556 | ||||
| 557 | default: | |||
| 558 | return (ENOTTY25); | |||
| 559 | } | |||
| 560 | ||||
| 561 | return (0); | |||
| 562 | } | |||
| 563 | ||||
| 564 | /* | |||
| 565 | * start output | |||
| 566 | */ | |||
| 567 | void | |||
| 568 | cystart(struct tty *tp) | |||
| 569 | { | |||
| 570 | int card = CY_CARD(tp->t_dev)((((unsigned)((tp->t_dev) & 0xff) | (((tp->t_dev) & 0xffff0000) >> 8)) >> 5) & 3); | |||
| 571 | int port = CY_PORT(tp->t_dev)(((unsigned)((tp->t_dev) & 0xff) | (((tp->t_dev) & 0xffff0000) >> 8)) & 0xf); | |||
| 572 | struct cy_softc *sc = cy_cd.cd_devs[card]; | |||
| 573 | struct cy_port *cy = &sc->sc_ports[port]; | |||
| 574 | int s; | |||
| 575 | ||||
| 576 | #ifdef CY_DEBUG | |||
| 577 | printf("%s port %d start, tty %p\n", sc->sc_dev.dv_xname, port, tp); | |||
| 578 | #endif | |||
| 579 | ||||
| 580 | s = spltty()splraise(0x9); | |||
| 581 | ||||
| 582 | #ifdef CY_DEBUG1 | |||
| 583 | cy->cy_start_count++; | |||
| 584 | #endif | |||
| 585 | ||||
| 586 | if (!ISSET(tp->t_state, TS_TTSTOP | TS_TIMEOUT | TS_BUSY)((tp->t_state) & (0x00100 | 0x00080 | 0x00004))) { | |||
| 587 | ttwakeupwr(tp); | |||
| 588 | if (tp->t_outq.c_cc == 0) | |||
| 589 | goto out; | |||
| 590 | ||||
| 591 | SET(tp->t_state, TS_BUSY)((tp->t_state) |= (0x00004)); | |||
| 592 | cy_enable_transmitter(cy); | |||
| 593 | } | |||
| 594 | out: | |||
| 595 | ||||
| 596 | splx(s)spllower(s); | |||
| 597 | } | |||
| 598 | ||||
| 599 | /* | |||
| 600 | * stop output | |||
| 601 | */ | |||
| 602 | int | |||
| 603 | cystop(struct tty *tp, int flag) | |||
| 604 | { | |||
| 605 | int card = CY_CARD(tp->t_dev)((((unsigned)((tp->t_dev) & 0xff) | (((tp->t_dev) & 0xffff0000) >> 8)) >> 5) & 3); | |||
| 606 | int port = CY_PORT(tp->t_dev)(((unsigned)((tp->t_dev) & 0xff) | (((tp->t_dev) & 0xffff0000) >> 8)) & 0xf); | |||
| 607 | struct cy_softc *sc = cy_cd.cd_devs[card]; | |||
| 608 | struct cy_port *cy = &sc->sc_ports[port]; | |||
| 609 | int s; | |||
| 610 | ||||
| 611 | #ifdef CY_DEBUG | |||
| 612 | printf("%s port %d stop tty %p flag 0x%x\n", sc->sc_dev.dv_xname, | |||
| 613 | port, tp, flag); | |||
| 614 | #endif | |||
| 615 | ||||
| 616 | s = spltty()splraise(0x9); | |||
| 617 | ||||
| 618 | if (ISSET(tp->t_state, TS_BUSY)((tp->t_state) & (0x00004))) { | |||
| 619 | if (!ISSET(tp->t_state, TS_TTSTOP)((tp->t_state) & (0x00100))) | |||
| 620 | SET(tp->t_state, TS_FLUSH)((tp->t_state) |= (0x00010)); | |||
| 621 | ||||
| 622 | /* | |||
| 623 | * the transmit interrupt routine will disable transmit when it | |||
| 624 | * notices that CYF_STOP has been set. | |||
| 625 | */ | |||
| 626 | SET(cy->cy_flags, CYF_STOP)((cy->cy_flags) |= (0x08)); | |||
| 627 | } | |||
| 628 | splx(s)spllower(s); | |||
| 629 | return (0); | |||
| 630 | } | |||
| 631 | ||||
| 632 | /* | |||
| 633 | * parameter setting routine. | |||
| 634 | * returns 0 if successful, else returns error code | |||
| 635 | */ | |||
| 636 | int | |||
| 637 | cyparam(struct tty *tp, struct termios *t) | |||
| 638 | { | |||
| 639 | int card = CY_CARD(tp->t_dev)((((unsigned)((tp->t_dev) & 0xff) | (((tp->t_dev) & 0xffff0000) >> 8)) >> 5) & 3); | |||
| 640 | int port = CY_PORT(tp->t_dev)(((unsigned)((tp->t_dev) & 0xff) | (((tp->t_dev) & 0xffff0000) >> 8)) & 0xf); | |||
| 641 | struct cy_softc *sc = cy_cd.cd_devs[card]; | |||
| 642 | struct cy_port *cy = &sc->sc_ports[port]; | |||
| 643 | int ibpr, obpr, i_clk_opt, o_clk_opt; | |||
| 644 | int s, opt; | |||
| 645 | ||||
| 646 | #ifdef CY_DEBUG | |||
| 647 | printf("%s port %d param tty %p termios %p\n", sc->sc_dev.dv_xname, | |||
| 648 | port, tp, t); | |||
| 649 | printf("ispeed %d ospeed %d\n", t->c_ispeed, t->c_ospeed); | |||
| 650 | #endif | |||
| 651 | ||||
| 652 | if (t->c_ospeed != 0 && | |||
| 653 | cy_speed(t->c_ospeed, &o_clk_opt, &obpr, cy->cy_clock) < 0) | |||
| 654 | return (EINVAL22); | |||
| 655 | ||||
| 656 | if (t->c_ispeed != 0 && | |||
| 657 | cy_speed(t->c_ispeed, &i_clk_opt, &ibpr, cy->cy_clock) < 0) | |||
| 658 | return (EINVAL22); | |||
| 659 | ||||
| 660 | s = spltty()splraise(0x9); | |||
| 661 | ||||
| 662 | /* hang up the line is ospeed is zero, else turn DTR on */ | |||
| 663 | cy_modem_control(cy, TIOCM_DTR0002, (t->c_ospeed == 0 ? DMBIC2 : DMBIS1)); | |||
| 664 | ||||
| 665 | /* channel was selected by the above call to cy_modem_control() */ | |||
| 666 | /* cd_write_reg(cy, CD1400_CAR, port & CD1400_CAR_CHAN); */ | |||
| 667 | ||||
| 668 | /* set transmit speed */ | |||
| 669 | if (t->c_ospeed != 0) { | |||
| 670 | cd_write_reg(cy, CD1400_TCOR, o_clk_opt)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x76<<1))<<cy->cy_bustype)), ((o_clk_opt)) )); | |||
| 671 | cd_write_reg(cy, CD1400_TBPR, obpr)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x72<<1))<<cy->cy_bustype)), ((obpr)))); | |||
| 672 | } | |||
| 673 | /* set receive speed */ | |||
| 674 | if (t->c_ispeed != 0) { | |||
| 675 | cd_write_reg(cy, CD1400_RCOR, i_clk_opt)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x7C<<1))<<cy->cy_bustype)), ((i_clk_opt)) )); | |||
| 676 | cd_write_reg(cy, CD1400_RBPR, ibpr)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x78<<1))<<cy->cy_bustype)), ((ibpr)))); | |||
| 677 | } | |||
| 678 | ||||
| 679 | opt = CD1400_CCR_CMDCHANCTL(1<<4) | CD1400_CCR_XMTEN(1<<3) | |||
| 680 | | (ISSET(t->c_cflag, CREAD)((t->c_cflag) & (0x00000800)) ? CD1400_CCR_RCVEN(1<<1) : CD1400_CCR_RCVDIS(1<<0)); | |||
| 681 | ||||
| 682 | if (opt != cy->cy_channel_control) { | |||
| 683 | cy->cy_channel_control = opt; | |||
| 684 | cd1400_channel_cmd(cy, opt); | |||
| 685 | } | |||
| 686 | ||||
| 687 | /* compute COR1 contents */ | |||
| 688 | opt = 0; | |||
| 689 | if (ISSET(t->c_cflag, PARENB)((t->c_cflag) & (0x00001000))) { | |||
| 690 | if (ISSET(t->c_cflag, PARODD)((t->c_cflag) & (0x00002000))) | |||
| 691 | opt |= CD1400_COR1_PARODD(1<<7); | |||
| 692 | opt |= CD1400_COR1_PARNORMAL(2<<5); | |||
| 693 | } | |||
| 694 | ||||
| 695 | if (!ISSET(t->c_iflag, INPCK)((t->c_iflag) & (0x00000010))) | |||
| 696 | opt |= CD1400_COR1_NOINPCK(1<<4); /* no parity checking */ | |||
| 697 | ||||
| 698 | if (ISSET(t->c_cflag, CSTOPB)((t->c_cflag) & (0x00000400))) | |||
| 699 | opt |= CD1400_COR1_STOP2(2<<2); | |||
| 700 | ||||
| 701 | switch (t->c_cflag & CSIZE0x00000300) { | |||
| 702 | case CS50x00000000: | |||
| 703 | opt |= CD1400_COR1_CS5(0<<0); | |||
| 704 | break; | |||
| 705 | ||||
| 706 | case CS60x00000100: | |||
| 707 | opt |= CD1400_COR1_CS6(1<<0); | |||
| 708 | break; | |||
| 709 | ||||
| 710 | case CS70x00000200: | |||
| 711 | opt |= CD1400_COR1_CS7(2<<0); | |||
| 712 | break; | |||
| 713 | ||||
| 714 | default: | |||
| 715 | opt |= CD1400_COR1_CS8(3<<0); | |||
| 716 | break; | |||
| 717 | } | |||
| 718 | ||||
| 719 | cd_write_reg(cy, CD1400_COR1, opt)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x08<<1))<<cy->cy_bustype)), ((opt)))); | |||
| 720 | ||||
| 721 | #ifdef CY_DEBUG | |||
| 722 | printf("cor1 = 0x%x...", opt); | |||
| 723 | #endif | |||
| 724 | ||||
| 725 | /* | |||
| 726 | * use the CD1400 automatic CTS flow control if CRTSCTS is set | |||
| 727 | * | |||
| 728 | * CD1400_COR2_ETC is used because breaks are generated with | |||
| 729 | * embedded transmit commands | |||
| 730 | */ | |||
| 731 | cd_write_reg(cy, CD1400_COR2,((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x09<<1))<<cy->cy_bustype)), (((1<<5 ) | (((t->c_cflag) & (0x00010000)) ? (1<<1) : 0) )))) | |||
| 732 | CD1400_COR2_ETC |((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x09<<1))<<cy->cy_bustype)), (((1<<5 ) | (((t->c_cflag) & (0x00010000)) ? (1<<1) : 0) )))) | |||
| 733 | (ISSET(t->c_cflag, CRTSCTS) ? CD1400_COR2_CCTS_OFLOW : 0))((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x09<<1))<<cy->cy_bustype)), (((1<<5 ) | (((t->c_cflag) & (0x00010000)) ? (1<<1) : 0) )))); | |||
| 734 | ||||
| 735 | cd_write_reg(cy, CD1400_COR3, RX_FIFO_THRESHOLD)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x0A<<1))<<cy->cy_bustype)), ((6)))); | |||
| 736 | ||||
| 737 | cd1400_channel_cmd(cy, | |||
| 738 | CD1400_CCR_CMDCORCHG(1<<6) | | |||
| 739 | CD1400_CCR_COR1(1<<1) | CD1400_CCR_COR2(1<<2) | CD1400_CCR_COR3(1<<3)); | |||
| 740 | ||||
| 741 | cd_write_reg(cy, CD1400_COR4, CD1400_COR4_PFO_EXCEPTION)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x1E<<1))<<cy->cy_bustype)), (((0<<0 ))))); | |||
| 742 | cd_write_reg(cy, CD1400_COR5, 0)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x1F<<1))<<cy->cy_bustype)), ((0)))); | |||
| 743 | ||||
| 744 | /* | |||
| 745 | * set modem change option registers to generate interrupts | |||
| 746 | * on carrier detect changes. | |||
| 747 | * | |||
| 748 | * if hardware RTS handshaking is used (CY_HW_RTS, DTR and RTS lines | |||
| 749 | * exchanged), also set the handshaking threshold. | |||
| 750 | */ | |||
| 751 | #ifdef CY_HW_RTS | |||
| 752 | cd_write_reg(cy, CD1400_MCOR1, CD1400_MCOR1_CDzd |((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x15<<1))<<cy->cy_bustype)), (((1<<4 ) | (((t->c_cflag) & (0x00010000)) ? 9 : 0))))) | |||
| 753 | (ISSET(t->c_cflag, CRTSCTS) ? RX_DTR_THRESHOLD : 0))((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x15<<1))<<cy->cy_bustype)), (((1<<4 ) | (((t->c_cflag) & (0x00010000)) ? 9 : 0))))); | |||
| 754 | #else | |||
| 755 | cd_write_reg(cy, CD1400_MCOR1, CD1400_MCOR1_CDzd)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x15<<1))<<cy->cy_bustype)), (((1<<4 ))))); | |||
| 756 | #endif /* CY_HW_RTS */ | |||
| 757 | ||||
| 758 | cd_write_reg(cy, CD1400_MCOR2, CD1400_MCOR2_CDod)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x16<<1))<<cy->cy_bustype)), (((1<<4 ))))); | |||
| 759 | ||||
| 760 | /* | |||
| 761 | * set receive timeout to approx. 2ms | |||
| 762 | * could use more complex logic here... | |||
| 763 | * (but is it actually needed or even useful?) | |||
| 764 | */ | |||
| 765 | cd_write_reg(cy, CD1400_RTPR, 2)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x21<<1))<<cy->cy_bustype)), ((2)))); | |||
| 766 | ||||
| 767 | /* | |||
| 768 | * should do anything else here? | |||
| 769 | * XXX check MDMBUF handshaking like in com.c? | |||
| 770 | */ | |||
| 771 | ||||
| 772 | splx(s)spllower(s); | |||
| 773 | return (0); | |||
| 774 | } | |||
| 775 | ||||
| 776 | /* | |||
| 777 | * set/get modem line status | |||
| 778 | * | |||
| 779 | * bits can be: TIOCM_DTR, TIOCM_RTS, TIOCM_CTS, TIOCM_CD, TIOCM_RI, TIOCM_DSR | |||
| 780 | * | |||
| 781 | * RTS and DTR are exchanged if CY_HW_RTS is set | |||
| 782 | * | |||
| 783 | */ | |||
| 784 | int | |||
| 785 | cy_modem_control(struct cy_port *cy, int bits, int howto) | |||
| 786 | { | |||
| 787 | int s, msvr; | |||
| 788 | ||||
| 789 | s = spltty()splraise(0x9); | |||
| 790 | ||||
| 791 | /* select channel */ | |||
| 792 | cd_write_reg(cy, CD1400_CAR, cy->cy_port_num & CD1400_CAR_CHAN)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x68<<1))<<cy->cy_bustype)), ((cy->cy_port_num & (3<<0))))); | |||
| 793 | ||||
| 794 | /* does not manipulate RTS if it is used for flow control */ | |||
| 795 | switch (howto) { | |||
| 796 | case DMGET3: | |||
| 797 | bits = 0; | |||
| 798 | if (cy->cy_channel_control & CD1400_CCR_RCVEN(1<<1)) | |||
| 799 | bits |= TIOCM_LE0001; | |||
| 800 | msvr = cd_read_reg(cy, CD1400_MSVR2)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6D<<1))<<cy->cy_bustype)))); | |||
| 801 | #ifdef CY_HW_RTS | |||
| 802 | if (cd_read_reg(cy, CD1400_MSVR1)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)))) & CD1400_MSVR1_RTS(1<<0)) | |||
| 803 | bits |= TIOCM_DTR0002; | |||
| 804 | if (msvr & CD1400_MSVR2_DTR(1<<1)) | |||
| 805 | bits |= TIOCM_RTS0004; | |||
| 806 | #else | |||
| 807 | if (cd_read_reg(cy, CD1400_MSVR1)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)))) & CD1400_MSVR1_RTS(1<<0)) | |||
| 808 | bits |= TIOCM_RTS0004; | |||
| 809 | if (msvr & CD1400_MSVR2_DTR(1<<1)) | |||
| 810 | bits |= TIOCM_DTR0002; | |||
| 811 | #endif /* CY_HW_RTS */ | |||
| 812 | if (msvr & CD1400_MSVR2_CTS(1<<6)) | |||
| 813 | bits |= TIOCM_CTS0040; | |||
| 814 | if (msvr & CD1400_MSVR2_CD(1<<4)) | |||
| 815 | bits |= TIOCM_CD0100; | |||
| 816 | if (msvr & CD1400_MSVR2_DSR(1<<7)) /* not connected on some | |||
| 817 | Cyclom cards? */ | |||
| 818 | bits |= TIOCM_DSR0400; | |||
| 819 | if (msvr & CD1400_MSVR2_RI(1<<5)) /* not connected on | |||
| 820 | Cyclom-8Y cards? */ | |||
| 821 | bits |= TIOCM_RI0200; | |||
| 822 | splx(s)spllower(s); | |||
| 823 | return (bits); | |||
| 824 | ||||
| 825 | case DMSET0: /* replace old values with new ones */ | |||
| 826 | #ifdef CY_HW_RTS | |||
| 827 | if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS)((cy->cy_tty->t_termios.c_cflag) & (0x00010000))) | |||
| 828 | cd_write_reg(cy, CD1400_MSVR2,((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6D<<1))<<cy->cy_bustype)), ((((bits & 0004) ? (1<<1) : 0))))) | |||
| 829 | ((bits & TIOCM_RTS) ? CD1400_MSVR2_DTR : 0))((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6D<<1))<<cy->cy_bustype)), ((((bits & 0004) ? (1<<1) : 0))))); | |||
| 830 | cd_write_reg(cy, CD1400_MSVR1,((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)), ((((bits & 0002) ? (1<<0) : 0))))) | |||
| 831 | ((bits & TIOCM_DTR) ? CD1400_MSVR1_RTS : 0))((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)), ((((bits & 0002) ? (1<<0) : 0))))); | |||
| 832 | #else | |||
| 833 | if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS)((cy->cy_tty->t_termios.c_cflag) & (0x00010000))) | |||
| 834 | cd_write_reg(cy, CD1400_MSVR1,((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)), ((((bits & 0004) ? (1<<0) : 0))))) | |||
| 835 | ((bits & TIOCM_RTS) ? CD1400_MSVR1_RTS : 0))((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)), ((((bits & 0004) ? (1<<0) : 0))))); | |||
| 836 | cd_write_reg(cy, CD1400_MSVR2,((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6D<<1))<<cy->cy_bustype)), ((((bits & 0002) ? (1<<1) : 0))))) | |||
| 837 | ((bits & TIOCM_DTR) ? CD1400_MSVR2_DTR : 0))((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6D<<1))<<cy->cy_bustype)), ((((bits & 0002) ? (1<<1) : 0))))); | |||
| 838 | #endif /* CY_HW_RTS */ | |||
| 839 | break; | |||
| 840 | ||||
| 841 | case DMBIS1: /* set bits */ | |||
| 842 | #ifdef CY_HW_RTS | |||
| 843 | if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS)((cy->cy_tty->t_termios.c_cflag) & (0x00010000)) && | |||
| 844 | (bits & TIOCM_RTS0004) != 0) | |||
| 845 | cd_write_reg(cy, CD1400_MSVR2, CD1400_MSVR2_DTR)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6D<<1))<<cy->cy_bustype)), (((1<<1 ))))); | |||
| 846 | if (bits & TIOCM_DTR0002) | |||
| 847 | cd_write_reg(cy, CD1400_MSVR1, CD1400_MSVR1_RTS)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)), (((1<<0 ))))); | |||
| 848 | #else | |||
| 849 | if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS)((cy->cy_tty->t_termios.c_cflag) & (0x00010000)) && | |||
| 850 | (bits & TIOCM_RTS0004) != 0) | |||
| 851 | cd_write_reg(cy, CD1400_MSVR1, CD1400_MSVR1_RTS)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)), (((1<<0 ))))); | |||
| 852 | if (bits & TIOCM_DTR0002) | |||
| 853 | cd_write_reg(cy, CD1400_MSVR2, CD1400_MSVR2_DTR)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6D<<1))<<cy->cy_bustype)), (((1<<1 ))))); | |||
| 854 | #endif /* CY_HW_RTS */ | |||
| 855 | break; | |||
| 856 | ||||
| 857 | case DMBIC2: /* clear bits */ | |||
| 858 | #ifdef CY_HW_RTS | |||
| 859 | if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS)((cy->cy_tty->t_termios.c_cflag) & (0x00010000)) && | |||
| 860 | (bits & TIOCM_RTS0004)) | |||
| 861 | cd_write_reg(cy, CD1400_MSVR2, 0)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6D<<1))<<cy->cy_bustype)), ((0)))); | |||
| 862 | if (bits & TIOCM_DTR0002) | |||
| 863 | cd_write_reg(cy, CD1400_MSVR1, 0)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)), ((0)))); | |||
| 864 | #else | |||
| 865 | if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS)((cy->cy_tty->t_termios.c_cflag) & (0x00010000)) && | |||
| 866 | (bits & TIOCM_RTS0004)) | |||
| 867 | cd_write_reg(cy, CD1400_MSVR1, 0)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)), ((0)))); | |||
| 868 | if (bits & TIOCM_DTR0002) | |||
| 869 | cd_write_reg(cy, CD1400_MSVR2, 0)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6D<<1))<<cy->cy_bustype)), ((0)))); | |||
| 870 | #endif /* CY_HW_RTS */ | |||
| 871 | break; | |||
| 872 | } | |||
| 873 | splx(s)spllower(s); | |||
| 874 | return (0); | |||
| 875 | } | |||
| 876 | ||||
| 877 | /* | |||
| 878 | * Upper-level handler loop (called from timer interrupt?) | |||
| 879 | * This routine is common for multiple cards | |||
| 880 | */ | |||
| 881 | void | |||
| 882 | cy_poll(void *arg) | |||
| 883 | { | |||
| 884 | int port; | |||
| 885 | struct cy_softc *sc = arg; | |||
| 886 | struct cy_port *cy; | |||
| 887 | struct tty *tp; | |||
| 888 | static int counter = 0; | |||
| 889 | #ifdef CY_DEBUG1 | |||
| 890 | int did_something; | |||
| 891 | #endif | |||
| 892 | ||||
| 893 | int s; | |||
| 894 | ||||
| 895 | s = spltty()splraise(0x9); | |||
| 896 | ||||
| 897 | if (sc->sc_events == 0 && ++counter < 200) { | |||
| 898 | splx(s)spllower(s); | |||
| 899 | goto out; | |||
| 900 | } | |||
| 901 | ||||
| 902 | sc->sc_events = 0; | |||
| 903 | splx(s)spllower(s); | |||
| 904 | ||||
| 905 | #ifdef CY_DEBUG1 | |||
| 906 | sc->sc_poll_count1++; | |||
| 907 | did_something = 0; | |||
| 908 | #endif | |||
| 909 | ||||
| 910 | for (port = 0; port < sc->sc_nports; port++) { | |||
| 911 | cy = &sc->sc_ports[port]; | |||
| 912 | if ((tp = cy->cy_tty) == NULL((void *)0) || cy->cy_ibuf == NULL((void *)0) || | |||
| 913 | !ISSET(tp->t_state, TS_ISOPEN | TS_WOPEN)((tp->t_state) & (0x00020 | 0x00200))) | |||
| 914 | continue; | |||
| 915 | ||||
| 916 | /* | |||
| 917 | * handle received data | |||
| 918 | */ | |||
| 919 | while (cy->cy_ibuf_rd_ptr != cy->cy_ibuf_wr_ptr) { | |||
| 920 | u_char line_stat; | |||
| 921 | int chr; | |||
| 922 | ||||
| 923 | line_stat = cy->cy_ibuf_rd_ptr[0]; | |||
| 924 | chr = cy->cy_ibuf_rd_ptr[1]; | |||
| 925 | ||||
| 926 | if (line_stat & | |||
| 927 | (CD1400_RDSR_BREAK(1<<3)|CD1400_RDSR_FE(1<<1))) | |||
| 928 | chr |= TTY_FE0x01000000; | |||
| 929 | if (line_stat & CD1400_RDSR_PE(1<<2)) | |||
| 930 | chr |= TTY_PE0x02000000; | |||
| 931 | ||||
| 932 | /* | |||
| 933 | * on an overrun error the data is treated as | |||
| 934 | * good just as it should be. | |||
| 935 | */ | |||
| 936 | ||||
| 937 | #ifdef CY_DEBUG | |||
| 938 | printf("%s port %d ttyinput 0x%x\n", | |||
| 939 | sc->sc_dev.dv_xname, port, chr); | |||
| 940 | #endif | |||
| 941 | ||||
| 942 | (*linesw[tp->t_line].l_rint)(chr, tp); | |||
| 943 | ||||
| 944 | s = spltty()splraise(0x9); /* really necessary? */ | |||
| 945 | if ((cy->cy_ibuf_rd_ptr += 2) == | |||
| 946 | cy->cy_ibuf_end) | |||
| 947 | cy->cy_ibuf_rd_ptr = cy->cy_ibuf; | |||
| 948 | splx(s)spllower(s); | |||
| 949 | ||||
| 950 | #ifdef CY_DEBUG1 | |||
| 951 | did_something = 1; | |||
| 952 | #endif | |||
| 953 | } | |||
| 954 | ||||
| 955 | #ifndef CY_HW_RTS | |||
| 956 | /* | |||
| 957 | * If we don't have any received data in ibuf and | |||
| 958 | * CRTSCTS is on and RTS is turned off, it is time | |||
| 959 | * to turn RTS back on | |||
| 960 | */ | |||
| 961 | if (ISSET(tp->t_cflag, CRTSCTS)((tp->t_termios.c_cflag) & (0x00010000))) { | |||
| 962 | /* we can't use cy_modem_control() here as it | |||
| 963 | doesn't change RTS if RTSCTS is on */ | |||
| 964 | cd_write_reg(cy, CD1400_CAR,((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x68<<1))<<cy->cy_bustype)), ((port & ( 3<<0))))) | |||
| 965 | port & CD1400_CAR_CHAN)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x68<<1))<<cy->cy_bustype)), ((port & ( 3<<0))))); | |||
| 966 | ||||
| 967 | if ((cd_read_reg(cy,((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)))) | |||
| 968 | CD1400_MSVR1)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)))) & CD1400_MSVR1_RTS(1<<0)) == 0) { | |||
| 969 | cd_write_reg(cy, CD1400_MSVR1,((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)), (((1<<0 ))))) | |||
| 970 | CD1400_MSVR1_RTS)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)), (((1<<0 ))))); | |||
| 971 | #ifdef CY_DEBUG1 | |||
| 972 | did_something = 1; | |||
| 973 | #endif | |||
| 974 | } | |||
| 975 | } | |||
| 976 | #endif /* CY_HW_RTS */ | |||
| 977 | ||||
| 978 | /* | |||
| 979 | * handle carrier changes | |||
| 980 | */ | |||
| 981 | s = spltty()splraise(0x9); | |||
| 982 | if (ISSET(cy->cy_flags, CYF_CARRIER_CHANGED)((cy->cy_flags) & (0x01))) { | |||
| 983 | int carrier; | |||
| 984 | ||||
| 985 | CLR(cy->cy_flags, CYF_CARRIER_CHANGED)((cy->cy_flags) &= ~(0x01)); | |||
| 986 | splx(s)spllower(s); | |||
| 987 | ||||
| 988 | carrier = ((cy->cy_carrier_stat & | |||
| 989 | CD1400_MSVR2_CD(1<<4)) != 0); | |||
| 990 | ||||
| 991 | #ifdef CY_DEBUG | |||
| 992 | printf("%s: cy_poll: carrier change " | |||
| 993 | "(port %d, carrier %d)\n", | |||
| 994 | sc->sc_dev.dv_xname, port, carrier); | |||
| 995 | #endif | |||
| 996 | if (CY_DIALIN(tp->t_dev)(!((((unsigned)((tp->t_dev) & 0xff) | (((tp->t_dev) & 0xffff0000) >> 8)) & 0x80) != 0)) && | |||
| 997 | !(*linesw[tp->t_line].l_modem)(tp, carrier)) | |||
| 998 | cy_modem_control(cy, TIOCM_DTR0002, DMBIC2); | |||
| 999 | ||||
| 1000 | #ifdef CY_DEBUG1 | |||
| 1001 | did_something = 1; | |||
| 1002 | #endif | |||
| 1003 | } else { | |||
| 1004 | splx(s)spllower(s); | |||
| 1005 | } | |||
| 1006 | ||||
| 1007 | s = spltty()splraise(0x9); | |||
| 1008 | if (ISSET(cy->cy_flags, CYF_START)((cy->cy_flags) & (0x20))) { | |||
| 1009 | CLR(cy->cy_flags, CYF_START)((cy->cy_flags) &= ~(0x20)); | |||
| 1010 | splx(s)spllower(s); | |||
| 1011 | ||||
| 1012 | (*linesw[tp->t_line].l_start)(tp); | |||
| 1013 | ||||
| 1014 | #ifdef CY_DEBUG1 | |||
| 1015 | did_something = 1; | |||
| 1016 | #endif | |||
| 1017 | } else { | |||
| 1018 | splx(s)spllower(s); | |||
| 1019 | } | |||
| 1020 | ||||
| 1021 | /* could move this to even upper level... */ | |||
| 1022 | if (cy->cy_fifo_overruns) { | |||
| 1023 | cy->cy_fifo_overruns = 0; | |||
| 1024 | /* doesn't report overrun count, | |||
| 1025 | but shouldn't really matter */ | |||
| 1026 | log(LOG_WARNING4, "%s: port %d fifo overrun\n", | |||
| 1027 | sc->sc_dev.dv_xname, port); | |||
| 1028 | } | |||
| 1029 | if (cy->cy_ibuf_overruns) { | |||
| 1030 | cy->cy_ibuf_overruns = 0; | |||
| 1031 | log(LOG_WARNING4, "%s: port %d ibuf overrun\n", | |||
| 1032 | sc->sc_dev.dv_xname, port); | |||
| 1033 | } | |||
| 1034 | } /* for(port...) */ | |||
| 1035 | #ifdef CY_DEBUG1 | |||
| 1036 | if (did_something && counter >= 200) | |||
| 1037 | sc->sc_poll_count2++; | |||
| 1038 | #endif | |||
| 1039 | ||||
| 1040 | counter = 0; | |||
| 1041 | ||||
| 1042 | out: | |||
| 1043 | timeout_add(&sc->sc_poll_to, 1); | |||
| 1044 | } | |||
| 1045 | ||||
| 1046 | /* | |||
| 1047 | * hardware interrupt routine | |||
| 1048 | */ | |||
| 1049 | int | |||
| 1050 | cy_intr(void *arg) | |||
| 1051 | { | |||
| 1052 | struct cy_softc *sc = arg; | |||
| 1053 | struct cy_port *cy; | |||
| 1054 | int cy_chip, stat; | |||
| 1055 | int int_serviced = -1; | |||
| 1056 | ||||
| 1057 | /* | |||
| 1058 | * Check interrupt status of each CD1400 chip on this card | |||
| 1059 | * (multiple cards cannot share the same interrupt) | |||
| 1060 | */ | |||
| 1061 | for (cy_chip = 0; cy_chip < sc->sc_nr_cd1400s; cy_chip++) { | |||
| ||||
| 1062 | ||||
| 1063 | stat = cd_read_reg_sc(sc, cy_chip, CD1400_SVRR)((sc->sc_memt)->read_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x67<<1))<<sc->sc_bustype)))); | |||
| 1064 | if (stat == 0) | |||
| 1065 | continue; | |||
| 1066 | ||||
| 1067 | if (ISSET(stat, CD1400_SVRR_RXRDY)((stat) & ((1<<0)))) { | |||
| 1068 | u_char save_car, save_rir, serv_type; | |||
| 1069 | u_char line_stat, recv_data, n_chars; | |||
| 1070 | u_char *buf_p; | |||
| 1071 | ||||
| 1072 | save_rir = cd_read_reg_sc(sc, cy_chip, CD1400_RIR)((sc->sc_memt)->read_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x6B<<1))<<sc->sc_bustype)))); | |||
| 1073 | save_car = cd_read_reg_sc(sc, cy_chip, CD1400_CAR)((sc->sc_memt)->read_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x68<<1))<<sc->sc_bustype)))); | |||
| 1074 | /* enter rx service */ | |||
| 1075 | cd_write_reg_sc(sc, cy_chip, CD1400_CAR, save_rir)((sc->sc_memt)->write_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x68<<1))<<sc->sc_bustype)), ((save_rir )))); | |||
| 1076 | ||||
| 1077 | serv_type = cd_read_reg_sc(sc, cy_chip, CD1400_RIVR)((sc->sc_memt)->read_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x43<<1))<<sc->sc_bustype)))); | |||
| 1078 | cy = &sc->sc_ports[serv_type >> 3]; | |||
| 1079 | ||||
| 1080 | #ifdef CY_DEBUG1 | |||
| 1081 | cy->cy_rx_int_count++; | |||
| 1082 | #endif | |||
| 1083 | ||||
| 1084 | buf_p = cy->cy_ibuf_wr_ptr; | |||
| 1085 | ||||
| 1086 | if (ISSET(serv_type, CD1400_RIVR_EXCEPTION)((serv_type) & ((1<<2)))) { | |||
| 1087 | line_stat = cd_read_reg(cy, CD1400_RDSR)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x62<<1))<<cy->cy_bustype)))); | |||
| 1088 | recv_data = cd_read_reg(cy, CD1400_RDSR)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x62<<1))<<cy->cy_bustype)))); | |||
| 1089 | ||||
| 1090 | if (cy->cy_tty == NULL((void *)0) || | |||
| 1091 | !ISSET(cy->cy_tty->t_state, TS_ISOPEN)((cy->cy_tty->t_state) & (0x00020))) | |||
| 1092 | goto end_rx_serv; | |||
| 1093 | ||||
| 1094 | #ifdef CY_DEBUG | |||
| 1095 | printf("%s port %d recv exception, " | |||
| 1096 | "line_stat 0x%x, char 0x%x\n", | |||
| 1097 | sc->sc_dev.dv_xname, cy->cy_port_num, | |||
| 1098 | line_stat, recv_data); | |||
| 1099 | #endif | |||
| 1100 | if (ISSET(line_stat, CD1400_RDSR_OE)((line_stat) & ((1<<0)))) | |||
| 1101 | cy->cy_fifo_overruns++; | |||
| 1102 | ||||
| 1103 | *buf_p++ = line_stat; | |||
| 1104 | *buf_p++ = recv_data; | |||
| 1105 | if (buf_p == cy->cy_ibuf_end) | |||
| 1106 | buf_p = cy->cy_ibuf; | |||
| 1107 | ||||
| 1108 | if (buf_p == cy->cy_ibuf_rd_ptr) { | |||
| 1109 | if (buf_p == cy->cy_ibuf) | |||
| 1110 | buf_p = cy->cy_ibuf_end; | |||
| 1111 | buf_p -= 2; | |||
| 1112 | cy->cy_ibuf_overruns++; | |||
| 1113 | } | |||
| 1114 | sc->sc_events = 1; | |||
| 1115 | } else { /* no exception, received data OK */ | |||
| 1116 | n_chars = cd_read_reg(cy, CD1400_RDCR)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x0E<<1))<<cy->cy_bustype)))); | |||
| 1117 | ||||
| 1118 | /* If no tty or not open, discard data */ | |||
| 1119 | if (cy->cy_tty == NULL((void *)0) || | |||
| 1120 | !ISSET(cy->cy_tty->t_state, TS_ISOPEN)((cy->cy_tty->t_state) & (0x00020))) { | |||
| 1121 | while (n_chars--) | |||
| 1122 | cd_read_reg(cy, CD1400_RDSR)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x62<<1))<<cy->cy_bustype)))); | |||
| 1123 | goto end_rx_serv; | |||
| 1124 | } | |||
| 1125 | ||||
| 1126 | #ifdef CY_DEBUG | |||
| 1127 | printf("%s port %d receive ok %d chars\n", | |||
| 1128 | sc->sc_dev.dv_xname, cy->cy_port_num, | |||
| 1129 | n_chars); | |||
| 1130 | #endif | |||
| 1131 | while (n_chars--) { | |||
| 1132 | *buf_p++ = 0; /* status: OK */ | |||
| 1133 | *buf_p++ = cd_read_reg(cy,((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x62<<1))<<cy->cy_bustype)))) | |||
| 1134 | CD1400_RDSR)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x62<<1))<<cy->cy_bustype)))); /* data byte */ | |||
| 1135 | if (buf_p == cy->cy_ibuf_end) | |||
| 1136 | buf_p = cy->cy_ibuf; | |||
| 1137 | if (buf_p == cy->cy_ibuf_rd_ptr) { | |||
| 1138 | if (buf_p == cy->cy_ibuf) | |||
| 1139 | buf_p = cy->cy_ibuf_end; | |||
| 1140 | buf_p -= 2; | |||
| 1141 | cy->cy_ibuf_overruns++; | |||
| 1142 | break; | |||
| 1143 | } | |||
| 1144 | } | |||
| 1145 | sc->sc_events = 1; | |||
| 1146 | } | |||
| 1147 | ||||
| 1148 | cy->cy_ibuf_wr_ptr = buf_p; | |||
| 1149 | ||||
| 1150 | #ifndef CY_HW_RTS | |||
| 1151 | /* RTS handshaking for incoming data */ | |||
| 1152 | if (ISSET(cy->cy_tty->t_cflag, CRTSCTS)((cy->cy_tty->t_termios.c_cflag) & (0x00010000))) { | |||
| 1153 | int bf; | |||
| 1154 | ||||
| 1155 | bf = buf_p - cy->cy_ibuf_rd_ptr; | |||
| 1156 | if (bf < 0) | |||
| 1157 | bf += IBUF_SIZE(2*512); | |||
| 1158 | ||||
| 1159 | if (bf > (IBUF_SIZE(2*512)/2)) /* turn RTS off */ | |||
| 1160 | cd_write_reg(cy, CD1400_MSVR1, 0)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6C<<1))<<cy->cy_bustype)), ((0)))); | |||
| 1161 | } | |||
| 1162 | #endif /* CY_HW_RTS */ | |||
| 1163 | ||||
| 1164 | end_rx_serv: | |||
| 1165 | /* terminate service context */ | |||
| 1166 | cd_write_reg(cy, CD1400_RIR, save_rir & 0x3f)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6B<<1))<<cy->cy_bustype)), ((save_rir & 0x3f)))); | |||
| 1167 | cd_write_reg(cy, CD1400_CAR, save_car)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x68<<1))<<cy->cy_bustype)), ((save_car))) ); | |||
| 1168 | int_serviced = 1; | |||
| 1169 | } /* if(rx_service...) */ | |||
| 1170 | ||||
| 1171 | if (ISSET(stat, CD1400_SVRR_MDMCH)((stat) & ((1<<2)))) { | |||
| 1172 | u_char save_car, save_mir, serv_type, modem_stat; | |||
| 1173 | ||||
| 1174 | save_mir = cd_read_reg_sc(sc, cy_chip, CD1400_MIR)((sc->sc_memt)->read_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x69<<1))<<sc->sc_bustype)))); | |||
| 1175 | save_car = cd_read_reg_sc(sc, cy_chip, CD1400_CAR)((sc->sc_memt)->read_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x68<<1))<<sc->sc_bustype)))); | |||
| 1176 | /* enter modem service */ | |||
| 1177 | cd_write_reg_sc(sc, cy_chip, CD1400_CAR, save_mir)((sc->sc_memt)->write_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x68<<1))<<sc->sc_bustype)), ((save_mir )))); | |||
| 1178 | ||||
| 1179 | serv_type = cd_read_reg_sc(sc, cy_chip, CD1400_MIVR)((sc->sc_memt)->read_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x41<<1))<<sc->sc_bustype)))); | |||
| 1180 | cy = &sc->sc_ports[serv_type >> 3]; | |||
| 1181 | ||||
| 1182 | #ifdef CY_DEBUG1 | |||
| 1183 | cy->cy_modem_int_count++; | |||
| 1184 | #endif | |||
| 1185 | ||||
| 1186 | modem_stat = cd_read_reg(cy, CD1400_MSVR2)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6D<<1))<<cy->cy_bustype)))); | |||
| 1187 | ||||
| 1188 | #ifdef CY_DEBUG | |||
| 1189 | printf("%s port %d modem line change, new stat 0x%x\n", | |||
| 1190 | sc->sc_dev.dv_xname, cy->cy_port_num, modem_stat); | |||
| 1191 | #endif | |||
| 1192 | if (ISSET((cy->cy_carrier_stat ^ modem_stat),(((cy->cy_carrier_stat ^ modem_stat)) & ((1<<4)) ) | |||
| 1193 | CD1400_MSVR2_CD)(((cy->cy_carrier_stat ^ modem_stat)) & ((1<<4)) )) { | |||
| 1194 | SET(cy->cy_flags, CYF_CARRIER_CHANGED)((cy->cy_flags) |= (0x01)); | |||
| 1195 | sc->sc_events = 1; | |||
| 1196 | } | |||
| 1197 | ||||
| 1198 | cy->cy_carrier_stat = modem_stat; | |||
| 1199 | ||||
| 1200 | /* terminate service context */ | |||
| 1201 | cd_write_reg(cy, CD1400_MIR, save_mir & 0x3f)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x69<<1))<<cy->cy_bustype)), ((save_mir & 0x3f)))); | |||
| 1202 | cd_write_reg(cy, CD1400_CAR, save_car)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x68<<1))<<cy->cy_bustype)), ((save_car))) ); | |||
| 1203 | int_serviced = 1; | |||
| 1204 | } /* if(modem_service...) */ | |||
| 1205 | ||||
| 1206 | if (ISSET(stat, CD1400_SVRR_TXRDY)((stat) & ((1<<1)))) { | |||
| 1207 | u_char save_car, save_tir, serv_type, count, ch; | |||
| 1208 | struct tty *tp; | |||
| 1209 | ||||
| 1210 | save_tir = cd_read_reg_sc(sc, cy_chip, CD1400_TIR)((sc->sc_memt)->read_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x6A<<1))<<sc->sc_bustype)))); | |||
| 1211 | save_car = cd_read_reg_sc(sc, cy_chip, CD1400_CAR)((sc->sc_memt)->read_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x68<<1))<<sc->sc_bustype)))); | |||
| 1212 | /* enter tx service */ | |||
| 1213 | cd_write_reg_sc(sc, cy_chip, CD1400_CAR, save_tir)((sc->sc_memt)->write_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x68<<1))<<sc->sc_bustype)), ((save_tir )))); | |||
| 1214 | ||||
| 1215 | serv_type = cd_read_reg_sc(sc, cy_chip, CD1400_TIVR)((sc->sc_memt)->read_1((sc->sc_memh), (sc->sc_cd1400_offs [cy_chip]+ (((0x42<<1))<<sc->sc_bustype)))); | |||
| 1216 | cy = &sc->sc_ports[serv_type >> 3]; | |||
| 1217 | ||||
| 1218 | #ifdef CY_DEBUG1 | |||
| 1219 | cy->cy_tx_int_count++; | |||
| 1220 | #endif | |||
| 1221 | #ifdef CY_DEBUG | |||
| 1222 | printf("%s port %d tx service\n", sc->sc_dev.dv_xname, | |||
| 1223 | cy->cy_port_num); | |||
| 1224 | #endif | |||
| 1225 | ||||
| 1226 | /* stop transmitting if no tty or CYF_STOP set */ | |||
| 1227 | tp = cy->cy_tty; | |||
| 1228 | if (tp == NULL((void *)0) || ISSET(cy->cy_flags, CYF_STOP)((cy->cy_flags) & (0x08))) | |||
| 1229 | goto txdone; | |||
| 1230 | ||||
| 1231 | count = 0; | |||
| 1232 | if (ISSET(cy->cy_flags, CYF_SEND_NUL)((cy->cy_flags) & (0x10))) { | |||
| 1233 | cd_write_reg(cy, CD1400_TDR, 0)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x63<<1))<<cy->cy_bustype)), ((0)))); | |||
| 1234 | cd_write_reg(cy, CD1400_TDR, 0)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x63<<1))<<cy->cy_bustype)), ((0)))); | |||
| 1235 | count += 2; | |||
| 1236 | CLR(cy->cy_flags, CYF_SEND_NUL)((cy->cy_flags) &= ~(0x10)); | |||
| 1237 | } | |||
| 1238 | ||||
| 1239 | if (tp->t_outq.c_cc > 0) { | |||
| 1240 | SET(tp->t_state, TS_BUSY)((tp->t_state) |= (0x00004)); | |||
| 1241 | while (tp->t_outq.c_cc > 0 && | |||
| 1242 | count < CD1400_TX_FIFO_SIZE12) { | |||
| 1243 | ch = getc(&tp->t_outq); | |||
| 1244 | /* remember to double NUL characters | |||
| 1245 | because embedded transmit commands | |||
| 1246 | are enabled */ | |||
| 1247 | if (ch == 0) { | |||
| 1248 | if (count >= | |||
| 1249 | CD1400_TX_FIFO_SIZE12-2) { | |||
| 1250 | SET(cy->cy_flags,((cy->cy_flags) |= (0x10)) | |||
| 1251 | CYF_SEND_NUL)((cy->cy_flags) |= (0x10)); | |||
| 1252 | break; | |||
| 1253 | } | |||
| 1254 | ||||
| 1255 | cd_write_reg(cy, CD1400_TDR, ch)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x63<<1))<<cy->cy_bustype)), ((ch)))); | |||
| 1256 | count++; | |||
| 1257 | } | |||
| 1258 | ||||
| 1259 | cd_write_reg(cy, CD1400_TDR, ch)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x63<<1))<<cy->cy_bustype)), ((ch)))); | |||
| 1260 | count++; | |||
| 1261 | } | |||
| 1262 | } else { | |||
| 1263 | /* no data to send -- check if we should | |||
| 1264 | start/stop a break */ | |||
| 1265 | /* XXX does this cause too much delay before | |||
| 1266 | breaks? */ | |||
| 1267 | if (ISSET(cy->cy_flags, CYF_START_BREAK)((cy->cy_flags) & (0x02))) { | |||
| 1268 | cd_write_reg(cy, CD1400_TDR, 0)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x63<<1))<<cy->cy_bustype)), ((0)))); | |||
| 1269 | cd_write_reg(cy, CD1400_TDR, 0x81)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x63<<1))<<cy->cy_bustype)), ((0x81)))); | |||
| 1270 | CLR(cy->cy_flags, CYF_START_BREAK)((cy->cy_flags) &= ~(0x02)); | |||
| 1271 | } | |||
| 1272 | if (ISSET(cy->cy_flags, CYF_END_BREAK)((cy->cy_flags) & (0x04))) { | |||
| 1273 | cd_write_reg(cy, CD1400_TDR, 0)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x63<<1))<<cy->cy_bustype)), ((0)))); | |||
| 1274 | cd_write_reg(cy, CD1400_TDR, 0x83)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x63<<1))<<cy->cy_bustype)), ((0x83)))); | |||
| 1275 | CLR(cy->cy_flags, CYF_END_BREAK)((cy->cy_flags) &= ~(0x04)); | |||
| 1276 | } | |||
| 1277 | } | |||
| 1278 | ||||
| 1279 | if (tp->t_outq.c_cc == 0) { | |||
| 1280 | txdone: | |||
| 1281 | /* | |||
| 1282 | * No data to send or requested to stop. | |||
| 1283 | * Disable transmit interrupt | |||
| 1284 | */ | |||
| 1285 | cd_write_reg(cy, CD1400_SRER,((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x06<<1))<<cy->cy_bustype)), ((((cy->cy_memt )->read_1((cy->cy_memh), (cy->cy_chip_offs+(((0x06<< 1))<<cy->cy_bustype)))) & ~(1<<2))))) | |||
| 1286 | cd_read_reg(cy, CD1400_SRER)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x06<<1))<<cy->cy_bustype)), ((((cy->cy_memt )->read_1((cy->cy_memh), (cy->cy_chip_offs+(((0x06<< 1))<<cy->cy_bustype)))) & ~(1<<2))))) | |||
| 1287 | & ~CD1400_SRER_TXRDY)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x06<<1))<<cy->cy_bustype)), ((((cy->cy_memt )->read_1((cy->cy_memh), (cy->cy_chip_offs+(((0x06<< 1))<<cy->cy_bustype)))) & ~(1<<2))))); | |||
| 1288 | CLR(cy->cy_flags, CYF_STOP)((cy->cy_flags) &= ~(0x08)); | |||
| 1289 | CLR(tp->t_state, TS_BUSY)((tp->t_state) &= ~(0x00004)); | |||
| ||||
| 1290 | } | |||
| 1291 | ||||
| 1292 | if (tp->t_outq.c_cc <= tp->t_lowat) { | |||
| 1293 | SET(cy->cy_flags, CYF_START)((cy->cy_flags) |= (0x20)); | |||
| 1294 | sc->sc_events = 1; | |||
| 1295 | } | |||
| 1296 | ||||
| 1297 | /* terminate service context */ | |||
| 1298 | cd_write_reg(cy, CD1400_TIR, save_tir & 0x3f)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x6A<<1))<<cy->cy_bustype)), ((save_tir & 0x3f)))); | |||
| 1299 | cd_write_reg(cy, CD1400_CAR, save_car)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x68<<1))<<cy->cy_bustype)), ((save_car))) ); | |||
| 1300 | int_serviced = 1; | |||
| 1301 | } /* if(tx_service...) */ | |||
| 1302 | } /* for(...all CD1400s on a card) */ | |||
| 1303 | ||||
| 1304 | /* ensure an edge for next interrupt */ | |||
| 1305 | bus_space_write_1(sc->sc_memt, sc->sc_memh,((sc->sc_memt)->write_1((sc->sc_memh), (0x1800<< sc->sc_bustype), (0))) | |||
| 1306 | CY_CLEAR_INTR<<sc->sc_bustype, 0)((sc->sc_memt)->write_1((sc->sc_memh), (0x1800<< sc->sc_bustype), (0))); | |||
| 1307 | return (int_serviced); | |||
| 1308 | } | |||
| 1309 | ||||
| 1310 | /* | |||
| 1311 | * subroutine to enable CD1400 transmitter | |||
| 1312 | */ | |||
| 1313 | void | |||
| 1314 | cy_enable_transmitter(struct cy_port *cy) | |||
| 1315 | { | |||
| 1316 | int s; | |||
| 1317 | s = spltty()splraise(0x9); | |||
| 1318 | cd_write_reg(cy, CD1400_CAR, cy->cy_port_num & CD1400_CAR_CHAN)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x68<<1))<<cy->cy_bustype)), ((cy->cy_port_num & (3<<0))))); | |||
| 1319 | cd_write_reg(cy, CD1400_SRER, cd_read_reg(cy, CD1400_SRER)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x06<<1))<<cy->cy_bustype)), ((((cy->cy_memt )->read_1((cy->cy_memh), (cy->cy_chip_offs+(((0x06<< 1))<<cy->cy_bustype)))) | (1<<2))))) | |||
| 1320 | | CD1400_SRER_TXRDY)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x06<<1))<<cy->cy_bustype)), ((((cy->cy_memt )->read_1((cy->cy_memh), (cy->cy_chip_offs+(((0x06<< 1))<<cy->cy_bustype)))) | (1<<2))))); | |||
| 1321 | splx(s)spllower(s); | |||
| 1322 | } | |||
| 1323 | ||||
| 1324 | /* | |||
| 1325 | * Execute a CD1400 channel command | |||
| 1326 | */ | |||
| 1327 | void | |||
| 1328 | cd1400_channel_cmd(struct cy_port *cy, int cmd) | |||
| 1329 | { | |||
| 1330 | u_int waitcnt = 5 * 8 * 1024; /* approx 5 ms */ | |||
| 1331 | ||||
| 1332 | #ifdef CY_DEBUG | |||
| 1333 | printf("c1400_channel_cmd cy %p command 0x%x\n", cy, cmd); | |||
| 1334 | #endif | |||
| 1335 | ||||
| 1336 | /* wait until cd1400 is ready to process a new command */ | |||
| 1337 | while (cd_read_reg(cy, CD1400_CCR)((cy->cy_memt)->read_1((cy->cy_memh), (cy->cy_chip_offs +(((0x05<<1))<<cy->cy_bustype)))) != 0 && waitcnt-- > 0) | |||
| 1338 | ; | |||
| 1339 | ||||
| 1340 | if (waitcnt == 0) | |||
| 1341 | log(LOG_ERR3, "cy: channel command timeout\n"); | |||
| 1342 | ||||
| 1343 | cd_write_reg(cy, CD1400_CCR, cmd)((cy->cy_memt)->write_1((cy->cy_memh), (cy->cy_chip_offs +(((0x05<<1))<<cy->cy_bustype)), ((cmd)))); | |||
| 1344 | } | |||
| 1345 | ||||
| 1346 | /* | |||
| 1347 | * Compute clock option register and baud rate register values | |||
| 1348 | * for a given speed. Return 0 on success, -1 on failure. | |||
| 1349 | * | |||
| 1350 | * The error between requested and actual speed seems | |||
| 1351 | * to be well within allowed limits (less than 3%) | |||
| 1352 | * with every speed value between 50 and 150000 bps. | |||
| 1353 | */ | |||
| 1354 | int | |||
| 1355 | cy_speed(speed_t speed, int *cor, int *bpr, int cy_clock) | |||
| 1356 | { | |||
| 1357 | int c, co, br; | |||
| 1358 | ||||
| 1359 | if (speed < 50 || speed > 150000) | |||
| 1360 | return (-1); | |||
| 1361 | ||||
| 1362 | for (c = 0, co = 8; co <= 2048; co <<= 2, c++) { | |||
| 1363 | br = (cy_clock + (co * speed) / 2) / (co * speed); | |||
| 1364 | if (br < 0x100) { | |||
| 1365 | *bpr = br; | |||
| 1366 | *cor = c; | |||
| 1367 | return (0); | |||
| 1368 | } | |||
| 1369 | } | |||
| 1370 | ||||
| 1371 | return (-1); | |||
| 1372 | } |