This source file includes following definitions.
- cy_probe_common
- cy_attach
- cyopen
- cyclose
- cyread
- cywrite
- cytty
- cyioctl
- cystart
- cystop
- cyparam
- cy_modem_control
- cy_poll
- cy_intr
- cy_enable_transmitter
- cd1400_channel_cmd
- cy_speed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54 #include "cy.h"
55 #if NCY > 0
56
57 #include <sys/types.h>
58 #include <sys/param.h>
59 #include <sys/ioctl.h>
60 #include <sys/syslog.h>
61 #include <sys/fcntl.h>
62 #include <sys/tty.h>
63 #include <sys/proc.h>
64 #include <sys/conf.h>
65 #include <sys/user.h>
66 #include <sys/selinfo.h>
67 #include <sys/device.h>
68 #include <sys/malloc.h>
69 #include <sys/systm.h>
70
71 #include <machine/bus.h>
72 #include <machine/intr.h>
73
74 #if NCY_ISA > 0
75 #include <dev/isa/isavar.h>
76 #include <dev/isa/isareg.h>
77 #endif
78 #if NCY_PCI > 0
79 #include <dev/pci/pcivar.h>
80 #include <dev/pci/pcireg.h>
81 #include <dev/pci/pcidevs.h>
82 #endif
83
84 #include <dev/ic/cd1400reg.h>
85 #include <dev/ic/cyreg.h>
86
87
88 int cy_intr(void *);
89 int cyparam(struct tty *, struct termios *);
90 void cystart(struct tty *);
91 void cy_poll(void *);
92 int cy_modem_control(struct cy_port *, int, int);
93 void cy_enable_transmitter(struct cy_port *);
94 void cd1400_channel_cmd(struct cy_port *, int);
95 int cy_speed(speed_t, int *, int *, int);
96
97 struct cfdriver cy_cd = {
98 NULL, "cy", DV_TTY
99 };
100
101
102
103
104
105
106 int
107 cy_probe_common(bus_space_tag_t memt, bus_space_handle_t memh, int bustype)
108 {
109 int cy_chip, chip_offs;
110 u_char firmware_ver;
111 int nchips;
112
113
114 bus_space_write_1(memt, memh, CY16_RESET<<bustype, 0);
115 DELAY(500);
116 bus_space_write_1(memt, memh, CY_CLEAR_INTR<<bustype, 0);
117
118 #ifdef CY_DEBUG
119 printf("cy: card reset done\n");
120 #endif
121
122 nchips = 0;
123
124 for (cy_chip = 0, chip_offs = 0;
125 cy_chip < CY_MAX_CD1400s;
126 cy_chip++, chip_offs += (CY_CD1400_MEMSPACING << bustype)) {
127 int i;
128
129
130
131 if (cy_chip == 4)
132 chip_offs -= (CY32_ADDR_FIX << bustype);
133
134 #ifdef CY_DEBUG
135 printf("cy: probe chip %d offset 0x%lx ... ",
136 cy_chip, chip_offs);
137 #endif
138
139
140 DELAY(1000);
141 if (bus_space_read_1(memt, memh, chip_offs +
142 ((CD1400_CCR << 1) << bustype)) != 0) {
143 #ifdef CY_DEBUG
144 printf("not ready for command\n");
145 #endif
146 break;
147 }
148
149
150 bus_space_write_1(memt, memh, chip_offs +
151 ((CD1400_GFRCR << 1) << bustype), 0);
152
153
154
155
156
157
158
159 if (cy_chip == 4 &&
160 bus_space_read_1(memt, memh, chip_offs +
161 ((CD1400_GFRCR << 1) << bustype)) == 0)
162 break;
163
164
165 bus_space_write_1(memt, memh, chip_offs +
166 ((CD1400_CCR << 1) << bustype),
167 CD1400_CCR_CMDRESET | CD1400_CCR_FULLRESET);
168
169
170 for (i = 0; i < 200; i++) {
171 DELAY(50);
172 firmware_ver = bus_space_read_1(memt, memh, chip_offs +
173 ((CD1400_GFRCR << 1) << bustype));
174 if ((firmware_ver & 0xf0) == 0x40)
175 break;
176 }
177 #ifdef CY_DEBUG
178 printf("firmware version 0x%x\n", firmware_ver);
179 #endif
180
181 if ((firmware_ver & 0xf0) != 0x40)
182 break;
183
184
185 nchips++;
186 }
187
188 if (nchips == 0) {
189 #ifdef CY_DEBUG
190 printf("no CD1400s found\n");
191 #endif
192 return (0);
193 }
194
195 #ifdef CY_DEBUG
196 printf("found %d CD1400s\n", nchips);
197 #endif
198
199 return (nchips);
200 }
201
202 void
203 cy_attach(parent, self)
204 struct device *parent, *self;
205 {
206 int card, port, cy_chip, num_chips, cdu, chip_offs, cy_clock;
207 struct cy_softc *sc = (void *)self;
208
209 card = sc->sc_dev.dv_unit;
210 num_chips = sc->sc_nr_cd1400s;
211 if (num_chips == 0)
212 return;
213
214 timeout_set(&sc->sc_poll_to, cy_poll, sc);
215 bzero(sc->sc_ports, sizeof(sc->sc_ports));
216 sc->sc_nports = num_chips * CD1400_NO_OF_CHANNELS;
217
218 port = 0;
219 for (cy_chip = 0, chip_offs = 0;
220 cy_chip < num_chips;
221 cy_chip++, chip_offs += (CY_CD1400_MEMSPACING<<sc->sc_bustype)) {
222 if (cy_chip == 4)
223 chip_offs -= (CY32_ADDR_FIX<<sc->sc_bustype);
224
225 #ifdef CY_DEBUG
226 printf("attach CD1400 #%d offset 0x%x\n", cy_chip, chip_offs);
227 #endif
228 sc->sc_cd1400_offs[cy_chip] = chip_offs;
229
230
231
232 cd_write_reg_sc(sc, cy_chip, CD1400_GCR, 0);
233
234
235 if (cd_read_reg_sc(sc, cy_chip, CD1400_GFRCR) <= 0x46)
236 cy_clock = CY_CLOCK;
237 else
238 cy_clock = CY_CLOCK_60;
239
240
241 cd_write_reg_sc(sc, cy_chip, CD1400_PPR,
242 (cy_clock / CD1400_PPR_PRESCALER / 1000) + 1);
243
244 for (cdu = 0; cdu < CD1400_NO_OF_CHANNELS; cdu++) {
245 sc->sc_ports[port].cy_port_num = port;
246 sc->sc_ports[port].cy_memt = sc->sc_memt;
247 sc->sc_ports[port].cy_memh = sc->sc_memh;
248 sc->sc_ports[port].cy_chip_offs = chip_offs;
249 sc->sc_ports[port].cy_bustype = sc->sc_bustype;
250 sc->sc_ports[port].cy_clock = cy_clock;
251
252
253 port++;
254 }
255
256 }
257
258 printf(": %d ports\n", port);
259
260
261 bus_space_write_1(sc->sc_memt, sc->sc_memh,
262 CY_CLEAR_INTR<<sc->sc_bustype, 0);
263 }
264
265
266
267
268 int cyopen(dev_t, int, int, struct proc *);
269 int cyclose(dev_t, int, int, struct proc *);
270 int cyread(dev_t, struct uio *, int);
271 int cywrite(dev_t, struct uio *, int);
272 struct tty *cytty(dev_t);
273 int cyioctl(dev_t, u_long, caddr_t, int, struct proc *);
274 int cystop(struct tty *, int flag);
275
276 int
277 cyopen(dev, flag, mode, p)
278 dev_t dev;
279 int flag, mode;
280 struct proc *p;
281 {
282 int card = CY_CARD(dev);
283 int port = CY_PORT(dev);
284 struct cy_softc *sc;
285 struct cy_port *cy;
286 struct tty *tp;
287 int s, error;
288
289 if (card >= cy_cd.cd_ndevs ||
290 (sc = cy_cd.cd_devs[card]) == NULL) {
291 return (ENXIO);
292 }
293
294 #ifdef CY_DEBUG
295 printf("%s open port %d flag 0x%x mode 0x%x\n", sc->sc_dev.dv_xname,
296 port, flag, mode);
297 #endif
298
299 cy = &sc->sc_ports[port];
300
301 s = spltty();
302 if (cy->cy_tty == NULL) {
303 cy->cy_tty = ttymalloc();
304 }
305 splx(s);
306
307 tp = cy->cy_tty;
308 tp->t_oproc = cystart;
309 tp->t_param = cyparam;
310 tp->t_dev = dev;
311
312 if (!ISSET(tp->t_state, TS_ISOPEN)) {
313 SET(tp->t_state, TS_WOPEN);
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
331
332 if (cy->cy_ibuf == NULL) {
333 cy->cy_ibuf = malloc(IBUF_SIZE, M_DEVBUF, M_NOWAIT);
334 if (cy->cy_ibuf == NULL) {
335 printf("%s: (port %d) can't allocate input buffer\n",
336 sc->sc_dev.dv_xname, port);
337 splx(s);
338 return (ENOMEM);
339 }
340 cy->cy_ibuf_end = cy->cy_ibuf + IBUF_SIZE;
341 }
342
343
344 cy->cy_ibuf_rd_ptr = cy->cy_ibuf_wr_ptr = cy->cy_ibuf;
345
346
347 cd_write_reg(cy, CD1400_CAR, port & CD1400_CAR_CHAN);
348
349 cd1400_channel_cmd(cy, CD1400_CCR_CMDRESET);
350
351
352 cd_write_reg(cy, CD1400_LIVR, port << 3);
353
354 cy->cy_channel_control = 0;
355
356 if (!timeout_pending(&sc->sc_poll_to))
357 timeout_add(&sc->sc_poll_to, 1);
358
359
360 cyparam(tp, &tp->t_termios);
361
362 ttsetwater(tp);
363
364
365 cy_modem_control(cy, TIOCM_RTS, DMBIS);
366
367 cy->cy_carrier_stat = cd_read_reg(cy, CD1400_MSVR2);
368
369
370 cd_write_reg(cy, CD1400_SRER,
371 CD1400_SRER_MDMCH | CD1400_SRER_RXDATA);
372
373 if (CY_DIALOUT(dev) ||
374 ISSET(cy->cy_openflags, TIOCFLAG_SOFTCAR) ||
375 ISSET(tp->t_cflag, MDMBUF) ||
376 ISSET(cy->cy_carrier_stat, CD1400_MSVR2_CD))
377 SET(tp->t_state, TS_CARR_ON);
378 else
379 CLR(tp->t_state, TS_CARR_ON);
380 } else if (ISSET(tp->t_state, TS_XCLUDE) && p->p_ucred->cr_uid != 0) {
381 return (EBUSY);
382 } else {
383 s = spltty();
384 }
385
386
387 if (!ISSET(flag, O_NONBLOCK)) {
388 while (!ISSET(tp->t_cflag, CLOCAL) &&
389 !ISSET(tp->t_state, TS_CARR_ON)) {
390 SET(tp->t_state, TS_WOPEN);
391 error = ttysleep(tp, &tp->t_rawq, TTIPRI | PCATCH,
392 "cydcd", 0);
393 if (error != 0) {
394 splx(s);
395 CLR(tp->t_state, TS_WOPEN);
396 return (error);
397 }
398 }
399 }
400
401 splx(s);
402
403 return (*linesw[tp->t_line].l_open)(dev, tp);
404 }
405
406
407
408
409 int
410 cyclose(dev, flag, mode, p)
411 dev_t dev;
412 int flag, mode;
413 struct proc *p;
414 {
415 int card = CY_CARD(dev);
416 int port = CY_PORT(dev);
417 struct cy_softc *sc = cy_cd.cd_devs[card];
418 struct cy_port *cy = &sc->sc_ports[port];
419 struct tty *tp = cy->cy_tty;
420 int s;
421
422 #ifdef CY_DEBUG
423 printf("%s close port %d, flag 0x%x, mode 0x%x\n", sc->sc_dev.dv_xname,
424 port, flag, mode);
425 #endif
426
427 (*linesw[tp->t_line].l_close)(tp, flag);
428 s = spltty();
429
430 if (ISSET(tp->t_cflag, HUPCL) &&
431 !ISSET(cy->cy_openflags, TIOCFLAG_SOFTCAR)) {
432
433
434 cy_modem_control(cy, 0, DMSET);
435 }
436
437
438
439
440
441 CLR(tp->t_state, TS_BUSY | TS_FLUSH);
442
443 splx(s);
444 ttyclose(tp);
445
446 return (0);
447 }
448
449
450
451
452 int
453 cyread(dev, uio, flag)
454 dev_t dev;
455 struct uio *uio;
456 int flag;
457 {
458 int card = CY_CARD(dev);
459 int port = CY_PORT(dev);
460 struct cy_softc *sc = cy_cd.cd_devs[card];
461 struct cy_port *cy = &sc->sc_ports[port];
462 struct tty *tp = cy->cy_tty;
463
464 #ifdef CY_DEBUG
465 printf("%s read port %d uio 0x%x flag 0x%x\n", sc->sc_dev.dv_xname,
466 port, uio, flag);
467 #endif
468
469 return ((*linesw[tp->t_line].l_read)(tp, uio, flag));
470 }
471
472
473
474
475 int
476 cywrite(dev, uio, flag)
477 dev_t dev;
478 struct uio *uio;
479 int flag;
480 {
481 int card = CY_CARD(dev);
482 int port = CY_PORT(dev);
483 struct cy_softc *sc = cy_cd.cd_devs[card];
484 struct cy_port *cy = &sc->sc_ports[port];
485 struct tty *tp = cy->cy_tty;
486
487 #ifdef CY_DEBUG
488 printf("%s write port %d uio 0x%x flag 0x%x\n", sc->sc_dev.dv_xname,
489 port, uio, flag);
490 #endif
491
492 return ((*linesw[tp->t_line].l_write)(tp, uio, flag));
493 }
494
495
496
497
498 struct tty *
499 cytty(dev)
500 dev_t dev;
501 {
502 int card = CY_CARD(dev);
503 int port = CY_PORT(dev);
504 struct cy_softc *sc = cy_cd.cd_devs[card];
505 struct cy_port *cy = &sc->sc_ports[port];
506 struct tty *tp = cy->cy_tty;
507
508 return (tp);
509 }
510
511
512
513
514 int
515 cyioctl(dev, cmd, data, flag, p)
516 dev_t dev;
517 u_long cmd;
518 caddr_t data;
519 int flag;
520 struct proc *p;
521 {
522 int card = CY_CARD(dev);
523 int port = CY_PORT(dev);
524 struct cy_softc *sc = cy_cd.cd_devs[card];
525 struct cy_port *cy = &sc->sc_ports[port];
526 struct tty *tp = cy->cy_tty;
527 int error;
528
529 #ifdef CY_DEBUG
530 printf("%s port %d ioctl cmd 0x%x data 0x%x flag 0x%x\n",
531 sc->sc_dev.dv_xname, port, cmd, data, flag);
532 #endif
533
534 error = (*linesw[tp->t_line].l_ioctl)(tp, cmd, data, flag, p);
535 if (error >= 0)
536 return (error);
537
538 error = ttioctl(tp, cmd, data, flag, p);
539 if (error >= 0)
540 return (error);
541
542
543
544 switch (cmd) {
545 case TIOCSBRK:
546 SET(cy->cy_flags, CYF_START_BREAK);
547 cy_enable_transmitter(cy);
548 break;
549
550 case TIOCCBRK:
551 SET(cy->cy_flags, CYF_END_BREAK);
552 cy_enable_transmitter(cy);
553 break;
554
555 case TIOCSDTR:
556 cy_modem_control(cy, TIOCM_DTR, DMBIS);
557 break;
558
559 case TIOCCDTR:
560 cy_modem_control(cy, TIOCM_DTR, DMBIC);
561 break;
562
563 case TIOCMSET:
564 cy_modem_control(cy, *((int *)data), DMSET);
565 break;
566
567 case TIOCMBIS:
568 cy_modem_control(cy, *((int *)data), DMBIS);
569 break;
570
571 case TIOCMBIC:
572 cy_modem_control(cy, *((int *)data), DMBIC);
573 break;
574
575 case TIOCMGET:
576 *((int *)data) = cy_modem_control(cy, 0, DMGET);
577 break;
578
579 case TIOCGFLAGS:
580 *((int *)data) = cy->cy_openflags |
581 (CY_DIALOUT(dev) ? TIOCFLAG_SOFTCAR : 0);
582 break;
583
584 case TIOCSFLAGS:
585 error = suser(p, 0);
586 if (error != 0)
587 return (EPERM);
588
589 cy->cy_openflags = *((int *)data) &
590 (TIOCFLAG_SOFTCAR | TIOCFLAG_CLOCAL |
591 TIOCFLAG_CRTSCTS | TIOCFLAG_MDMBUF);
592 break;
593
594 default:
595 return (ENOTTY);
596 }
597
598 return (0);
599 }
600
601
602
603
604 void
605 cystart(tp)
606 struct tty *tp;
607 {
608 int card = CY_CARD(tp->t_dev);
609 int port = CY_PORT(tp->t_dev);
610 struct cy_softc *sc = cy_cd.cd_devs[card];
611 struct cy_port *cy = &sc->sc_ports[port];
612 int s;
613
614 #ifdef CY_DEBUG
615 printf("%s port %d start, tty 0x%x\n", sc->sc_dev.dv_xname, port, tp);
616 #endif
617
618 s = spltty();
619
620 #ifdef CY_DEBUG1
621 cy->cy_start_count++;
622 #endif
623
624 if (!ISSET(tp->t_state, TS_TTSTOP | TS_TIMEOUT | TS_BUSY)) {
625 if (tp->t_outq.c_cc <= tp->t_lowat) {
626 if (ISSET(tp->t_state, TS_ASLEEP)) {
627 CLR(tp->t_state, TS_ASLEEP);
628 wakeup(&tp->t_outq);
629 }
630
631 selwakeup(&tp->t_wsel);
632
633 if (tp->t_outq.c_cc == 0)
634 goto out;
635 }
636
637 SET(tp->t_state, TS_BUSY);
638 cy_enable_transmitter(cy);
639 }
640 out:
641
642 splx(s);
643 }
644
645
646
647
648 int
649 cystop(tp, flag)
650 struct tty *tp;
651 int flag;
652 {
653 int card = CY_CARD(tp->t_dev);
654 int port = CY_PORT(tp->t_dev);
655 struct cy_softc *sc = cy_cd.cd_devs[card];
656 struct cy_port *cy = &sc->sc_ports[port];
657 int s;
658
659 #ifdef CY_DEBUG
660 printf("%s port %d stop tty 0x%x flag 0x%x\n", sc->sc_dev.dv_xname,
661 port, tp, flag);
662 #endif
663
664 s = spltty();
665
666 if (ISSET(tp->t_state, TS_BUSY)) {
667 if (!ISSET(tp->t_state, TS_TTSTOP))
668 SET(tp->t_state, TS_FLUSH);
669
670
671
672
673
674 SET(cy->cy_flags, CYF_STOP);
675 }
676 splx(s);
677 return (0);
678 }
679
680
681
682
683
684 int
685 cyparam(tp, t)
686 struct tty *tp;
687 struct termios *t;
688 {
689 int card = CY_CARD(tp->t_dev);
690 int port = CY_PORT(tp->t_dev);
691 struct cy_softc *sc = cy_cd.cd_devs[card];
692 struct cy_port *cy = &sc->sc_ports[port];
693 int ibpr, obpr, i_clk_opt, o_clk_opt;
694 int s, opt;
695
696 #ifdef CY_DEBUG
697 printf("%s port %d param tty 0x%x termios 0x%x\n", sc->sc_dev.dv_xname,
698 port, tp, t);
699 printf("ispeed %d ospeed %d\n", t->c_ispeed, t->c_ospeed);
700 #endif
701
702 if (t->c_ospeed != 0 &&
703 cy_speed(t->c_ospeed, &o_clk_opt, &obpr, cy->cy_clock) < 0)
704 return (EINVAL);
705
706 if (t->c_ispeed != 0 &&
707 cy_speed(t->c_ispeed, &i_clk_opt, &ibpr, cy->cy_clock) < 0)
708 return (EINVAL);
709
710 s = spltty();
711
712
713 cy_modem_control(cy, TIOCM_DTR, (t->c_ospeed == 0 ? DMBIC : DMBIS));
714
715
716
717
718
719 if (t->c_ospeed != 0) {
720 cd_write_reg(cy, CD1400_TCOR, o_clk_opt);
721 cd_write_reg(cy, CD1400_TBPR, obpr);
722 }
723
724 if (t->c_ispeed != 0) {
725 cd_write_reg(cy, CD1400_RCOR, i_clk_opt);
726 cd_write_reg(cy, CD1400_RBPR, ibpr);
727 }
728
729 opt = CD1400_CCR_CMDCHANCTL | CD1400_CCR_XMTEN
730 | (ISSET(t->c_cflag, CREAD) ? CD1400_CCR_RCVEN : CD1400_CCR_RCVDIS);
731
732 if (opt != cy->cy_channel_control) {
733 cy->cy_channel_control = opt;
734 cd1400_channel_cmd(cy, opt);
735 }
736
737
738 opt = 0;
739 if (ISSET(t->c_cflag, PARENB)) {
740 if (ISSET(t->c_cflag, PARODD))
741 opt |= CD1400_COR1_PARODD;
742 opt |= CD1400_COR1_PARNORMAL;
743 }
744
745 if (!ISSET(t->c_iflag, INPCK))
746 opt |= CD1400_COR1_NOINPCK;
747
748 if (ISSET(t->c_cflag, CSTOPB))
749 opt |= CD1400_COR1_STOP2;
750
751 switch (t->c_cflag & CSIZE) {
752 case CS5:
753 opt |= CD1400_COR1_CS5;
754 break;
755
756 case CS6:
757 opt |= CD1400_COR1_CS6;
758 break;
759
760 case CS7:
761 opt |= CD1400_COR1_CS7;
762 break;
763
764 default:
765 opt |= CD1400_COR1_CS8;
766 break;
767 }
768
769 cd_write_reg(cy, CD1400_COR1, opt);
770
771 #ifdef CY_DEBUG
772 printf("cor1 = 0x%x...", opt);
773 #endif
774
775
776
777
778
779
780
781 cd_write_reg(cy, CD1400_COR2,
782 CD1400_COR2_ETC |
783 (ISSET(t->c_cflag, CRTSCTS) ? CD1400_COR2_CCTS_OFLOW : 0));
784
785 cd_write_reg(cy, CD1400_COR3, RX_FIFO_THRESHOLD);
786
787 cd1400_channel_cmd(cy,
788 CD1400_CCR_CMDCORCHG |
789 CD1400_CCR_COR1 | CD1400_CCR_COR2 | CD1400_CCR_COR3);
790
791 cd_write_reg(cy, CD1400_COR4, CD1400_COR4_PFO_EXCEPTION);
792 cd_write_reg(cy, CD1400_COR5, 0);
793
794
795
796
797
798
799
800
801 #ifdef CY_HW_RTS
802 cd_write_reg(cy, CD1400_MCOR1, CD1400_MCOR1_CDzd |
803 (ISSET(t->c_cflag, CRTSCTS) ? RX_DTR_THRESHOLD : 0));
804 #else
805 cd_write_reg(cy, CD1400_MCOR1, CD1400_MCOR1_CDzd);
806 #endif
807
808 cd_write_reg(cy, CD1400_MCOR2, CD1400_MCOR2_CDod);
809
810
811
812
813
814
815 cd_write_reg(cy, CD1400_RTPR, 2);
816
817
818
819
820
821
822 splx(s);
823 return (0);
824 }
825
826
827
828
829
830
831
832
833
834 int
835 cy_modem_control(cy, bits, howto)
836 struct cy_port *cy;
837 int bits;
838 int howto;
839 {
840 int s, msvr;
841
842 s = spltty();
843
844
845 cd_write_reg(cy, CD1400_CAR, cy->cy_port_num & CD1400_CAR_CHAN);
846
847
848 switch (howto) {
849 case DMGET:
850 bits = 0;
851 if (cy->cy_channel_control & CD1400_CCR_RCVEN)
852 bits |= TIOCM_LE;
853 msvr = cd_read_reg(cy, CD1400_MSVR2);
854 #ifdef CY_HW_RTS
855 if (cd_read_reg(cy, CD1400_MSVR1) & CD1400_MSVR1_RTS)
856 bits |= TIOCM_DTR;
857 if (msvr & CD1400_MSVR2_DTR)
858 bits |= TIOCM_RTS;
859 #else
860 if (cd_read_reg(cy, CD1400_MSVR1) & CD1400_MSVR1_RTS)
861 bits |= TIOCM_RTS;
862 if (msvr & CD1400_MSVR2_DTR)
863 bits |= TIOCM_DTR;
864 #endif
865 if (msvr & CD1400_MSVR2_CTS)
866 bits |= TIOCM_CTS;
867 if (msvr & CD1400_MSVR2_CD)
868 bits |= TIOCM_CD;
869 if (msvr & CD1400_MSVR2_DSR)
870
871 bits |= TIOCM_DSR;
872 if (msvr & CD1400_MSVR2_RI)
873
874 bits |= TIOCM_RI;
875 splx(s);
876 return (bits);
877
878 case DMSET:
879 #ifdef CY_HW_RTS
880 if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS))
881 cd_write_reg(cy, CD1400_MSVR2,
882 ((bits & TIOCM_RTS) ? CD1400_MSVR2_DTR : 0));
883 cd_write_reg(cy, CD1400_MSVR1,
884 ((bits & TIOCM_DTR) ? CD1400_MSVR1_RTS : 0));
885 #else
886 if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS))
887 cd_write_reg(cy, CD1400_MSVR1,
888 ((bits & TIOCM_RTS) ? CD1400_MSVR1_RTS : 0));
889 cd_write_reg(cy, CD1400_MSVR2,
890 ((bits & TIOCM_DTR) ? CD1400_MSVR2_DTR : 0));
891 #endif
892 break;
893
894 case DMBIS:
895 #ifdef CY_HW_RTS
896 if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS) &&
897 (bits & TIOCM_RTS) != 0)
898 cd_write_reg(cy, CD1400_MSVR2, CD1400_MSVR2_DTR);
899 if (bits & TIOCM_DTR)
900 cd_write_reg(cy, CD1400_MSVR1, CD1400_MSVR1_RTS);
901 #else
902 if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS) &&
903 (bits & TIOCM_RTS) != 0)
904 cd_write_reg(cy, CD1400_MSVR1, CD1400_MSVR1_RTS);
905 if (bits & TIOCM_DTR)
906 cd_write_reg(cy, CD1400_MSVR2, CD1400_MSVR2_DTR);
907 #endif
908 break;
909
910 case DMBIC:
911 #ifdef CY_HW_RTS
912 if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS) &&
913 (bits & TIOCM_RTS))
914 cd_write_reg(cy, CD1400_MSVR2, 0);
915 if (bits & TIOCM_DTR)
916 cd_write_reg(cy, CD1400_MSVR1, 0);
917 #else
918 if (!ISSET(cy->cy_tty->t_cflag, CRTSCTS) &&
919 (bits & TIOCM_RTS))
920 cd_write_reg(cy, CD1400_MSVR1, 0);
921 if (bits & TIOCM_DTR)
922 cd_write_reg(cy, CD1400_MSVR2, 0);
923 #endif
924 break;
925 }
926 splx(s);
927 return (0);
928 }
929
930
931
932
933
934 void
935 cy_poll(void *arg)
936 {
937 int port;
938 struct cy_softc *sc = arg;
939 struct cy_port *cy;
940 struct tty *tp;
941 static int counter = 0;
942 #ifdef CY_DEBUG1
943 int did_something;
944 #endif
945
946 int s;
947
948 s = spltty();
949
950 if (sc->sc_events == 0 && ++counter < 200) {
951 splx(s);
952 goto out;
953 }
954
955 sc->sc_events = 0;
956 splx(s);
957
958 #ifdef CY_DEBUG1
959 sc->sc_poll_count1++;
960 did_something = 0;
961 #endif
962
963 for (port = 0; port < sc->sc_nports; port++) {
964 cy = &sc->sc_ports[port];
965 if ((tp = cy->cy_tty) == NULL || cy->cy_ibuf == NULL ||
966 !ISSET(tp->t_state, TS_ISOPEN | TS_WOPEN))
967 continue;
968
969
970
971
972 while (cy->cy_ibuf_rd_ptr != cy->cy_ibuf_wr_ptr) {
973 u_char line_stat;
974 int chr;
975
976 line_stat = cy->cy_ibuf_rd_ptr[0];
977 chr = cy->cy_ibuf_rd_ptr[1];
978
979 if (line_stat &
980 (CD1400_RDSR_BREAK|CD1400_RDSR_FE))
981 chr |= TTY_FE;
982 if (line_stat & CD1400_RDSR_PE)
983 chr |= TTY_PE;
984
985
986
987
988
989
990 #ifdef CY_DEBUG
991 printf("%s port %d ttyinput 0x%x\n",
992 sc->sc_dev.dv_xname, port, chr);
993 #endif
994
995 (*linesw[tp->t_line].l_rint)(chr, tp);
996
997 s = spltty();
998 if ((cy->cy_ibuf_rd_ptr += 2) ==
999 cy->cy_ibuf_end)
1000 cy->cy_ibuf_rd_ptr = cy->cy_ibuf;
1001 splx(s);
1002
1003 #ifdef CY_DEBUG1
1004 did_something = 1;
1005 #endif
1006 }
1007
1008 #ifndef CY_HW_RTS
1009
1010
1011
1012
1013
1014 if (ISSET(tp->t_cflag, CRTSCTS)) {
1015
1016
1017 cd_write_reg(cy, CD1400_CAR,
1018 port & CD1400_CAR_CHAN);
1019
1020 if ((cd_read_reg(cy,
1021 CD1400_MSVR1) & CD1400_MSVR1_RTS) == 0) {
1022 cd_write_reg(cy, CD1400_MSVR1,
1023 CD1400_MSVR1_RTS);
1024 #ifdef CY_DEBUG1
1025 did_something = 1;
1026 #endif
1027 }
1028 }
1029 #endif
1030
1031
1032
1033
1034 s = spltty();
1035 if (ISSET(cy->cy_flags, CYF_CARRIER_CHANGED)) {
1036 int carrier;
1037
1038 CLR(cy->cy_flags, CYF_CARRIER_CHANGED);
1039 splx(s);
1040
1041 carrier = ((cy->cy_carrier_stat &
1042 CD1400_MSVR2_CD) != 0);
1043
1044 #ifdef CY_DEBUG
1045 printf("%s: cy_poll: carrier change "
1046 "(port %d, carrier %d)\n",
1047 sc->sc_dev.dv_xname, port, carrier);
1048 #endif
1049 if (CY_DIALIN(tp->t_dev) &&
1050 !(*linesw[tp->t_line].l_modem)(tp, carrier))
1051 cy_modem_control(cy, TIOCM_DTR, DMBIC);
1052
1053 #ifdef CY_DEBUG1
1054 did_something = 1;
1055 #endif
1056 } else {
1057 splx(s);
1058 }
1059
1060 s = spltty();
1061 if (ISSET(cy->cy_flags, CYF_START)) {
1062 CLR(cy->cy_flags, CYF_START);
1063 splx(s);
1064
1065 (*linesw[tp->t_line].l_start)(tp);
1066
1067 #ifdef CY_DEBUG1
1068 did_something = 1;
1069 #endif
1070 } else {
1071 splx(s);
1072 }
1073
1074
1075 if (cy->cy_fifo_overruns) {
1076 cy->cy_fifo_overruns = 0;
1077
1078
1079 log(LOG_WARNING, "%s: port %d fifo overrun\n",
1080 sc->sc_dev.dv_xname, port);
1081 }
1082 if (cy->cy_ibuf_overruns) {
1083 cy->cy_ibuf_overruns = 0;
1084 log(LOG_WARNING, "%s: port %d ibuf overrun\n",
1085 sc->sc_dev.dv_xname, port);
1086 }
1087 }
1088 #ifdef CY_DEBUG1
1089 if (did_something && counter >= 200)
1090 sc->sc_poll_count2++;
1091 #endif
1092
1093 counter = 0;
1094
1095 out:
1096 timeout_add(&sc->sc_poll_to, 1);
1097 }
1098
1099
1100
1101
1102 int
1103 cy_intr(arg)
1104 void *arg;
1105 {
1106 struct cy_softc *sc = arg;
1107 struct cy_port *cy;
1108 int cy_chip, stat;
1109 int int_serviced = -1;
1110
1111
1112
1113
1114
1115 for (cy_chip = 0; cy_chip < sc->sc_nr_cd1400s; cy_chip++) {
1116
1117 stat = cd_read_reg_sc(sc, cy_chip, CD1400_SVRR);
1118 if (stat == 0)
1119 continue;
1120
1121 if (ISSET(stat, CD1400_SVRR_RXRDY)) {
1122 u_char save_car, save_rir, serv_type;
1123 u_char line_stat, recv_data, n_chars;
1124 u_char *buf_p;
1125
1126 save_rir = cd_read_reg_sc(sc, cy_chip, CD1400_RIR);
1127 save_car = cd_read_reg_sc(sc, cy_chip, CD1400_CAR);
1128
1129 cd_write_reg_sc(sc, cy_chip, CD1400_CAR, save_rir);
1130
1131 serv_type = cd_read_reg_sc(sc, cy_chip, CD1400_RIVR);
1132 cy = &sc->sc_ports[serv_type >> 3];
1133
1134 #ifdef CY_DEBUG1
1135 cy->cy_rx_int_count++;
1136 #endif
1137
1138 buf_p = cy->cy_ibuf_wr_ptr;
1139
1140 if (ISSET(serv_type, CD1400_RIVR_EXCEPTION)) {
1141 line_stat = cd_read_reg(cy, CD1400_RDSR);
1142 recv_data = cd_read_reg(cy, CD1400_RDSR);
1143
1144 if (cy->cy_tty == NULL ||
1145 !ISSET(cy->cy_tty->t_state, TS_ISOPEN))
1146 goto end_rx_serv;
1147
1148 #ifdef CY_DEBUG
1149 printf("%s port %d recv exception, "
1150 "line_stat 0x%x, char 0x%x\n",
1151 sc->sc_dev.dv_xname, cy->cy_port_num,
1152 line_stat, recv_data);
1153 #endif
1154 if (ISSET(line_stat, CD1400_RDSR_OE))
1155 cy->cy_fifo_overruns++;
1156
1157 *buf_p++ = line_stat;
1158 *buf_p++ = recv_data;
1159 if (buf_p == cy->cy_ibuf_end)
1160 buf_p = cy->cy_ibuf;
1161
1162 if (buf_p == cy->cy_ibuf_rd_ptr) {
1163 if (buf_p == cy->cy_ibuf)
1164 buf_p = cy->cy_ibuf_end;
1165 buf_p -= 2;
1166 cy->cy_ibuf_overruns++;
1167 }
1168 sc->sc_events = 1;
1169 } else {
1170 n_chars = cd_read_reg(cy, CD1400_RDCR);
1171
1172
1173 if (cy->cy_tty == NULL ||
1174 !ISSET(cy->cy_tty->t_state, TS_ISOPEN)) {
1175 while (n_chars--)
1176 cd_read_reg(cy, CD1400_RDSR);
1177 goto end_rx_serv;
1178 }
1179
1180 #ifdef CY_DEBUG
1181 printf("%s port %d receive ok %d chars\n",
1182 sc->sc_dev.dv_xname, cy->cy_port_num,
1183 n_chars);
1184 #endif
1185 while (n_chars--) {
1186 *buf_p++ = 0;
1187 *buf_p++ = cd_read_reg(cy,
1188 CD1400_RDSR);
1189 if (buf_p == cy->cy_ibuf_end)
1190 buf_p = cy->cy_ibuf;
1191 if (buf_p == cy->cy_ibuf_rd_ptr) {
1192 if (buf_p == cy->cy_ibuf)
1193 buf_p = cy->cy_ibuf_end;
1194 buf_p -= 2;
1195 cy->cy_ibuf_overruns++;
1196 break;
1197 }
1198 }
1199 sc->sc_events = 1;
1200 }
1201
1202 cy->cy_ibuf_wr_ptr = buf_p;
1203
1204 #ifndef CY_HW_RTS
1205
1206 if (ISSET(cy->cy_tty->t_cflag, CRTSCTS)) {
1207 int bf;
1208
1209 bf = buf_p - cy->cy_ibuf_rd_ptr;
1210 if (bf < 0)
1211 bf += IBUF_SIZE;
1212
1213 if (bf > (IBUF_SIZE/2))
1214 cd_write_reg(cy, CD1400_MSVR1, 0);
1215 }
1216 #endif
1217
1218 end_rx_serv:
1219
1220 cd_write_reg(cy, CD1400_RIR, save_rir & 0x3f);
1221 cd_write_reg(cy, CD1400_CAR, save_car);
1222 int_serviced = 1;
1223 }
1224
1225 if (ISSET(stat, CD1400_SVRR_MDMCH)) {
1226 u_char save_car, save_mir, serv_type, modem_stat;
1227
1228 save_mir = cd_read_reg_sc(sc, cy_chip, CD1400_MIR);
1229 save_car = cd_read_reg_sc(sc, cy_chip, CD1400_CAR);
1230
1231 cd_write_reg_sc(sc, cy_chip, CD1400_CAR, save_mir);
1232
1233 serv_type = cd_read_reg_sc(sc, cy_chip, CD1400_MIVR);
1234 cy = &sc->sc_ports[serv_type >> 3];
1235
1236 #ifdef CY_DEBUG1
1237 cy->cy_modem_int_count++;
1238 #endif
1239
1240 modem_stat = cd_read_reg(cy, CD1400_MSVR2);
1241
1242 #ifdef CY_DEBUG
1243 printf("%s port %d modem line change, new stat 0x%x\n",
1244 sc->sc_dev.dv_xname, cy->cy_port_num, modem_stat);
1245 #endif
1246 if (ISSET((cy->cy_carrier_stat ^ modem_stat),
1247 CD1400_MSVR2_CD)) {
1248 SET(cy->cy_flags, CYF_CARRIER_CHANGED);
1249 sc->sc_events = 1;
1250 }
1251
1252 cy->cy_carrier_stat = modem_stat;
1253
1254
1255 cd_write_reg(cy, CD1400_MIR, save_mir & 0x3f);
1256 cd_write_reg(cy, CD1400_CAR, save_car);
1257 int_serviced = 1;
1258 }
1259
1260 if (ISSET(stat, CD1400_SVRR_TXRDY)) {
1261 u_char save_car, save_tir, serv_type, count, ch;
1262 struct tty *tp;
1263
1264 save_tir = cd_read_reg_sc(sc, cy_chip, CD1400_TIR);
1265 save_car = cd_read_reg_sc(sc, cy_chip, CD1400_CAR);
1266
1267 cd_write_reg_sc(sc, cy_chip, CD1400_CAR, save_tir);
1268
1269 serv_type = cd_read_reg_sc(sc, cy_chip, CD1400_TIVR);
1270 cy = &sc->sc_ports[serv_type >> 3];
1271
1272 #ifdef CY_DEBUG1
1273 cy->cy_tx_int_count++;
1274 #endif
1275 #ifdef CY_DEBUG
1276 printf("%s port %d tx service\n", sc->sc_dev.dv_xname,
1277 cy->cy_port_num);
1278 #endif
1279
1280
1281 tp = cy->cy_tty;
1282 if (tp == NULL || ISSET(cy->cy_flags, CYF_STOP))
1283 goto txdone;
1284
1285 count = 0;
1286 if (ISSET(cy->cy_flags, CYF_SEND_NUL)) {
1287 cd_write_reg(cy, CD1400_TDR, 0);
1288 cd_write_reg(cy, CD1400_TDR, 0);
1289 count += 2;
1290 CLR(cy->cy_flags, CYF_SEND_NUL);
1291 }
1292
1293 if (tp->t_outq.c_cc > 0) {
1294 SET(tp->t_state, TS_BUSY);
1295 while (tp->t_outq.c_cc > 0 &&
1296 count < CD1400_TX_FIFO_SIZE) {
1297 ch = getc(&tp->t_outq);
1298
1299
1300
1301 if (ch == 0) {
1302 if (count >=
1303 CD1400_TX_FIFO_SIZE-2) {
1304 SET(cy->cy_flags,
1305 CYF_SEND_NUL);
1306 break;
1307 }
1308
1309 cd_write_reg(cy, CD1400_TDR, ch);
1310 count++;
1311 }
1312
1313 cd_write_reg(cy, CD1400_TDR, ch);
1314 count++;
1315 }
1316 } else {
1317
1318
1319
1320
1321 if (ISSET(cy->cy_flags, CYF_START_BREAK)) {
1322 cd_write_reg(cy, CD1400_TDR, 0);
1323 cd_write_reg(cy, CD1400_TDR, 0x81);
1324 CLR(cy->cy_flags, CYF_START_BREAK);
1325 }
1326 if (ISSET(cy->cy_flags, CYF_END_BREAK)) {
1327 cd_write_reg(cy, CD1400_TDR, 0);
1328 cd_write_reg(cy, CD1400_TDR, 0x83);
1329 CLR(cy->cy_flags, CYF_END_BREAK);
1330 }
1331 }
1332
1333 if (tp->t_outq.c_cc == 0) {
1334 txdone:
1335
1336
1337
1338
1339 cd_write_reg(cy, CD1400_SRER,
1340 cd_read_reg(cy, CD1400_SRER)
1341 & ~CD1400_SRER_TXRDY);
1342 CLR(cy->cy_flags, CYF_STOP);
1343 CLR(tp->t_state, TS_BUSY);
1344 }
1345
1346 if (tp->t_outq.c_cc <= tp->t_lowat) {
1347 SET(cy->cy_flags, CYF_START);
1348 sc->sc_events = 1;
1349 }
1350
1351
1352 cd_write_reg(cy, CD1400_TIR, save_tir & 0x3f);
1353 cd_write_reg(cy, CD1400_CAR, save_car);
1354 int_serviced = 1;
1355 }
1356 }
1357
1358
1359 bus_space_write_1(sc->sc_memt, sc->sc_memh,
1360 CY_CLEAR_INTR<<sc->sc_bustype, 0);
1361 return (int_serviced);
1362 }
1363
1364
1365
1366
1367 void
1368 cy_enable_transmitter(cy)
1369 struct cy_port *cy;
1370 {
1371 int s;
1372 s = spltty();
1373 cd_write_reg(cy, CD1400_CAR, cy->cy_port_num & CD1400_CAR_CHAN);
1374 cd_write_reg(cy, CD1400_SRER, cd_read_reg(cy, CD1400_SRER)
1375 | CD1400_SRER_TXRDY);
1376 splx(s);
1377 }
1378
1379
1380
1381
1382 void
1383 cd1400_channel_cmd(cy, cmd)
1384 struct cy_port *cy;
1385 int cmd;
1386 {
1387 u_int waitcnt = 5 * 8 * 1024;
1388
1389 #ifdef CY_DEBUG
1390 printf("c1400_channel_cmd cy 0x%x command 0x%x\n", cy, cmd);
1391 #endif
1392
1393
1394 while (cd_read_reg(cy, CD1400_CCR) != 0 && waitcnt-- > 0)
1395 ;
1396
1397 if (waitcnt == 0)
1398 log(LOG_ERR, "cy: channel command timeout\n");
1399
1400 cd_write_reg(cy, CD1400_CCR, cmd);
1401 }
1402
1403
1404
1405
1406
1407
1408
1409
1410
1411 int
1412 cy_speed(speed_t speed, int *cor, int *bpr, int cy_clock)
1413 {
1414 int c, co, br;
1415
1416 if (speed < 50 || speed > 150000)
1417 return (-1);
1418
1419 for (c = 0, co = 8; co <= 2048; co <<= 2, c++) {
1420 br = (cy_clock + (co * speed) / 2) / (co * speed);
1421 if (br < 0x100) {
1422 *bpr = br;
1423 *cor = c;
1424 return (0);
1425 }
1426 }
1427
1428 return (-1);
1429 }
1430
1431 #endif