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