cy.c revision 1.58 1 /* $NetBSD: cy.c,v 1.58 2011/04/24 16:27:00 rmind Exp $ */
2
3 /*
4 * cy.c
5 *
6 * Driver for Cyclades Cyclom-8/16/32 multiport serial cards
7 * (currently not tested with Cyclom-32 cards)
8 *
9 * Timo Rossi, 1996
10 *
11 * Supports both ISA and PCI Cyclom cards
12 *
13 * Lots of debug output can be enabled by defining CY_DEBUG
14 * Some debugging counters (number of receive/transmit interrupts etc.)
15 * can be enabled by defining CY_DEBUG1
16 */
17
18 #include <sys/cdefs.h>
19 __KERNEL_RCSID(0, "$NetBSD: cy.c,v 1.58 2011/04/24 16:27:00 rmind Exp $");
20
21 #include <sys/param.h>
22 #include <sys/ioctl.h>
23 #include <sys/syslog.h>
24 #include <sys/fcntl.h>
25 #include <sys/tty.h>
26 #include <sys/proc.h>
27 #include <sys/conf.h>
28 #include <sys/select.h>
29 #include <sys/device.h>
30 #include <sys/malloc.h>
31 #include <sys/systm.h>
32 #include <sys/callout.h>
33 #include <sys/kauth.h>
34
35 #include <sys/bus.h>
36
37 #include <dev/ic/cd1400reg.h>
38 #include <dev/ic/cyreg.h>
39 #include <dev/ic/cyvar.h>
40
41 static int cyparam(struct tty *, struct termios *);
42 static void cystart(struct tty *);
43 static void cy_poll(void *);
44 static int cy_modem_control(struct cy_softc *, struct cy_port *, int, int);
45 static void cy_enable_transmitter(struct cy_softc *, struct cy_port *);
46 static void cd1400_channel_cmd(struct cy_softc *, struct cy_port *, int);
47 static int cy_speed(speed_t, int *, int *, int);
48
49 extern struct cfdriver cy_cd;
50
51 static dev_type_open(cyopen);
52 static dev_type_close(cyclose);
53 static dev_type_read(cyread);
54 static dev_type_write(cywrite);
55 static dev_type_ioctl(cyioctl);
56 static dev_type_stop(cystop);
57 static dev_type_tty(cytty);
58 static dev_type_poll(cypoll);
59
60 const struct cdevsw cy_cdevsw = {
61 .d_open = cyopen,
62 .d_close = cyclose,
63 .d_read = cyread,
64 .d_write = cywrite,
65 .d_ioctl = cyioctl,
66 .d_stop = cystop,
67 .d_tty = cytty,
68 .d_poll = cypoll,
69 .d_mmap = nommap,
70 .d_kqfilter = ttykqfilter,
71 .d_flag = D_TTY
72 };
73
74 static int cy_open = 0;
75 static int cy_events = 0;
76
77 int cy_attached_ttys;
78 bool cy_callout_init;
79 callout_t cy_poll_callout;
80
81 /*
82 * Common probe routine
83 */
84 int
85 cy_find(struct cy_softc *sc)
86 {
87 int cy_chip, chip;
88 u_char firmware_ver;
89 bus_space_tag_t tag = sc->sc_memt;
90 bus_space_handle_t bsh = sc->sc_bsh;
91 int bustype = sc->sc_bustype;
92
93 /* Cyclom card hardware reset */
94 bus_space_write_1(tag, bsh, CY16_RESET << bustype, 0);
95 DELAY(500); /* wait for reset to complete */
96 bus_space_write_1(tag, bsh, CY_CLEAR_INTR << bustype, 0);
97
98 #ifdef CY_DEBUG
99 printf("cy: card reset done\n");
100 #endif
101 sc->sc_nchips = 0;
102
103 for (cy_chip = 0, chip = 0; cy_chip < CY_MAX_CD1400s;
104 cy_chip++, chip += (CY_CD1400_MEMSPACING << bustype)) {
105 int i;
106
107 /*
108 * the last 4 nchips are 'interleaved' with the first 4 on
109 * 32-port boards
110 */
111 if (cy_chip == 4)
112 chip -= (CY32_ADDR_FIX << bustype);
113
114 #ifdef CY_DEBUG
115 printf("sy: probe chip %d offset 0x%x ... ", cy_chip, chip);
116 #endif
117
118 /* wait until the chip is ready for command */
119 DELAY(1000);
120 if (bus_space_read_1(tag, bsh, chip +
121 ((CD1400_CCR << 1) << bustype)) != 0) {
122 #ifdef CY_DEBUG
123 printf("not ready for command\n");
124 #endif
125 break;
126 }
127 /* clear the firmware version reg. */
128 bus_space_write_1(tag, bsh, chip +
129 ((CD1400_GFRCR << 1) << bustype), 0);
130
131 /*
132 * On Cyclom-16 references to non-existent chip 4
133 * actually access chip 0 (address line 9 not decoded).
134 * Here we check if the clearing of chip 4 GFRCR actually
135 * cleared chip 0 GFRCR. In that case we have a 16 port card.
136 */
137 if (cy_chip == 4 &&
138 bus_space_read_1(tag, bsh, /* off for chip 0 (0) + */
139 ((CD1400_GFRCR << 1) << bustype)) == 0)
140 break;
141
142 /* reset the chip */
143 bus_space_write_1(tag, bsh, chip +
144 ((CD1400_CCR << 1) << bustype),
145 CD1400_CCR_CMDRESET | CD1400_CCR_FULLRESET);
146
147 /* wait for the chip to initialize itself */
148 for (i = 0; i < 200; i++) {
149 DELAY(50);
150 firmware_ver = bus_space_read_1(tag, bsh, chip +
151 ((CD1400_GFRCR << 1) << bustype));
152 if ((firmware_ver & 0xf0) == 0x40) /* found a CD1400 */
153 break;
154 }
155 #ifdef CY_DEBUG
156 printf("firmware version 0x%x\n", firmware_ver);
157 #endif
158
159 if ((firmware_ver & 0xf0) != 0x40)
160 break;
161
162 /* firmware version OK, CD1400 found */
163 sc->sc_nchips++;
164 }
165
166 if (sc->sc_nchips == 0) {
167 #ifdef CY_DEBUG
168 printf("no CD1400s found\n");
169 #endif
170 return 0;
171 }
172 #ifdef CY_DEBUG
173 printf("found %d CD1400s\n", sc->sc_nchips);
174 #endif
175
176 return 1;
177 }
178
179 void
180 cy_attach(struct cy_softc *sc)
181 {
182 int port, cy_chip, num_chips, cdu, chip;
183 int cy_clock;
184
185 if (!cy_callout_init) {
186 cy_callout_init = true;
187 callout_init(&cy_poll_callout, 0);
188 }
189
190 num_chips = sc->sc_nchips;
191 if (num_chips == 0)
192 return;
193
194 memset(sc->sc_ports, 0, sizeof(sc->sc_ports));
195
196 port = 0;
197 for (cy_chip = 0, chip = 0; cy_chip < num_chips; cy_chip++,
198 chip += (CY_CD1400_MEMSPACING << sc->sc_bustype)) {
199
200 if (cy_chip == 4)
201 chip -= (CY32_ADDR_FIX << sc->sc_bustype);
202
203 #ifdef CY_DEBUG
204 aprint_debug("attach CD1400 #%d offset 0x%x\n", cy_chip, chip);
205 #endif
206 sc->sc_cd1400_offs[cy_chip] = chip;
207
208 /*
209 * configure port 0 as serial port (should already be after
210 * reset)
211 */
212 cd_write_reg(sc, cy_chip, CD1400_GCR, 0);
213
214 if (cd_read_reg(sc, cy_chip, CD1400_GFRCR) <= 0x46)
215 cy_clock = CY_CLOCK;
216 else
217 cy_clock = CY_CLOCK_60;
218
219 /* set up a receive timeout period (1ms) */
220 cd_write_reg(sc, cy_chip, CD1400_PPR,
221 (cy_clock / CD1400_PPR_PRESCALER / 1000) + 1);
222
223 for (cdu = 0; cdu < CD1400_NO_OF_CHANNELS; cdu++) {
224 sc->sc_ports[port].cy_softc = sc;
225 sc->sc_ports[port].cy_port_num = port;
226 sc->sc_ports[port].cy_chip = cy_chip;
227 sc->sc_ports[port].cy_clock = cy_clock;
228
229 /* should we initialize anything else here? */
230 port++;
231 } /* for(each port on one CD1400...) */
232
233 } /* for(each CD1400 on a card... ) */
234
235 sc->sc_nchannels = port;
236
237 aprint_normal_dev(sc->sc_dev, "%d channels (ttyCY%03d..ttyCY%03d)\n",
238 sc->sc_nchannels, cy_attached_ttys,
239 cy_attached_ttys + (sc->sc_nchannels - 1));
240
241 cy_attached_ttys += sc->sc_nchannels;
242
243 /* ensure an edge for the next interrupt */
244 bus_space_write_1(sc->sc_memt, sc->sc_bsh,
245 CY_CLEAR_INTR << sc->sc_bustype, 0);
246 }
247
248 #define CYDIALOUT_MASK 0x80000
249 #define CY_DIALOUT(dev) (minor(dev) & CYDIALOUT_MASK)
250
251 #define CY_PORT(dev) cy_getport((dev))
252 #define CY_BOARD(cy) ((cy)->cy_softc)
253
254 static struct cy_port *
255 cy_getport(dev_t dev)
256 {
257 int i, j, k, u = minor(dev) & ~CYDIALOUT_MASK;
258 struct cy_softc *sc;
259
260 for (i = 0, j = 0; i < cy_cd.cd_ndevs; i++) {
261 k = j;
262 sc = device_lookup_private(&cy_cd, i);
263 if (sc == NULL)
264 continue;
265 if (sc->sc_nchannels == 0)
266 continue;
267 j += sc->sc_nchannels;
268 if (j > u)
269 return (&sc->sc_ports[u - k]);
270 }
271
272 return (NULL);
273 }
274
275 /*
276 * open routine. returns zero if successful, else error code
277 */
278 int
279 cyopen(dev_t dev, int flag, int mode, struct lwp *l)
280 {
281 struct cy_softc *sc;
282 struct cy_port *cy;
283 struct tty *tp;
284 int s, error;
285
286 cy = CY_PORT(dev);
287 if (cy == NULL)
288 return (ENXIO);
289 sc = CY_BOARD(cy);
290
291 s = spltty();
292 if (cy->cy_tty == NULL) {
293 if ((cy->cy_tty = tty_alloc()) == NULL) {
294 splx(s);
295 aprint_error_dev(sc->sc_dev,
296 "port %d: can't allocate tty\n",
297 cy->cy_port_num);
298 return (ENOMEM);
299 }
300 tty_attach(cy->cy_tty);
301 }
302 splx(s);
303
304 tp = cy->cy_tty;
305 tp->t_oproc = cystart;
306 tp->t_param = cyparam;
307 tp->t_dev = dev;
308
309 if (kauth_authorize_device_tty(l->l_cred, KAUTH_DEVICE_TTY_OPEN, tp))
310 return (EBUSY);
311
312 if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
313 ttychars(tp);
314 tp->t_iflag = TTYDEF_IFLAG;
315 tp->t_oflag = TTYDEF_OFLAG;
316 tp->t_cflag = TTYDEF_CFLAG;
317 if (ISSET(cy->cy_openflags, TIOCFLAG_CLOCAL))
318 SET(tp->t_cflag, CLOCAL);
319 if (ISSET(cy->cy_openflags, TIOCFLAG_CRTSCTS))
320 SET(tp->t_cflag, CRTSCTS);
321 if (ISSET(cy->cy_openflags, TIOCFLAG_MDMBUF))
322 SET(tp->t_cflag, MDMBUF);
323 tp->t_lflag = TTYDEF_LFLAG;
324 tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
325
326 s = spltty();
327
328 /*
329 * Allocate input ring buffer if we don't already have one
330 */
331 if (cy->cy_ibuf == NULL) {
332 cy->cy_ibuf = malloc(CY_IBUF_SIZE, M_DEVBUF, M_NOWAIT);
333 if (cy->cy_ibuf == NULL) {
334 aprint_error_dev(sc->sc_dev,
335 "port %d: can't allocate input buffer\n",
336 cy->cy_port_num);
337 splx(s);
338 return ENOMEM;
339 }
340 cy->cy_ibuf_end = cy->cy_ibuf + CY_IBUF_SIZE;
341 }
342 /* mark the ring buffer as empty */
343 cy->cy_ibuf_rd_ptr = cy->cy_ibuf_wr_ptr = cy->cy_ibuf;
344
345 /* select CD1400 channel */
346 cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
347 cy->cy_port_num & CD1400_CAR_CHAN);
348 /* reset the channel */
349 cd1400_channel_cmd(sc, cy, CD1400_CCR_CMDRESET);
350 /* encode unit (port) number in LIVR */
351 /* there is just enough space for 5 bits (32 ports) */
352 cd_write_reg(sc, cy->cy_chip, CD1400_LIVR,
353 cy->cy_port_num << 3);
354
355 cy->cy_channel_control = 0;
356
357 /* hmm... need spltty() here? */
358 if (cy_open == 0) {
359 cy_open = 1;
360 callout_reset(&cy_poll_callout, 1, cy_poll, NULL);
361 }
362 /* this sets parameters and raises DTR */
363 cyparam(tp, &tp->t_termios);
364
365 ttsetwater(tp);
366
367 /* raise RTS too */
368 cy_modem_control(sc, cy, TIOCM_RTS, DMBIS);
369
370 cy->cy_carrier_stat =
371 cd_read_reg(sc, cy->cy_chip, CD1400_MSVR2);
372
373 /* enable receiver and modem change interrupts */
374 cd_write_reg(sc, cy->cy_chip, CD1400_SRER,
375 CD1400_SRER_MDMCH | CD1400_SRER_RXDATA);
376
377 if (CY_DIALOUT(dev) ||
378 ISSET(cy->cy_openflags, TIOCFLAG_SOFTCAR) ||
379 ISSET(tp->t_cflag, MDMBUF) ||
380 ISSET(cy->cy_carrier_stat, CD1400_MSVR2_CD))
381 SET(tp->t_state, TS_CARR_ON);
382 else
383 CLR(tp->t_state, TS_CARR_ON);
384 splx(s);
385 }
386
387 /* wait for carrier if necessary */
388 if (!ISSET(flag, O_NONBLOCK)) {
389 mutex_spin_enter(&tty_lock);
390 while (!ISSET(tp->t_cflag, CLOCAL) &&
391 !ISSET(tp->t_state, TS_CARR_ON)) {
392 tp->t_wopen++;
393 error = ttysleep(tp, &tp->t_rawcv, true, 0);
394 tp->t_wopen--;
395 if (error != 0) {
396 mutex_spin_exit(&tty_lock);
397 return error;
398 }
399 }
400 mutex_spin_exit(&tty_lock);
401 }
402
403 return (*tp->t_linesw->l_open) (dev, tp);
404 }
405
406 /*
407 * close routine. returns zero if successful, else error code
408 */
409 int
410 cyclose(dev_t dev, int flag, int mode, struct lwp *l)
411 {
412 struct cy_softc *sc;
413 struct cy_port *cy;
414 struct tty *tp;
415 int s;
416
417 cy = CY_PORT(dev);
418 sc = CY_BOARD(cy);
419 tp = cy->cy_tty;
420
421 (*tp->t_linesw->l_close) (tp, flag);
422 s = spltty();
423
424 if (ISSET(tp->t_cflag, HUPCL) &&
425 !ISSET(cy->cy_openflags, TIOCFLAG_SOFTCAR)) {
426 /*
427 * drop DTR and RTS (should we wait for output buffer to
428 * become empty first?)
429 */
430 cy_modem_control(sc, cy, 0, DMSET);
431 }
432 /*
433 * XXX should we disable modem change and
434 * receive interrupts here or somewhere ?
435 */
436 CLR(tp->t_state, TS_BUSY | TS_FLUSH);
437
438 splx(s);
439 ttyclose(tp);
440
441 return 0;
442 }
443
444 /*
445 * Read routine
446 */
447 int
448 cyread(dev_t dev, struct uio *uio, int flag)
449 {
450 struct cy_port *cy;
451 struct tty *tp;
452
453 cy = CY_PORT(dev);
454 tp = cy->cy_tty;
455
456 return ((*tp->t_linesw->l_read)(tp, uio, flag));
457 }
458
459 /*
460 * Write routine
461 */
462 int
463 cywrite(dev_t dev, struct uio *uio, int flag)
464 {
465 struct cy_port *cy;
466 struct tty *tp;
467
468 cy = CY_PORT(dev);
469 tp = cy->cy_tty;
470
471 return ((*tp->t_linesw->l_write)(tp, uio, flag));
472 }
473
474 /*
475 * Poll routine
476 */
477 int
478 cypoll(dev_t dev, int events, struct lwp *l)
479 {
480 struct cy_port *cy;
481 struct tty *tp;
482
483 cy = CY_PORT(dev);
484 tp = cy->cy_tty;
485
486 return ((*tp->t_linesw->l_poll)(tp, events, l));
487 }
488
489 /*
490 * return tty pointer
491 */
492 struct tty *
493 cytty(dev_t dev)
494 {
495 struct cy_port *cy;
496
497 cy = CY_PORT(dev);
498
499 return (cy->cy_tty);
500 }
501
502 /*
503 * ioctl routine
504 */
505 int
506 cyioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
507 {
508 struct cy_softc *sc;
509 struct cy_port *cy;
510 struct tty *tp;
511 int error;
512
513 cy = CY_PORT(dev);
514 sc = CY_BOARD(cy);
515 tp = cy->cy_tty;
516
517 error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, l);
518 if (error != EPASSTHROUGH)
519 return error;
520
521 error = ttioctl(tp, cmd, data, flag, l);
522 if (error != EPASSTHROUGH)
523 return error;
524
525 /* XXX should not allow dropping DTR when dialin? */
526
527 switch (cmd) {
528 case TIOCSBRK: /* start break */
529 SET(cy->cy_flags, CY_F_START_BREAK);
530 cy_enable_transmitter(sc, cy);
531 break;
532
533 case TIOCCBRK: /* stop break */
534 SET(cy->cy_flags, CY_F_END_BREAK);
535 cy_enable_transmitter(sc, cy);
536 break;
537
538 case TIOCSDTR: /* DTR on */
539 cy_modem_control(sc, cy, TIOCM_DTR, DMBIS);
540 break;
541
542 case TIOCCDTR: /* DTR off */
543 cy_modem_control(sc, cy, TIOCM_DTR, DMBIC);
544 break;
545
546 case TIOCMSET: /* set new modem control line values */
547 cy_modem_control(sc, cy, *((int *) data), DMSET);
548 break;
549
550 case TIOCMBIS: /* turn modem control bits on */
551 cy_modem_control(sc, cy, *((int *) data), DMBIS);
552 break;
553
554 case TIOCMBIC: /* turn modem control bits off */
555 cy_modem_control(sc, cy, *((int *) data), DMBIC);
556 break;
557
558 case TIOCMGET: /* get modem control/status line state */
559 *((int *) data) = cy_modem_control(sc, cy, 0, DMGET);
560 break;
561
562 case TIOCGFLAGS:
563 *((int *) data) = cy->cy_openflags |
564 (CY_DIALOUT(dev) ? TIOCFLAG_SOFTCAR : 0);
565 break;
566
567 case TIOCSFLAGS:
568 error = kauth_authorize_device_tty(l->l_cred,
569 KAUTH_DEVICE_TTY_PRIVSET, tp);
570 if (error != 0)
571 return EPERM;
572
573 cy->cy_openflags = *((int *) data) &
574 (TIOCFLAG_SOFTCAR | TIOCFLAG_CLOCAL |
575 TIOCFLAG_CRTSCTS | TIOCFLAG_MDMBUF);
576 break;
577
578 default:
579 return EPASSTHROUGH;
580 }
581
582 return 0;
583 }
584
585 /*
586 * start output
587 */
588 void
589 cystart(struct tty *tp)
590 {
591 struct cy_softc *sc;
592 struct cy_port *cy;
593 int s;
594
595 cy = CY_PORT(tp->t_dev);
596 sc = cy->cy_softc;
597
598 s = spltty();
599
600 #ifdef CY_DEBUG1
601 cy->cy_start_count++;
602 #endif
603
604 if (!ISSET(tp->t_state, TS_TTSTOP | TS_TIMEOUT | TS_BUSY)) {
605 if (!ttypull(tp))
606 goto out;
607 SET(tp->t_state, TS_BUSY);
608 cy_enable_transmitter(sc, cy);
609 }
610 out:
611
612 splx(s);
613 }
614
615 /*
616 * stop output
617 */
618 void
619 cystop(struct tty *tp, int flag)
620 {
621 struct cy_port *cy;
622 int s;
623
624 cy = CY_PORT(tp->t_dev);
625
626 s = spltty();
627 if (ISSET(tp->t_state, TS_BUSY)) {
628 if (!ISSET(tp->t_state, TS_TTSTOP))
629 SET(tp->t_state, TS_FLUSH);
630
631 /*
632 * the transmit interrupt routine will disable transmit when it
633 * notices that CY_F_STOP has been set.
634 */
635 SET(cy->cy_flags, CY_F_STOP);
636 }
637 splx(s);
638 }
639
640 /*
641 * parameter setting routine.
642 * returns 0 if successful, else returns error code
643 */
644 int
645 cyparam(struct tty *tp, struct termios *t)
646 {
647 struct cy_softc *sc;
648 struct cy_port *cy;
649 int ibpr = 0, obpr = 0, i_clk_opt = 0, o_clk_opt = 0; /* XXX: GCC */
650 int s, opt;
651
652 cy = CY_PORT(tp->t_dev);
653 sc = CY_BOARD(cy);
654
655 if (t->c_ospeed != 0 && cy_speed(t->c_ospeed, &o_clk_opt, &obpr, cy->cy_clock) < 0)
656 return EINVAL;
657
658 if (t->c_ispeed != 0 && cy_speed(t->c_ispeed, &i_clk_opt, &ibpr, cy->cy_clock) < 0)
659 return EINVAL;
660
661 s = spltty();
662
663 /* hang up the line is ospeed is zero, else turn DTR on */
664 cy_modem_control(sc, cy, TIOCM_DTR, (t->c_ospeed == 0 ? DMBIC : DMBIS));
665
666 /* channel was selected by the above call to cy_modem_control() */
667 #if 0
668 cd_write_reg(sc, cy->cy_chip, CD1400_CAR, port & CD1400_CAR_CHAN);
669 #endif
670
671 /* set transmit speed */
672 if (t->c_ospeed != 0) {
673 cd_write_reg(sc, cy->cy_chip, CD1400_TCOR, o_clk_opt);
674 cd_write_reg(sc, cy->cy_chip, CD1400_TBPR, obpr);
675 }
676 /* set receive speed */
677 if (t->c_ispeed != 0) {
678 cd_write_reg(sc, cy->cy_chip, CD1400_RCOR, i_clk_opt);
679 cd_write_reg(sc, cy->cy_chip, CD1400_RBPR, ibpr);
680 }
681 opt = CD1400_CCR_CMDCHANCTL | CD1400_CCR_XMTEN
682 | (ISSET(t->c_cflag, CREAD) ? CD1400_CCR_RCVEN : CD1400_CCR_RCVDIS);
683
684 if (opt != cy->cy_channel_control) {
685 cy->cy_channel_control = opt;
686 cd1400_channel_cmd(sc, cy, opt);
687 }
688 /* compute COR1 contents */
689 opt = 0;
690 if (ISSET(t->c_cflag, PARENB)) {
691 if (ISSET(t->c_cflag, PARODD))
692 opt |= CD1400_COR1_PARODD;
693 opt |= CD1400_COR1_PARNORMAL;
694 }
695 if (!ISSET(t->c_iflag, INPCK))
696 opt |= CD1400_COR1_NOINPCK; /* no parity checking */
697
698 if (ISSET(t->c_cflag, CSTOPB))
699 opt |= CD1400_COR1_STOP2;
700
701 switch (t->c_cflag & CSIZE) {
702 case CS5:
703 opt |= CD1400_COR1_CS5;
704 break;
705
706 case CS6:
707 opt |= CD1400_COR1_CS6;
708 break;
709
710 case CS7:
711 opt |= CD1400_COR1_CS7;
712 break;
713
714 default:
715 opt |= CD1400_COR1_CS8;
716 break;
717 }
718
719 cd_write_reg(sc, cy->cy_chip, CD1400_COR1, 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(sc, cy->cy_chip, CD1400_COR2,
732 CD1400_COR2_ETC |
733 (ISSET(t->c_cflag, CRTSCTS) ? CD1400_COR2_CCTS_OFLOW : 0));
734
735 cd_write_reg(sc, cy->cy_chip, CD1400_COR3, CY_RX_FIFO_THRESHOLD);
736
737 cd1400_channel_cmd(sc, cy, CD1400_CCR_CMDCORCHG |
738 CD1400_CCR_COR1 | CD1400_CCR_COR2 | CD1400_CCR_COR3);
739
740 cd_write_reg(sc, cy->cy_chip, CD1400_COR4, CD1400_COR4_PFO_EXCEPTION);
741 cd_write_reg(sc, cy->cy_chip, CD1400_COR5, 0);
742
743 /*
744 * set modem change option registers to generate interrupts
745 * on carrier detect changes.
746 *
747 * if hardware RTS handshaking is used
748 * also set the handshaking threshold.
749 */
750 if (cy->cy_clock == CY_CLOCK_60) {
751 cd_write_reg(sc, cy->cy_chip, CD1400_MCOR1, CD1400_MCOR1_CDzd |
752 (ISSET(t->c_cflag, CRTSCTS) ? CY_RX_DTR_THRESHOLD : 0));
753 } else {
754 cd_write_reg(sc, cy->cy_chip, CD1400_MCOR1, CD1400_MCOR1_CDzd);
755 }
756
757 cd_write_reg(sc, cy->cy_chip, CD1400_MCOR2, CD1400_MCOR2_CDod);
758
759 /*
760 * set receive timeout to approx. 2ms
761 * could use more complex logic here...
762 * (but is it actually needed or even useful?)
763 */
764 cd_write_reg(sc, cy->cy_chip, CD1400_RTPR, 2);
765
766 /*
767 * should do anything else here?
768 * XXX check MDMBUF handshaking like in com.c?
769 */
770
771 splx(s);
772 return 0;
773 }
774
775 /*
776 * set/get modem line status
777 *
778 * bits can be: TIOCM_DTR, TIOCM_RTS, TIOCM_CTS, TIOCM_CD, TIOCM_RI, TIOCM_DSR
779 */
780 int
781 cy_modem_control(struct cy_softc *sc, struct cy_port *cy, int bits, int howto)
782 {
783 struct tty *tp = cy->cy_tty;
784 int s, msvr;
785
786 s = spltty();
787
788 /* select channel */
789 cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
790 cy->cy_port_num & CD1400_CAR_CHAN);
791
792 /* Does not manipulate RTS if it is used for flow control. */
793 switch (howto) {
794 case DMGET:
795 bits = 0;
796 if (cy->cy_channel_control & CD1400_CCR_RCVEN)
797 bits |= TIOCM_LE;
798 msvr = cd_read_reg(sc, cy->cy_chip, CD1400_MSVR2);
799 if (cy->cy_clock == CY_CLOCK_60) {
800 if (cd_read_reg(sc, cy->cy_chip, CD1400_MSVR1) &
801 CD1400_MSVR1_RTS)
802 bits |= TIOCM_DTR;
803 if (msvr & CD1400_MSVR2_DTR)
804 bits |= TIOCM_RTS;
805 } else {
806 if (cd_read_reg(sc, cy->cy_chip, CD1400_MSVR1) &
807 CD1400_MSVR1_RTS)
808 bits |= TIOCM_RTS;
809 if (msvr & CD1400_MSVR2_DTR)
810 bits |= TIOCM_DTR;
811 }
812 if (msvr & CD1400_MSVR2_CTS)
813 bits |= TIOCM_CTS;
814 if (msvr & CD1400_MSVR2_CD)
815 bits |= TIOCM_CD;
816 /* Not connected on some Cyclom-Y boards? */
817 if (msvr & CD1400_MSVR2_DSR)
818 bits |= TIOCM_DSR;
819 /* Not connected on some Cyclom-8Y boards? */
820 if (msvr & CD1400_MSVR2_RI)
821 bits |= TIOCM_RI;
822 break;
823
824 case DMSET: /* replace old values with new ones */
825 if (cy->cy_clock == CY_CLOCK_60) {
826 if (!ISSET(tp->t_cflag, CRTSCTS))
827 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
828 ((bits & TIOCM_RTS) ? CD1400_MSVR2_DTR : 0));
829 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
830 ((bits & TIOCM_DTR) ? CD1400_MSVR1_RTS : 0));
831 } else {
832 if (!ISSET(tp->t_cflag, CRTSCTS))
833 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
834 ((bits & TIOCM_RTS) ? CD1400_MSVR1_RTS : 0));
835 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
836 ((bits & TIOCM_DTR) ? CD1400_MSVR2_DTR : 0));
837 }
838 break;
839
840 case DMBIS: /* set bits */
841 if (cy->cy_clock == CY_CLOCK_60) {
842 if (!ISSET(tp->t_cflag, CRTSCTS) &&
843 (bits & TIOCM_RTS) != 0)
844 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
845 CD1400_MSVR2_DTR);
846 if (bits & TIOCM_DTR)
847 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
848 CD1400_MSVR1_RTS);
849 } else {
850 if (!ISSET(tp->t_cflag, CRTSCTS) &&
851 (bits & TIOCM_RTS) != 0)
852 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1,
853 CD1400_MSVR1_RTS);
854 if (bits & TIOCM_DTR)
855 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2,
856 CD1400_MSVR2_DTR);
857 }
858 break;
859
860 case DMBIC: /* clear bits */
861 if (cy->cy_clock == CY_CLOCK_60) {
862 if (!ISSET(tp->t_cflag, CRTSCTS) && (bits & TIOCM_RTS))
863 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2, 0);
864 if (bits & TIOCM_DTR)
865 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1, 0);
866 } else {
867 if (!ISSET(tp->t_cflag, CRTSCTS) && (bits & TIOCM_RTS))
868 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR1, 0);
869 if (bits & TIOCM_DTR)
870 cd_write_reg(sc, cy->cy_chip, CD1400_MSVR2, 0);
871 }
872 break;
873 }
874 splx(s);
875 return ((howto == DMGET) ? bits : 0);
876 }
877
878 /*
879 * Upper-level handler loop (called from timer interrupt?)
880 * This routine is common for multiple cards
881 */
882 void
883 cy_poll(void *arg)
884 {
885 int card, port;
886 struct cy_softc *sc;
887 struct cy_port *cy;
888 struct tty *tp;
889 static int counter = 0;
890 #ifdef CY_DEBUG1
891 int did_something;
892 #endif
893 int s = spltty();
894
895 if (cy_events == 0 && ++counter < 200) {
896 splx(s);
897 goto out;
898 }
899 cy_events = 0;
900 splx(s);
901
902 for (card = 0; card < cy_cd.cd_ndevs; card++) {
903 sc = device_lookup_private(&cy_cd, card);
904 if (sc == NULL)
905 continue;
906
907 #ifdef CY_DEBUG1
908 sc->sc_poll_count1++;
909 did_something = 0;
910 #endif
911
912 for (port = 0; port < sc->sc_nchannels; port++) {
913 cy = &sc->sc_ports[port];
914 if ((tp = cy->cy_tty) == NULL || cy->cy_ibuf == NULL ||
915 (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0))
916 continue;
917
918 /*
919 * handle received data
920 */
921 while (cy->cy_ibuf_rd_ptr != cy->cy_ibuf_wr_ptr) {
922 u_char line_stat;
923 int chr;
924
925 line_stat = cy->cy_ibuf_rd_ptr[0];
926 chr = cy->cy_ibuf_rd_ptr[1];
927
928 if (line_stat &
929 (CD1400_RDSR_BREAK | CD1400_RDSR_FE))
930 chr |= TTY_FE;
931 if (line_stat & CD1400_RDSR_PE)
932 chr |= TTY_PE;
933
934 /*
935 * on an overrun error the data is treated as
936 * good just as it should be.
937 */
938
939 #ifdef CY_DEBUG
940 aprint_debug_dev(sc->sc_dev,
941 "port %d ttyinput 0x%x\n",
942 port, chr);
943 #endif
944
945 (*tp->t_linesw->l_rint) (chr, tp);
946
947 s = spltty(); /* really necessary? */
948 if ((cy->cy_ibuf_rd_ptr += 2) ==
949 cy->cy_ibuf_end)
950 cy->cy_ibuf_rd_ptr = cy->cy_ibuf;
951 splx(s);
952
953 #ifdef CY_DEBUG1
954 did_something = 1;
955 #endif
956 }
957
958 /*
959 * If we don't have any received data in ibuf and
960 * CRTSCTS is on and RTS is turned off, it is time to
961 * turn RTS back on
962 */
963 if (ISSET(tp->t_cflag, CRTSCTS)) {
964 /*
965 * we can't use cy_modem_control() here as it
966 * doesn't change RTS if RTSCTS is on
967 */
968 cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
969 port & CD1400_CAR_CHAN);
970
971 if (cy->cy_clock == CY_CLOCK_60) {
972 if ((cd_read_reg(sc, cy->cy_chip,
973 CD1400_MSVR2) & CD1400_MSVR2_DTR) == 0) {
974 cd_write_reg(sc, cy->cy_chip,
975 CD1400_MSVR2,CD1400_MSVR2_DTR);
976 #ifdef CY_DEBUG1
977 did_something = 1;
978 #endif
979 }
980 } else {
981 if ((cd_read_reg(sc, cy->cy_chip,
982 CD1400_MSVR1) & CD1400_MSVR1_RTS) == 0) {
983 cd_write_reg(sc, cy->cy_chip,
984 CD1400_MSVR1,CD1400_MSVR1_RTS);
985 #ifdef CY_DEBUG1
986 did_something = 1;
987 #endif
988 }
989 }
990 }
991
992 /*
993 * handle carrier changes
994 */
995 s = spltty();
996 if (ISSET(cy->cy_flags, CY_F_CARRIER_CHANGED)) {
997 int carrier;
998
999 CLR(cy->cy_flags, CY_F_CARRIER_CHANGED);
1000 splx(s);
1001
1002 carrier = ((cy->cy_carrier_stat &
1003 CD1400_MSVR2_CD) != 0);
1004
1005 #ifdef CY_DEBUG
1006 printf("cy_poll: carrier change "
1007 "(card %d, port %d, carrier %d)\n",
1008 card, port, carrier);
1009 #endif
1010 if (CY_DIALOUT(tp->t_dev) == 0 &&
1011 !(*tp->t_linesw->l_modem)(tp, carrier))
1012 cy_modem_control(sc, cy,
1013 TIOCM_DTR, DMBIC);
1014
1015 #ifdef CY_DEBUG1
1016 did_something = 1;
1017 #endif
1018 } else
1019 splx(s);
1020
1021 s = spltty();
1022 if (ISSET(cy->cy_flags, CY_F_START)) {
1023 CLR(cy->cy_flags, CY_F_START);
1024 splx(s);
1025
1026 (*tp->t_linesw->l_start) (tp);
1027
1028 #ifdef CY_DEBUG1
1029 did_something = 1;
1030 #endif
1031 } else
1032 splx(s);
1033
1034 /* could move this to even upper level... */
1035 if (cy->cy_fifo_overruns) {
1036 cy->cy_fifo_overruns = 0;
1037 /*
1038 * doesn't report overrun count, but
1039 * shouldn't really matter
1040 */
1041 log(LOG_WARNING, "%s: port %d fifo overrun\n",
1042 device_xname(sc->sc_dev), port);
1043 }
1044 if (cy->cy_ibuf_overruns) {
1045 cy->cy_ibuf_overruns = 0;
1046 log(LOG_WARNING, "%s: port %d ibuf overrun\n",
1047 device_xname(sc->sc_dev), port);
1048 }
1049 } /* for(port...) */
1050 #ifdef CY_DEBUG1
1051 if (did_something && counter >= 200)
1052 sc->sc_poll_count2++;
1053 #endif
1054 } /* for(card...) */
1055
1056 counter = 0;
1057
1058 out:
1059 callout_reset(&cy_poll_callout, 1, cy_poll, NULL);
1060 }
1061
1062 /*
1063 * hardware interrupt routine
1064 */
1065 int
1066 cy_intr(void *arg)
1067 {
1068 struct cy_softc *sc = arg;
1069 struct cy_port *cy;
1070 int cy_chip, stat;
1071 int int_serviced = 0;
1072
1073 /*
1074 * Check interrupt status of each CD1400 chip on this card
1075 * (multiple cards cannot share the same interrupt)
1076 */
1077 for (cy_chip = 0; cy_chip < sc->sc_nchips; cy_chip++) {
1078
1079 stat = cd_read_reg(sc, cy_chip, CD1400_SVRR);
1080 if (stat == 0)
1081 continue;
1082
1083 if (ISSET(stat, CD1400_SVRR_RXRDY)) {
1084 u_char save_car, save_rir, serv_type;
1085 u_char line_stat, recv_data, n_chars;
1086 u_char *buf_p;
1087
1088 save_rir = cd_read_reg(sc, cy_chip, CD1400_RIR);
1089 save_car = cd_read_reg(sc, cy_chip, CD1400_CAR);
1090 /* enter rx service */
1091 cd_write_reg(sc, cy_chip, CD1400_CAR, save_rir);
1092
1093 serv_type = cd_read_reg(sc, cy_chip, CD1400_RIVR);
1094 cy = &sc->sc_ports[serv_type >> 3];
1095
1096 #ifdef CY_DEBUG1
1097 cy->cy_rx_int_count++;
1098 #endif
1099
1100 buf_p = cy->cy_ibuf_wr_ptr;
1101
1102 if (ISSET(serv_type, CD1400_RIVR_EXCEPTION)) {
1103 line_stat = cd_read_reg(sc, cy->cy_chip,
1104 CD1400_RDSR);
1105 recv_data = cd_read_reg(sc, cy->cy_chip,
1106 CD1400_RDSR);
1107
1108 if (cy->cy_tty == NULL ||
1109 !ISSET(cy->cy_tty->t_state, TS_ISOPEN))
1110 goto end_rx_serv;
1111
1112 #ifdef CY_DEBUG
1113 aprint_debug_dev(
1114 sc->sc_dev,
1115 "port %d recv exception, "
1116 "line_stat 0x%x, char 0x%x\n",
1117 cy->cy_port_num, line_stat, recv_data);
1118 #endif
1119 if (ISSET(line_stat, CD1400_RDSR_OE))
1120 cy->cy_fifo_overruns++;
1121
1122 *buf_p++ = line_stat;
1123 *buf_p++ = recv_data;
1124 if (buf_p == cy->cy_ibuf_end)
1125 buf_p = cy->cy_ibuf;
1126
1127 if (buf_p == cy->cy_ibuf_rd_ptr) {
1128 if (buf_p == cy->cy_ibuf)
1129 buf_p = cy->cy_ibuf_end;
1130 buf_p -= 2;
1131 cy->cy_ibuf_overruns++;
1132 }
1133 cy_events = 1;
1134 } else {/* no exception, received data OK */
1135 n_chars = cd_read_reg(sc, cy->cy_chip,
1136 CD1400_RDCR);
1137
1138 /* If no tty or not open, discard data */
1139 if (cy->cy_tty == NULL ||
1140 !ISSET(cy->cy_tty->t_state, TS_ISOPEN)) {
1141 while (n_chars--)
1142 (void)cd_read_reg(sc,
1143 cy->cy_chip, CD1400_RDSR);
1144 goto end_rx_serv;
1145 }
1146
1147 #ifdef CY_DEBUG
1148 aprint_debug_dev(sc->sc_dev,
1149 "port %d receive ok %d chars\n",
1150 cy->cy_port_num, n_chars);
1151 #endif
1152 while (n_chars--) {
1153 *buf_p++ = 0; /* status: OK */
1154 /* data byte */
1155 *buf_p++ = cd_read_reg(sc,
1156 cy->cy_chip, CD1400_RDSR);
1157 if (buf_p == cy->cy_ibuf_end)
1158 buf_p = cy->cy_ibuf;
1159 if (buf_p == cy->cy_ibuf_rd_ptr) {
1160 if (buf_p == cy->cy_ibuf)
1161 buf_p = cy->cy_ibuf_end;
1162 buf_p -= 2;
1163 cy->cy_ibuf_overruns++;
1164 break;
1165 }
1166 }
1167 cy_events = 1;
1168 }
1169
1170 cy->cy_ibuf_wr_ptr = buf_p;
1171
1172 /* RTS handshaking for incoming data */
1173 if (ISSET(cy->cy_tty->t_cflag, CRTSCTS)) {
1174 int bf, msvr;
1175
1176 bf = buf_p - cy->cy_ibuf_rd_ptr;
1177 if (bf < 0)
1178 bf += CY_IBUF_SIZE;
1179
1180 if (bf > (CY_IBUF_SIZE / 2)) {
1181 /* turn RTS off */
1182 if (cy->cy_clock == CY_CLOCK_60)
1183 msvr = CD1400_MSVR2;
1184 else
1185 msvr = CD1400_MSVR1;
1186 cd_write_reg(sc, cy->cy_chip, msvr, 0);
1187 }
1188 }
1189
1190 end_rx_serv:
1191 /* terminate service context */
1192 cd_write_reg(sc, cy->cy_chip, CD1400_RIR,
1193 save_rir & 0x3f);
1194 cd_write_reg(sc, cy->cy_chip, CD1400_CAR, save_car);
1195 int_serviced = 1;
1196 } /* if (rx_service...) */
1197 if (ISSET(stat, CD1400_SVRR_MDMCH)) {
1198 u_char save_car, save_mir, serv_type, modem_stat;
1199
1200 save_mir = cd_read_reg(sc, cy_chip, CD1400_MIR);
1201 save_car = cd_read_reg(sc, cy_chip, CD1400_CAR);
1202 /* enter modem service */
1203 cd_write_reg(sc, cy_chip, CD1400_CAR, save_mir);
1204
1205 serv_type = cd_read_reg(sc, cy_chip, CD1400_MIVR);
1206 cy = &sc->sc_ports[serv_type >> 3];
1207
1208 #ifdef CY_DEBUG1
1209 cy->cy_modem_int_count++;
1210 #endif
1211
1212 modem_stat = cd_read_reg(sc, cy->cy_chip, CD1400_MSVR2);
1213
1214 #ifdef CY_DEBUG
1215 aprint_debug_dev(sc->sc_dev,
1216 "port %d modem line change, new stat 0x%x\n",
1217 cy->cy_port_num, modem_stat);
1218 #endif
1219 if (ISSET((cy->cy_carrier_stat ^ modem_stat), CD1400_MSVR2_CD)) {
1220 SET(cy->cy_flags, CY_F_CARRIER_CHANGED);
1221 cy_events = 1;
1222 }
1223 cy->cy_carrier_stat = modem_stat;
1224
1225 /* terminate service context */
1226 cd_write_reg(sc, cy->cy_chip, CD1400_MIR, save_mir & 0x3f);
1227 cd_write_reg(sc, cy->cy_chip, CD1400_CAR, save_car);
1228 int_serviced = 1;
1229 } /* if (modem_service...) */
1230 if (ISSET(stat, CD1400_SVRR_TXRDY)) {
1231 u_char save_car, save_tir, serv_type,
1232 count, ch;
1233 struct tty *tp;
1234
1235 save_tir = cd_read_reg(sc, cy_chip, CD1400_TIR);
1236 save_car = cd_read_reg(sc, cy_chip, CD1400_CAR);
1237 /* enter tx service */
1238 cd_write_reg(sc, cy_chip, CD1400_CAR, save_tir);
1239
1240 serv_type = cd_read_reg(sc, cy_chip, CD1400_TIVR);
1241 cy = &sc->sc_ports[serv_type >> 3];
1242
1243 #ifdef CY_DEBUG1
1244 cy->cy_tx_int_count++;
1245 #endif
1246 #ifdef CY_DEBUG
1247 aprint_debug_dev(sc->sc_dev, "port %d tx service\n",
1248 cy->cy_port_num);
1249 #endif
1250
1251 /* stop transmitting if no tty or CY_F_STOP set */
1252 tp = cy->cy_tty;
1253 if (tp == NULL || ISSET(cy->cy_flags, CY_F_STOP))
1254 goto txdone;
1255
1256 count = 0;
1257 if (ISSET(cy->cy_flags, CY_F_SEND_NUL)) {
1258 cd_write_reg(sc, cy->cy_chip, CD1400_TDR, 0);
1259 cd_write_reg(sc, cy->cy_chip, CD1400_TDR, 0);
1260 count += 2;
1261 CLR(cy->cy_flags, CY_F_SEND_NUL);
1262 }
1263 if (tp->t_outq.c_cc > 0) {
1264 SET(tp->t_state, TS_BUSY);
1265 while (tp->t_outq.c_cc > 0 &&
1266 count < CD1400_TX_FIFO_SIZE) {
1267 ch = getc(&tp->t_outq);
1268 /*
1269 * remember to double NUL characters
1270 * because embedded transmit commands
1271 * are enabled
1272 */
1273 if (ch == 0) {
1274 if (count >= CD1400_TX_FIFO_SIZE - 2) {
1275 SET(cy->cy_flags, CY_F_SEND_NUL);
1276 break;
1277 }
1278 cd_write_reg(sc, cy->cy_chip,
1279 CD1400_TDR, ch);
1280 count++;
1281 }
1282 cd_write_reg(sc, cy->cy_chip,
1283 CD1400_TDR, ch);
1284 count++;
1285 }
1286 } else {
1287 /*
1288 * no data to send -- check if we should
1289 * start/stop a break
1290 */
1291 /*
1292 * XXX does this cause too much delay before
1293 * breaks?
1294 */
1295 if (ISSET(cy->cy_flags, CY_F_START_BREAK)) {
1296 cd_write_reg(sc, cy->cy_chip,
1297 CD1400_TDR, 0);
1298 cd_write_reg(sc, cy->cy_chip,
1299 CD1400_TDR, 0x81);
1300 CLR(cy->cy_flags, CY_F_START_BREAK);
1301 }
1302 if (ISSET(cy->cy_flags, CY_F_END_BREAK)) {
1303 cd_write_reg(sc, cy->cy_chip,
1304 CD1400_TDR, 0);
1305 cd_write_reg(sc, cy->cy_chip,
1306 CD1400_TDR, 0x83);
1307 CLR(cy->cy_flags, CY_F_END_BREAK);
1308 }
1309 }
1310
1311 if (tp->t_outq.c_cc == 0) {
1312 txdone:
1313 /*
1314 * No data to send or requested to stop.
1315 * Disable transmit interrupt
1316 */
1317 cd_write_reg(sc, cy->cy_chip, CD1400_SRER,
1318 cd_read_reg(sc, cy->cy_chip, CD1400_SRER)
1319 & ~CD1400_SRER_TXRDY);
1320 CLR(cy->cy_flags, CY_F_STOP);
1321 CLR(tp->t_state, TS_BUSY);
1322 }
1323 if (tp->t_outq.c_cc <= tp->t_lowat) {
1324 SET(cy->cy_flags, CY_F_START);
1325 cy_events = 1;
1326 }
1327 /* terminate service context */
1328 cd_write_reg(sc, cy->cy_chip, CD1400_TIR, save_tir & 0x3f);
1329 cd_write_reg(sc, cy->cy_chip, CD1400_CAR, save_car);
1330 int_serviced = 1;
1331 } /* if (tx_service...) */
1332 } /* for(...all CD1400s on a card) */
1333
1334 /* ensure an edge for next interrupt */
1335 bus_space_write_1(sc->sc_memt, sc->sc_bsh,
1336 CY_CLEAR_INTR << sc->sc_bustype, 0);
1337 return int_serviced;
1338 }
1339
1340 /*
1341 * subroutine to enable CD1400 transmitter
1342 */
1343 void
1344 cy_enable_transmitter(struct cy_softc *sc, struct cy_port *cy)
1345 {
1346 int s = spltty();
1347 cd_write_reg(sc, cy->cy_chip, CD1400_CAR,
1348 cy->cy_port_num & CD1400_CAR_CHAN);
1349 cd_write_reg(sc, cy->cy_chip, CD1400_SRER,
1350 cd_read_reg(sc, cy->cy_chip, CD1400_SRER) | CD1400_SRER_TXRDY);
1351 splx(s);
1352 }
1353
1354 /*
1355 * Execute a CD1400 channel command
1356 */
1357 void
1358 cd1400_channel_cmd(struct cy_softc *sc, struct cy_port *cy, int cmd)
1359 {
1360 u_int waitcnt = 5 * 8 * 1024; /* approx 5 ms */
1361
1362 #ifdef CY_DEBUG
1363 printf("c1400_channel_cmd cy %p command 0x%x\n", cy, cmd);
1364 #endif
1365
1366 /* wait until cd1400 is ready to process a new command */
1367 while (cd_read_reg(sc, cy->cy_chip, CD1400_CCR) != 0 && waitcnt-- > 0);
1368
1369 if (waitcnt == 0)
1370 log(LOG_ERR, "%s: channel command timeout\n",
1371 device_xname(sc->sc_dev));
1372
1373 cd_write_reg(sc, cy->cy_chip, CD1400_CCR, cmd);
1374 }
1375
1376 /*
1377 * Compute clock option register and baud rate register values
1378 * for a given speed. Return 0 on success, -1 on failure.
1379 *
1380 * The error between requested and actual speed seems
1381 * to be well within allowed limits (less than 3%)
1382 * with every speed value between 50 and 150000 bps.
1383 */
1384 int
1385 cy_speed(speed_t speed, int *cor, int *bpr, int cy_clock)
1386 {
1387 int c, co, br;
1388
1389 if (speed < 50 || speed > 150000)
1390 return -1;
1391
1392 for (c = 0, co = 8; co <= 2048; co <<= 2, c++) {
1393 br = (cy_clock + (co * speed) / 2) / (co * speed);
1394 if (br < 0x100) {
1395 *bpr = br;
1396 *cor = c;
1397 return 0;
1398 }
1399 }
1400
1401 return -1;
1402 }
1403