sab.c revision 1.13 1 1.12 martin /* $NetBSD: sab.c,v 1.13 2003/06/29 22:29:00 fvdl Exp $ */
2 1.1 petrov /* $OpenBSD: sab.c,v 1.7 2002/04/08 17:49:42 jason Exp $ */
3 1.1 petrov
4 1.1 petrov /*
5 1.1 petrov * Copyright (c) 2001 Jason L. Wright (jason (at) thought.net)
6 1.1 petrov * All rights reserved.
7 1.1 petrov *
8 1.1 petrov * Redistribution and use in source and binary forms, with or without
9 1.1 petrov * modification, are permitted provided that the following conditions
10 1.1 petrov * are met:
11 1.1 petrov * 1. Redistributions of source code must retain the above copyright
12 1.1 petrov * notice, this list of conditions and the following disclaimer.
13 1.1 petrov * 2. Redistributions in binary form must reproduce the above copyright
14 1.1 petrov * notice, this list of conditions and the following disclaimer in the
15 1.1 petrov * documentation and/or other materials provided with the distribution.
16 1.1 petrov * 3. All advertising materials mentioning features or use of this software
17 1.1 petrov * must display the following acknowledgement:
18 1.1 petrov * This product includes software developed by Jason L. Wright
19 1.1 petrov * 4. The name of the author may not be used to endorse or promote products
20 1.1 petrov * derived from this software without specific prior written permission.
21 1.1 petrov *
22 1.1 petrov * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
23 1.1 petrov * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
24 1.1 petrov * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
25 1.1 petrov * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
26 1.1 petrov * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
27 1.1 petrov * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
28 1.1 petrov * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29 1.1 petrov * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
30 1.1 petrov * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
31 1.1 petrov * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
32 1.1 petrov * POSSIBILITY OF SUCH DAMAGE.
33 1.1 petrov *
34 1.1 petrov * Effort sponsored in part by the Defense Advanced Research Projects
35 1.1 petrov * Agency (DARPA) and Air Force Research Laboratory, Air Force
36 1.1 petrov * Materiel Command, USAF, under agreement number F30602-01-2-0537.
37 1.1 petrov *
38 1.1 petrov */
39 1.1 petrov
40 1.1 petrov /*
41 1.1 petrov * SAB82532 Dual UART driver
42 1.1 petrov */
43 1.1 petrov
44 1.1 petrov #include <sys/types.h>
45 1.1 petrov #include <sys/param.h>
46 1.1 petrov #include <sys/systm.h>
47 1.1 petrov #include <sys/device.h>
48 1.1 petrov #include <sys/conf.h>
49 1.1 petrov #include <sys/file.h>
50 1.1 petrov #include <sys/ioctl.h>
51 1.1 petrov #include <sys/kernel.h>
52 1.1 petrov #include <sys/proc.h>
53 1.1 petrov #include <sys/tty.h>
54 1.1 petrov #include <sys/syslog.h>
55 1.1 petrov
56 1.1 petrov #include <machine/autoconf.h>
57 1.1 petrov #include <machine/openfirm.h>
58 1.1 petrov
59 1.1 petrov #include <dev/cons.h>
60 1.1 petrov
61 1.1 petrov #include <dev/ebus/ebusreg.h>
62 1.1 petrov #include <dev/ebus/ebusvar.h>
63 1.1 petrov #include <sparc64/dev/sab82532reg.h>
64 1.1 petrov
65 1.1 petrov #define SABUNIT(x) (minor(x) & 0x7ffff)
66 1.1 petrov #define SABDIALOUT(x) (minor(x) & 0x80000)
67 1.1 petrov
68 1.1 petrov #define SABTTY_RBUF_SIZE 1024 /* must be divisible by 2 */
69 1.1 petrov
70 1.1 petrov struct sab_softc {
71 1.1 petrov struct device sc_dv;
72 1.1 petrov struct intrhand * sc_ih;
73 1.1 petrov bus_space_tag_t sc_bt;
74 1.1 petrov bus_space_handle_t sc_bh;
75 1.1 petrov struct sabtty_softc * sc_child[SAB_NCHAN];
76 1.1 petrov u_int sc_nchild;
77 1.1 petrov void * sc_softintr;
78 1.1 petrov int sc_node;
79 1.1 petrov };
80 1.1 petrov
81 1.1 petrov struct sabtty_attach_args {
82 1.1 petrov u_int sbt_portno;
83 1.1 petrov };
84 1.1 petrov
85 1.1 petrov struct sabtty_softc {
86 1.1 petrov struct device sc_dv;
87 1.1 petrov struct sab_softc * sc_parent;
88 1.1 petrov bus_space_tag_t sc_bt;
89 1.1 petrov bus_space_handle_t sc_bh;
90 1.1 petrov struct tty * sc_tty;
91 1.1 petrov u_int sc_portno;
92 1.1 petrov u_int8_t sc_pvr_dtr, sc_pvr_dsr;
93 1.1 petrov u_int8_t sc_imr0, sc_imr1;
94 1.1 petrov int sc_openflags;
95 1.1 petrov u_char * sc_txp;
96 1.1 petrov int sc_txc;
97 1.1 petrov int sc_flags;
98 1.1 petrov #define SABTTYF_STOP 0x01
99 1.1 petrov #define SABTTYF_DONE 0x02
100 1.1 petrov #define SABTTYF_RINGOVERFLOW 0x04
101 1.1 petrov #define SABTTYF_CDCHG 0x08
102 1.1 petrov #define SABTTYF_CONS_IN 0x10
103 1.1 petrov #define SABTTYF_CONS_OUT 0x20
104 1.1 petrov #define SABTTYF_TXDRAIN 0x40
105 1.1 petrov #define SABTTYF_DONTDDB 0x80
106 1.1 petrov u_int8_t sc_rbuf[SABTTY_RBUF_SIZE];
107 1.1 petrov u_int8_t *sc_rend, *sc_rput, *sc_rget;
108 1.1 petrov u_int8_t sc_polling, sc_pollrfc;
109 1.1 petrov };
110 1.1 petrov
111 1.1 petrov struct sabtty_softc *sabtty_cons_input;
112 1.1 petrov struct sabtty_softc *sabtty_cons_output;
113 1.1 petrov
114 1.1 petrov #define SAB_READ(sc,r) \
115 1.1 petrov bus_space_read_1((sc)->sc_bt, (sc)->sc_bh, (r))
116 1.1 petrov #define SAB_WRITE(sc,r,v) \
117 1.1 petrov bus_space_write_1((sc)->sc_bt, (sc)->sc_bh, (r), (v))
118 1.11 petrov #define SAB_WRITE_BLOCK(sc,r,p,c) \
119 1.11 petrov bus_space_write_region_1((sc)->sc_bt, (sc)->sc_bh, (r), (p), (c))
120 1.1 petrov
121 1.1 petrov int sab_match(struct device *, struct cfdata *, void *);
122 1.1 petrov void sab_attach(struct device *, struct device *, void *);
123 1.1 petrov int sab_print(void *, const char *);
124 1.1 petrov int sab_intr(void *);
125 1.1 petrov
126 1.1 petrov void sab_softintr(void *);
127 1.1 petrov void sab_cnputc(dev_t, int);
128 1.1 petrov int sab_cngetc(dev_t);
129 1.1 petrov void sab_cnpollc(dev_t, int);
130 1.1 petrov
131 1.1 petrov int sabtty_match(struct device *, struct cfdata *, void *);
132 1.1 petrov void sabtty_attach(struct device *, struct device *, void *);
133 1.1 petrov void sabtty_start(struct tty *);
134 1.1 petrov int sabtty_param(struct tty *, struct termios *);
135 1.1 petrov int sabtty_intr(struct sabtty_softc *, int *);
136 1.1 petrov void sabtty_softintr(struct sabtty_softc *);
137 1.1 petrov int sabtty_mdmctrl(struct sabtty_softc *, int, int);
138 1.1 petrov void sabtty_cec_wait(struct sabtty_softc *);
139 1.1 petrov void sabtty_tec_wait(struct sabtty_softc *);
140 1.1 petrov void sabtty_reset(struct sabtty_softc *);
141 1.1 petrov void sabtty_flush(struct sabtty_softc *);
142 1.1 petrov int sabtty_speed(int);
143 1.1 petrov void sabtty_console_flags(struct sabtty_softc *);
144 1.1 petrov void sabtty_cnpollc(struct sabtty_softc *, int);
145 1.1 petrov void sabtty_shutdown(void *);
146 1.1 petrov int sabttyparam(struct sabtty_softc *, struct tty *, struct termios *);
147 1.1 petrov
148 1.1 petrov void sabtty_cnputc(struct sabtty_softc *, int);
149 1.1 petrov int sabtty_cngetc(struct sabtty_softc *);
150 1.1 petrov void sabtty_abort(struct sabtty_softc *);
151 1.1 petrov
152 1.5 thorpej CFATTACH_DECL(sab, sizeof(struct sab_softc),
153 1.6 thorpej sab_match, sab_attach, NULL, NULL);
154 1.1 petrov
155 1.1 petrov extern struct cfdriver sab_cd;
156 1.1 petrov
157 1.5 thorpej CFATTACH_DECL(sabtty, sizeof(struct sabtty_softc),
158 1.6 thorpej sabtty_match, sabtty_attach, NULL, NULL);
159 1.1 petrov
160 1.1 petrov extern struct cfdriver sabtty_cd;
161 1.2 gehenna
162 1.2 gehenna dev_type_open(sabopen);
163 1.2 gehenna dev_type_close(sabclose);
164 1.2 gehenna dev_type_read(sabread);
165 1.2 gehenna dev_type_write(sabwrite);
166 1.2 gehenna dev_type_ioctl(sabioctl);
167 1.2 gehenna dev_type_stop(sabstop);
168 1.2 gehenna dev_type_tty(sabtty);
169 1.2 gehenna dev_type_poll(sabpoll);
170 1.2 gehenna
171 1.2 gehenna const struct cdevsw sabtty_cdevsw = {
172 1.2 gehenna sabopen, sabclose, sabread, sabwrite, sabioctl,
173 1.7 jdolecek sabstop, sabtty, sabpoll, nommap, ttykqfilter, D_TTY
174 1.2 gehenna };
175 1.1 petrov
176 1.1 petrov struct sabtty_rate {
177 1.1 petrov int baud;
178 1.1 petrov int n, m;
179 1.1 petrov };
180 1.1 petrov
181 1.1 petrov struct sabtty_rate sabtty_baudtable[] = {
182 1.1 petrov { 50, 35, 10 },
183 1.1 petrov { 75, 47, 9 },
184 1.1 petrov { 110, 32, 9 },
185 1.1 petrov { 134, 53, 8 },
186 1.1 petrov { 150, 47, 8 },
187 1.1 petrov { 200, 35, 8 },
188 1.1 petrov { 300, 47, 7 },
189 1.1 petrov { 600, 47, 6 },
190 1.1 petrov { 1200, 47, 5 },
191 1.1 petrov { 1800, 31, 5 },
192 1.1 petrov { 2400, 47, 4 },
193 1.1 petrov { 4800, 47, 3 },
194 1.1 petrov { 9600, 47, 2 },
195 1.1 petrov { 19200, 47, 1 },
196 1.1 petrov { 38400, 23, 1 },
197 1.1 petrov { 57600, 15, 1 },
198 1.1 petrov { 115200, 7, 1 },
199 1.1 petrov { 230400, 3, 1 },
200 1.1 petrov { 460800, 1, 1 },
201 1.1 petrov { 76800, 11, 1 },
202 1.1 petrov { 153600, 5, 1 },
203 1.1 petrov { 307200, 3, 1 },
204 1.1 petrov { 614400, 3, 0 },
205 1.1 petrov { 921600, 0, 1 },
206 1.1 petrov };
207 1.1 petrov
208 1.1 petrov int
209 1.1 petrov sab_match(parent, match, aux)
210 1.1 petrov struct device *parent;
211 1.1 petrov struct cfdata *match;
212 1.1 petrov void *aux;
213 1.1 petrov {
214 1.1 petrov struct ebus_attach_args *ea = aux;
215 1.1 petrov char *compat;
216 1.1 petrov
217 1.1 petrov if (strcmp(ea->ea_name, "se") == 0)
218 1.1 petrov return (1);
219 1.1 petrov
220 1.1 petrov compat = PROM_getpropstring(ea->ea_node, "compatible");
221 1.1 petrov if (compat != NULL && !strcmp(compat, "sab82532"))
222 1.1 petrov return (1);
223 1.1 petrov
224 1.1 petrov return (0);
225 1.1 petrov }
226 1.1 petrov
227 1.1 petrov void
228 1.1 petrov sab_attach(parent, self, aux)
229 1.1 petrov struct device *parent;
230 1.1 petrov struct device *self;
231 1.1 petrov void *aux;
232 1.1 petrov {
233 1.1 petrov struct sab_softc *sc = (struct sab_softc *)self;
234 1.1 petrov struct ebus_attach_args *ea = aux;
235 1.1 petrov u_int8_t r;
236 1.1 petrov u_int i;
237 1.1 petrov
238 1.1 petrov sc->sc_bt = ea->ea_bustag;
239 1.1 petrov sc->sc_node = ea->ea_node;
240 1.1 petrov
241 1.1 petrov /* Use prom mapping, if available. */
242 1.1 petrov if (ea->ea_nvaddr)
243 1.1 petrov sparc_promaddr_to_handle(sc->sc_bt, ea->ea_vaddr[0], &sc->sc_bh);
244 1.1 petrov else if (bus_space_map(sc->sc_bt, EBUS_ADDR_FROM_REG(&ea->ea_reg[0]),
245 1.1 petrov ea->ea_reg[0].size, 0, &sc->sc_bh) != 0) {
246 1.1 petrov printf(": can't map register space\n");
247 1.1 petrov return;
248 1.1 petrov }
249 1.1 petrov
250 1.1 petrov sc->sc_ih = bus_intr_establish(ea->ea_bustag, ea->ea_intr[0],
251 1.8 pk IPL_TTY, sab_intr, sc);
252 1.1 petrov if (sc->sc_ih == NULL) {
253 1.1 petrov printf(": can't map interrupt\n");
254 1.1 petrov return;
255 1.1 petrov }
256 1.1 petrov
257 1.1 petrov sc->sc_softintr = softintr_establish(IPL_TTY, sab_softintr, sc);
258 1.1 petrov if (sc->sc_softintr == NULL) {
259 1.1 petrov printf(": can't get soft intr\n");
260 1.1 petrov return;
261 1.1 petrov }
262 1.1 petrov
263 1.1 petrov printf(": rev ");
264 1.1 petrov r = SAB_READ(sc, SAB_VSTR) & SAB_VSTR_VMASK;
265 1.1 petrov switch (r) {
266 1.1 petrov case SAB_VSTR_V_1:
267 1.1 petrov printf("1");
268 1.1 petrov break;
269 1.1 petrov case SAB_VSTR_V_2:
270 1.1 petrov printf("2");
271 1.1 petrov break;
272 1.1 petrov case SAB_VSTR_V_32:
273 1.1 petrov printf("3.2");
274 1.1 petrov break;
275 1.1 petrov default:
276 1.1 petrov printf("unknown(0x%x)", r);
277 1.1 petrov break;
278 1.1 petrov }
279 1.1 petrov printf("\n");
280 1.1 petrov
281 1.11 petrov /* Let current output drain */
282 1.11 petrov DELAY(100000);
283 1.11 petrov
284 1.1 petrov /* Set all pins, except DTR pins to be inputs */
285 1.1 petrov SAB_WRITE(sc, SAB_PCR, ~(SAB_PVR_DTR_A | SAB_PVR_DTR_B));
286 1.1 petrov /* Disable port interrupts */
287 1.1 petrov SAB_WRITE(sc, SAB_PIM, 0xff);
288 1.1 petrov SAB_WRITE(sc, SAB_PVR, SAB_PVR_DTR_A | SAB_PVR_DTR_B | SAB_PVR_MAGIC);
289 1.1 petrov SAB_WRITE(sc, SAB_IPC, SAB_IPC_ICPL);
290 1.1 petrov
291 1.1 petrov for (i = 0; i < SAB_NCHAN; i++) {
292 1.1 petrov struct sabtty_attach_args sta;
293 1.1 petrov
294 1.1 petrov sta.sbt_portno = i;
295 1.1 petrov sc->sc_child[i] = (struct sabtty_softc *)config_found_sm(self,
296 1.1 petrov &sta, sab_print, sabtty_match);
297 1.1 petrov if (sc->sc_child[i] != NULL)
298 1.1 petrov sc->sc_nchild++;
299 1.1 petrov }
300 1.1 petrov }
301 1.1 petrov
302 1.1 petrov int
303 1.1 petrov sab_print(args, name)
304 1.1 petrov void *args;
305 1.1 petrov const char *name;
306 1.1 petrov {
307 1.1 petrov struct sabtty_attach_args *sa = args;
308 1.1 petrov
309 1.1 petrov if (name)
310 1.9 thorpej aprint_normal("sabtty at %s", name);
311 1.9 thorpej aprint_normal(" port %d", sa->sbt_portno);
312 1.1 petrov return (UNCONF);
313 1.1 petrov }
314 1.1 petrov
315 1.1 petrov int
316 1.1 petrov sab_intr(vsc)
317 1.1 petrov void *vsc;
318 1.1 petrov {
319 1.1 petrov struct sab_softc *sc = vsc;
320 1.1 petrov int r = 0, needsoft = 0;
321 1.1 petrov u_int8_t gis;
322 1.1 petrov
323 1.1 petrov gis = SAB_READ(sc, SAB_GIS);
324 1.1 petrov
325 1.1 petrov /* channel A */
326 1.1 petrov if ((gis & (SAB_GIS_ISA1 | SAB_GIS_ISA0)) && sc->sc_child[0] &&
327 1.1 petrov sc->sc_child[0]->sc_tty)
328 1.1 petrov r |= sabtty_intr(sc->sc_child[0], &needsoft);
329 1.1 petrov
330 1.1 petrov /* channel B */
331 1.1 petrov if ((gis & (SAB_GIS_ISB1 | SAB_GIS_ISB0)) && sc->sc_child[1] &&
332 1.1 petrov sc->sc_child[1]->sc_tty)
333 1.1 petrov r |= sabtty_intr(sc->sc_child[1], &needsoft);
334 1.1 petrov
335 1.1 petrov if (needsoft)
336 1.1 petrov softintr_schedule(sc->sc_softintr);
337 1.1 petrov
338 1.1 petrov return (r);
339 1.1 petrov }
340 1.1 petrov
341 1.1 petrov void
342 1.1 petrov sab_softintr(vsc)
343 1.1 petrov void *vsc;
344 1.1 petrov {
345 1.1 petrov struct sab_softc *sc = vsc;
346 1.1 petrov
347 1.1 petrov if (sc->sc_child[0] && sc->sc_child[0]->sc_tty)
348 1.1 petrov sabtty_softintr(sc->sc_child[0]);
349 1.1 petrov if (sc->sc_child[1] && sc->sc_child[1]->sc_tty)
350 1.1 petrov sabtty_softintr(sc->sc_child[1]);
351 1.1 petrov }
352 1.1 petrov
353 1.1 petrov int
354 1.1 petrov sabtty_match(parent, match, aux)
355 1.1 petrov struct device *parent;
356 1.1 petrov struct cfdata *match;
357 1.1 petrov void *aux;
358 1.1 petrov {
359 1.1 petrov struct sabtty_attach_args *sa = aux;
360 1.1 petrov
361 1.1 petrov if (sa->sbt_portno < SAB_NCHAN)
362 1.1 petrov return (1);
363 1.1 petrov return (0);
364 1.1 petrov }
365 1.1 petrov
366 1.1 petrov void
367 1.1 petrov sabtty_attach(parent, self, aux)
368 1.1 petrov struct device *parent;
369 1.1 petrov struct device *self;
370 1.1 petrov void *aux;
371 1.1 petrov {
372 1.1 petrov struct sabtty_softc *sc = (struct sabtty_softc *)self;
373 1.1 petrov struct sabtty_attach_args *sa = aux;
374 1.1 petrov int r;
375 1.10 petrov int maj;
376 1.1 petrov
377 1.1 petrov sc->sc_tty = ttymalloc();
378 1.1 petrov if (sc->sc_tty == NULL) {
379 1.1 petrov printf(": failed to allocate tty\n");
380 1.1 petrov return;
381 1.1 petrov }
382 1.1 petrov tty_attach(sc->sc_tty);
383 1.1 petrov sc->sc_tty->t_oproc = sabtty_start;
384 1.1 petrov sc->sc_tty->t_param = sabtty_param;
385 1.1 petrov
386 1.1 petrov sc->sc_parent = (struct sab_softc *)parent;
387 1.1 petrov sc->sc_bt = sc->sc_parent->sc_bt;
388 1.1 petrov sc->sc_portno = sa->sbt_portno;
389 1.1 petrov sc->sc_rend = sc->sc_rbuf + SABTTY_RBUF_SIZE;
390 1.1 petrov
391 1.1 petrov switch (sa->sbt_portno) {
392 1.1 petrov case 0: /* port A */
393 1.1 petrov sc->sc_pvr_dtr = SAB_PVR_DTR_A;
394 1.1 petrov sc->sc_pvr_dsr = SAB_PVR_DSR_A;
395 1.1 petrov r = bus_space_subregion(sc->sc_bt, sc->sc_parent->sc_bh,
396 1.1 petrov SAB_CHAN_A, SAB_CHANLEN, &sc->sc_bh);
397 1.1 petrov break;
398 1.1 petrov case 1: /* port B */
399 1.1 petrov sc->sc_pvr_dtr = SAB_PVR_DTR_B;
400 1.1 petrov sc->sc_pvr_dsr = SAB_PVR_DSR_B;
401 1.1 petrov r = bus_space_subregion(sc->sc_bt, sc->sc_parent->sc_bh,
402 1.1 petrov SAB_CHAN_B, SAB_CHANLEN, &sc->sc_bh);
403 1.1 petrov break;
404 1.1 petrov default:
405 1.1 petrov printf(": invalid channel: %u\n", sa->sbt_portno);
406 1.1 petrov return;
407 1.1 petrov }
408 1.1 petrov if (r != 0) {
409 1.1 petrov printf(": failed to allocate register subregion\n");
410 1.1 petrov return;
411 1.1 petrov }
412 1.1 petrov
413 1.1 petrov sabtty_console_flags(sc);
414 1.1 petrov
415 1.1 petrov if (sc->sc_flags & (SABTTYF_CONS_IN | SABTTYF_CONS_OUT)) {
416 1.1 petrov struct termios t;
417 1.1 petrov char *acc;
418 1.1 petrov
419 1.1 petrov switch (sc->sc_flags & (SABTTYF_CONS_IN | SABTTYF_CONS_OUT)) {
420 1.1 petrov case SABTTYF_CONS_IN:
421 1.1 petrov acc = "input";
422 1.1 petrov break;
423 1.1 petrov case SABTTYF_CONS_OUT:
424 1.1 petrov acc = "output";
425 1.1 petrov break;
426 1.1 petrov case SABTTYF_CONS_IN|SABTTYF_CONS_OUT:
427 1.1 petrov default:
428 1.1 petrov acc = "i/o";
429 1.1 petrov break;
430 1.1 petrov }
431 1.1 petrov
432 1.1 petrov t.c_ispeed= 0;
433 1.1 petrov t.c_ospeed = 9600;
434 1.1 petrov t.c_cflag = CREAD | CS8 | HUPCL;
435 1.1 petrov sc->sc_tty->t_ospeed = 0;
436 1.1 petrov sabttyparam(sc, sc->sc_tty, &t);
437 1.1 petrov
438 1.1 petrov if (sc->sc_flags & SABTTYF_CONS_IN) {
439 1.1 petrov sabtty_cons_input = sc;
440 1.1 petrov cn_tab->cn_pollc = sab_cnpollc;
441 1.1 petrov cn_tab->cn_getc = sab_cngetc;
442 1.10 petrov maj = cdevsw_lookup_major(&sabtty_cdevsw);
443 1.10 petrov cn_tab->cn_dev = makedev(maj, self->dv_unit);
444 1.1 petrov shutdownhook_establish(sabtty_shutdown, sc);
445 1.1 petrov }
446 1.1 petrov
447 1.1 petrov if (sc->sc_flags & SABTTYF_CONS_OUT) {
448 1.1 petrov sabtty_cons_output = sc;
449 1.1 petrov cn_tab->cn_putc = sab_cnputc;
450 1.10 petrov maj = cdevsw_lookup_major(&sabtty_cdevsw);
451 1.10 petrov cn_tab->cn_dev = makedev(maj, self->dv_unit);
452 1.1 petrov }
453 1.1 petrov printf(": console %s", acc);
454 1.1 petrov } else {
455 1.1 petrov /* Not a console... */
456 1.1 petrov sabtty_reset(sc);
457 1.1 petrov }
458 1.1 petrov
459 1.1 petrov printf("\n");
460 1.1 petrov }
461 1.1 petrov
462 1.1 petrov int
463 1.1 petrov sabtty_intr(sc, needsoftp)
464 1.1 petrov struct sabtty_softc *sc;
465 1.1 petrov int *needsoftp;
466 1.1 petrov {
467 1.1 petrov u_int8_t isr0, isr1;
468 1.1 petrov int i, len = 0, needsoft = 0, r = 0, clearfifo = 0;
469 1.1 petrov
470 1.1 petrov isr0 = SAB_READ(sc, SAB_ISR0);
471 1.1 petrov isr1 = SAB_READ(sc, SAB_ISR1);
472 1.1 petrov
473 1.1 petrov if (isr0 || isr1)
474 1.1 petrov r = 1;
475 1.1 petrov
476 1.1 petrov if (isr0 & SAB_ISR0_RPF) {
477 1.1 petrov len = 32;
478 1.1 petrov clearfifo = 1;
479 1.1 petrov }
480 1.1 petrov if (isr0 & SAB_ISR0_TCD) {
481 1.1 petrov len = (32 - 1) & SAB_READ(sc, SAB_RBCL);
482 1.1 petrov clearfifo = 1;
483 1.1 petrov }
484 1.1 petrov if (isr0 & SAB_ISR0_TIME) {
485 1.1 petrov sabtty_cec_wait(sc);
486 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RFRD);
487 1.1 petrov }
488 1.1 petrov if (isr0 & SAB_ISR0_RFO) {
489 1.1 petrov sc->sc_flags |= SABTTYF_RINGOVERFLOW;
490 1.1 petrov clearfifo = 1;
491 1.1 petrov }
492 1.1 petrov if (len != 0) {
493 1.1 petrov u_int8_t *ptr;
494 1.1 petrov
495 1.1 petrov ptr = sc->sc_rput;
496 1.1 petrov for (i = 0; i < len; i++) {
497 1.1 petrov *ptr++ = SAB_READ(sc, SAB_RFIFO);
498 1.1 petrov if (ptr == sc->sc_rend)
499 1.1 petrov ptr = sc->sc_rbuf;
500 1.1 petrov if (ptr == sc->sc_rget) {
501 1.1 petrov if (ptr == sc->sc_rbuf)
502 1.1 petrov ptr = sc->sc_rend;
503 1.1 petrov ptr--;
504 1.1 petrov sc->sc_flags |= SABTTYF_RINGOVERFLOW;
505 1.1 petrov }
506 1.1 petrov }
507 1.1 petrov sc->sc_rput = ptr;
508 1.1 petrov needsoft = 1;
509 1.1 petrov }
510 1.1 petrov
511 1.1 petrov if (clearfifo) {
512 1.1 petrov sabtty_cec_wait(sc);
513 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RMC);
514 1.1 petrov }
515 1.1 petrov
516 1.1 petrov if (isr0 & SAB_ISR0_CDSC) {
517 1.1 petrov sc->sc_flags |= SABTTYF_CDCHG;
518 1.1 petrov needsoft = 1;
519 1.1 petrov }
520 1.1 petrov
521 1.1 petrov if (isr1 & SAB_ISR1_BRKT)
522 1.1 petrov sabtty_abort(sc);
523 1.1 petrov
524 1.11 petrov if (isr1 & (SAB_ISR1_XPR | SAB_ISR1_ALLS)) {
525 1.11 petrov if ((SAB_READ(sc, SAB_STAR) & SAB_STAR_XFW) &&
526 1.11 petrov (sc->sc_flags & SABTTYF_STOP) == 0) {
527 1.1 petrov if (sc->sc_txc < 32)
528 1.1 petrov len = sc->sc_txc;
529 1.1 petrov else
530 1.1 petrov len = 32;
531 1.11 petrov
532 1.11 petrov if (len > 0) {
533 1.11 petrov SAB_WRITE_BLOCK(sc, SAB_XFIFO, sc->sc_txp, len);
534 1.11 petrov sc->sc_txp += len;
535 1.11 petrov sc->sc_txc -= len;
536 1.11 petrov
537 1.1 petrov sabtty_cec_wait(sc);
538 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_XF);
539 1.11 petrov
540 1.11 petrov /*
541 1.11 petrov * Prevent the false end of xmit from
542 1.11 petrov * confusing things below.
543 1.11 petrov */
544 1.11 petrov isr1 &= ~SAB_ISR1_ALLS;
545 1.1 petrov }
546 1.1 petrov }
547 1.1 petrov
548 1.1 petrov if ((sc->sc_txc == 0) || (sc->sc_flags & SABTTYF_STOP)) {
549 1.11 petrov if ((sc->sc_imr1 & SAB_IMR1_XPR) == 0) {
550 1.11 petrov sc->sc_imr1 |= SAB_IMR1_XPR;
551 1.11 petrov sc->sc_imr1 &= ~SAB_IMR1_ALLS;
552 1.11 petrov SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
553 1.11 petrov }
554 1.1 petrov }
555 1.1 petrov }
556 1.1 petrov
557 1.11 petrov if ((isr1 & SAB_ISR1_ALLS) && ((sc->sc_txc == 0) ||
558 1.11 petrov (sc->sc_flags & SABTTYF_STOP))) {
559 1.11 petrov if (sc->sc_flags & SABTTYF_TXDRAIN)
560 1.11 petrov wakeup(sc);
561 1.11 petrov sc->sc_flags &= ~SABTTYF_STOP;
562 1.11 petrov sc->sc_flags |= SABTTYF_DONE;
563 1.11 petrov sc->sc_imr1 |= SAB_IMR1_ALLS;
564 1.11 petrov SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
565 1.11 petrov needsoft = 1;
566 1.11 petrov }
567 1.11 petrov
568 1.1 petrov if (needsoft)
569 1.1 petrov *needsoftp = needsoft;
570 1.1 petrov return (r);
571 1.1 petrov }
572 1.1 petrov
573 1.1 petrov void
574 1.1 petrov sabtty_softintr(sc)
575 1.1 petrov struct sabtty_softc *sc;
576 1.1 petrov {
577 1.1 petrov struct tty *tp = sc->sc_tty;
578 1.1 petrov int s, flags;
579 1.1 petrov u_int8_t r;
580 1.1 petrov
581 1.1 petrov if (tp == NULL)
582 1.1 petrov return;
583 1.1 petrov
584 1.1 petrov if ((tp->t_state & TS_ISOPEN) == 0)
585 1.1 petrov return;
586 1.1 petrov
587 1.1 petrov while (sc->sc_rget != sc->sc_rput) {
588 1.1 petrov int data;
589 1.1 petrov u_int8_t stat;
590 1.1 petrov
591 1.1 petrov data = sc->sc_rget[0];
592 1.1 petrov stat = sc->sc_rget[1];
593 1.1 petrov sc->sc_rget += 2;
594 1.1 petrov if (stat & SAB_RSTAT_PE)
595 1.1 petrov data |= TTY_PE;
596 1.1 petrov if (stat & SAB_RSTAT_FE)
597 1.1 petrov data |= TTY_FE;
598 1.1 petrov if (sc->sc_rget == sc->sc_rend)
599 1.1 petrov sc->sc_rget = sc->sc_rbuf;
600 1.1 petrov
601 1.1 petrov (*tp->t_linesw->l_rint)(data, tp);
602 1.1 petrov }
603 1.1 petrov
604 1.1 petrov s = splhigh();
605 1.1 petrov flags = sc->sc_flags;
606 1.1 petrov sc->sc_flags &= ~(SABTTYF_DONE|SABTTYF_CDCHG|SABTTYF_RINGOVERFLOW);
607 1.1 petrov splx(s);
608 1.1 petrov
609 1.1 petrov if (flags & SABTTYF_CDCHG) {
610 1.1 petrov s = spltty();
611 1.1 petrov r = SAB_READ(sc, SAB_VSTR) & SAB_VSTR_CD;
612 1.1 petrov splx(s);
613 1.1 petrov
614 1.1 petrov (*tp->t_linesw->l_modem)(tp, r);
615 1.1 petrov }
616 1.1 petrov
617 1.1 petrov if (flags & SABTTYF_RINGOVERFLOW)
618 1.1 petrov log(LOG_WARNING, "%s: ring overflow\n", sc->sc_dv.dv_xname);
619 1.1 petrov
620 1.1 petrov if (flags & SABTTYF_DONE) {
621 1.1 petrov ndflush(&tp->t_outq, sc->sc_txp - tp->t_outq.c_cf);
622 1.1 petrov tp->t_state &= ~TS_BUSY;
623 1.1 petrov (*tp->t_linesw->l_start)(tp);
624 1.1 petrov }
625 1.1 petrov }
626 1.1 petrov
627 1.1 petrov int
628 1.13 fvdl sabopen(dev, flags, mode, p)
629 1.1 petrov dev_t dev;
630 1.1 petrov int flags, mode;
631 1.13 fvdl struct proc *p;
632 1.1 petrov {
633 1.1 petrov struct sabtty_softc *sc;
634 1.1 petrov struct tty *tp;
635 1.1 petrov int s, s1;
636 1.1 petrov
637 1.1 petrov sc = device_lookup(&sabtty_cd, SABUNIT(dev));
638 1.1 petrov if (sc == NULL)
639 1.1 petrov return (ENXIO);
640 1.1 petrov
641 1.1 petrov tp = sc->sc_tty;
642 1.1 petrov tp->t_dev = dev;
643 1.1 petrov
644 1.1 petrov if ((tp->t_state & TS_ISOPEN) == 0) {
645 1.1 petrov ttychars(tp);
646 1.1 petrov tp->t_iflag = TTYDEF_IFLAG;
647 1.1 petrov tp->t_oflag = TTYDEF_OFLAG;
648 1.1 petrov tp->t_cflag = TTYDEF_CFLAG;
649 1.1 petrov if (sc->sc_openflags & TIOCFLAG_CLOCAL)
650 1.1 petrov tp->t_cflag |= CLOCAL;
651 1.1 petrov if (sc->sc_openflags & TIOCFLAG_CRTSCTS)
652 1.1 petrov tp->t_cflag |= CRTSCTS;
653 1.1 petrov if (sc->sc_openflags & TIOCFLAG_MDMBUF)
654 1.1 petrov tp->t_cflag |= MDMBUF;
655 1.1 petrov tp->t_lflag = TTYDEF_LFLAG;
656 1.1 petrov tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
657 1.1 petrov
658 1.1 petrov sc->sc_rput = sc->sc_rget = sc->sc_rbuf;
659 1.1 petrov
660 1.1 petrov s = spltty();
661 1.1 petrov
662 1.1 petrov ttsetwater(tp);
663 1.1 petrov
664 1.1 petrov s1 = splhigh();
665 1.1 petrov sabtty_reset(sc);
666 1.1 petrov sabtty_param(tp, &tp->t_termios);
667 1.1 petrov sc->sc_imr0 = SAB_IMR0_PERR | SAB_IMR0_FERR | SAB_IMR0_PLLA;
668 1.1 petrov SAB_WRITE(sc, SAB_IMR0, sc->sc_imr0);
669 1.1 petrov sc->sc_imr1 = SAB_IMR1_BRK | SAB_IMR1_ALLS | SAB_IMR1_XDU |
670 1.1 petrov SAB_IMR1_TIN | SAB_IMR1_CSC | SAB_IMR1_XMR | SAB_IMR1_XPR;
671 1.1 petrov SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
672 1.1 petrov SAB_WRITE(sc, SAB_CCR0, SAB_READ(sc, SAB_CCR0) | SAB_CCR0_PU);
673 1.1 petrov sabtty_cec_wait(sc);
674 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_XRES);
675 1.1 petrov sabtty_cec_wait(sc);
676 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RRES);
677 1.1 petrov sabtty_cec_wait(sc);
678 1.1 petrov splx(s1);
679 1.1 petrov
680 1.1 petrov sabtty_flush(sc);
681 1.1 petrov
682 1.1 petrov if ((sc->sc_openflags & TIOCFLAG_SOFTCAR) ||
683 1.1 petrov (SAB_READ(sc, SAB_VSTR) & SAB_VSTR_CD))
684 1.1 petrov tp->t_state |= TS_CARR_ON;
685 1.1 petrov else
686 1.1 petrov tp->t_state &= ~TS_CARR_ON;
687 1.1 petrov } else if ((tp->t_state & TS_XCLUDE) &&
688 1.13 fvdl (!suser(p->p_ucred, &p->p_acflag))) {
689 1.1 petrov return (EBUSY);
690 1.1 petrov } else {
691 1.1 petrov s = spltty();
692 1.1 petrov }
693 1.1 petrov
694 1.1 petrov if ((flags & O_NONBLOCK) == 0) {
695 1.1 petrov while ((tp->t_cflag & CLOCAL) == 0 &&
696 1.1 petrov (tp->t_state & TS_CARR_ON) == 0) {
697 1.1 petrov int error;
698 1.1 petrov
699 1.1 petrov error = ttysleep(tp, &tp->t_rawq, TTIPRI | PCATCH,
700 1.1 petrov "sabttycd", 0);
701 1.1 petrov if (error != 0) {
702 1.1 petrov splx(s);
703 1.1 petrov return (error);
704 1.1 petrov }
705 1.1 petrov }
706 1.1 petrov }
707 1.1 petrov
708 1.1 petrov splx(s);
709 1.1 petrov
710 1.1 petrov s = (*tp->t_linesw->l_open)(dev, tp);
711 1.1 petrov if (s != 0) {
712 1.1 petrov if (tp->t_state & TS_ISOPEN)
713 1.1 petrov return (s);
714 1.1 petrov
715 1.1 petrov if (tp->t_cflag & HUPCL) {
716 1.1 petrov sabtty_mdmctrl(sc, 0, DMSET);
717 1.1 petrov (void)tsleep(sc, TTIPRI, ttclos, hz);
718 1.1 petrov }
719 1.1 petrov
720 1.1 petrov if ((sc->sc_flags & (SABTTYF_CONS_IN | SABTTYF_CONS_OUT)) == 0) {
721 1.1 petrov /* Flush and power down if we're not the console */
722 1.1 petrov sabtty_flush(sc);
723 1.1 petrov sabtty_reset(sc);
724 1.1 petrov }
725 1.1 petrov }
726 1.1 petrov return (s);
727 1.1 petrov }
728 1.1 petrov
729 1.1 petrov int
730 1.13 fvdl sabclose(dev, flags, mode, p)
731 1.1 petrov dev_t dev;
732 1.1 petrov int flags, mode;
733 1.13 fvdl struct proc *p;
734 1.1 petrov {
735 1.1 petrov struct sabtty_softc *sc = device_lookup(&sabtty_cd, SABUNIT(dev));
736 1.1 petrov struct sab_softc *bc = sc->sc_parent;
737 1.1 petrov struct tty *tp = sc->sc_tty;
738 1.1 petrov int s;
739 1.1 petrov
740 1.1 petrov (*tp->t_linesw->l_close)(tp, flags);
741 1.1 petrov
742 1.1 petrov s = spltty();
743 1.1 petrov
744 1.1 petrov if ((tp->t_state & TS_ISOPEN) == 0) {
745 1.1 petrov /* Wait for output drain */
746 1.1 petrov sc->sc_imr1 &= ~SAB_IMR1_ALLS;
747 1.1 petrov SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
748 1.1 petrov sc->sc_flags |= SABTTYF_TXDRAIN;
749 1.1 petrov (void)tsleep(sc, TTIPRI, ttclos, 5 * hz);
750 1.1 petrov sc->sc_imr1 |= SAB_IMR1_ALLS;
751 1.1 petrov SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
752 1.1 petrov sc->sc_flags &= ~SABTTYF_TXDRAIN;
753 1.1 petrov
754 1.1 petrov if (tp->t_cflag & HUPCL) {
755 1.1 petrov sabtty_mdmctrl(sc, 0, DMSET);
756 1.1 petrov (void)tsleep(bc, TTIPRI, ttclos, hz);
757 1.1 petrov }
758 1.1 petrov
759 1.1 petrov if ((sc->sc_flags & (SABTTYF_CONS_IN | SABTTYF_CONS_OUT)) == 0) {
760 1.1 petrov /* Flush and power down if we're not the console */
761 1.1 petrov sabtty_flush(sc);
762 1.1 petrov sabtty_reset(sc);
763 1.1 petrov }
764 1.1 petrov }
765 1.1 petrov
766 1.1 petrov ttyclose(tp);
767 1.1 petrov splx(s);
768 1.1 petrov
769 1.1 petrov return (0);
770 1.1 petrov }
771 1.1 petrov
772 1.1 petrov int
773 1.1 petrov sabread(dev, uio, flags)
774 1.1 petrov dev_t dev;
775 1.1 petrov struct uio *uio;
776 1.1 petrov int flags;
777 1.1 petrov {
778 1.1 petrov struct sabtty_softc *sc = device_lookup(&sabtty_cd, SABUNIT(dev));
779 1.1 petrov struct tty *tp = sc->sc_tty;
780 1.1 petrov
781 1.1 petrov return ((*tp->t_linesw->l_read)(tp, uio, flags));
782 1.1 petrov }
783 1.1 petrov
784 1.1 petrov int
785 1.1 petrov sabwrite(dev, uio, flags)
786 1.1 petrov dev_t dev;
787 1.1 petrov struct uio *uio;
788 1.1 petrov int flags;
789 1.1 petrov {
790 1.1 petrov struct sabtty_softc *sc = device_lookup(&sabtty_cd, SABUNIT(dev));
791 1.1 petrov struct tty *tp = sc->sc_tty;
792 1.1 petrov
793 1.1 petrov return ((*tp->t_linesw->l_write)(tp, uio, flags));
794 1.1 petrov }
795 1.1 petrov
796 1.1 petrov int
797 1.13 fvdl sabioctl(dev, cmd, data, flags, p)
798 1.1 petrov dev_t dev;
799 1.1 petrov u_long cmd;
800 1.1 petrov caddr_t data;
801 1.1 petrov int flags;
802 1.13 fvdl struct proc *p;
803 1.1 petrov {
804 1.1 petrov struct sabtty_softc *sc = device_lookup(&sabtty_cd, SABUNIT(dev));
805 1.1 petrov struct tty *tp = sc->sc_tty;
806 1.1 petrov int error;
807 1.1 petrov
808 1.13 fvdl error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flags, p);
809 1.1 petrov if (error >= 0)
810 1.1 petrov return (error);
811 1.1 petrov
812 1.13 fvdl error = ttioctl(tp, cmd, data, flags, p);
813 1.1 petrov if (error >= 0)
814 1.1 petrov return (error);
815 1.1 petrov
816 1.1 petrov error = 0;
817 1.1 petrov
818 1.1 petrov switch (cmd) {
819 1.1 petrov case TIOCSBRK:
820 1.1 petrov SAB_WRITE(sc, SAB_DAFO,
821 1.1 petrov SAB_READ(sc, SAB_DAFO) | SAB_DAFO_XBRK);
822 1.1 petrov break;
823 1.1 petrov case TIOCCBRK:
824 1.1 petrov SAB_WRITE(sc, SAB_DAFO,
825 1.1 petrov SAB_READ(sc, SAB_DAFO) & ~SAB_DAFO_XBRK);
826 1.1 petrov break;
827 1.1 petrov case TIOCSDTR:
828 1.1 petrov sabtty_mdmctrl(sc, TIOCM_DTR, DMBIS);
829 1.1 petrov break;
830 1.1 petrov case TIOCCDTR:
831 1.1 petrov sabtty_mdmctrl(sc, TIOCM_DTR, DMBIC);
832 1.1 petrov break;
833 1.1 petrov case TIOCMBIS:
834 1.1 petrov sabtty_mdmctrl(sc, *((int *)data), DMBIS);
835 1.1 petrov break;
836 1.1 petrov case TIOCMBIC:
837 1.1 petrov sabtty_mdmctrl(sc, *((int *)data), DMBIC);
838 1.1 petrov break;
839 1.1 petrov case TIOCMGET:
840 1.1 petrov *((int *)data) = sabtty_mdmctrl(sc, 0, DMGET);
841 1.1 petrov break;
842 1.1 petrov case TIOCMSET:
843 1.1 petrov sabtty_mdmctrl(sc, *((int *)data), DMSET);
844 1.1 petrov break;
845 1.1 petrov case TIOCGFLAGS:
846 1.1 petrov *((int *)data) = sc->sc_openflags;
847 1.1 petrov break;
848 1.1 petrov case TIOCSFLAGS:
849 1.13 fvdl if (suser(p->p_ucred, &p->p_acflag))
850 1.1 petrov error = EPERM;
851 1.1 petrov else
852 1.1 petrov sc->sc_openflags = *((int *)data) &
853 1.1 petrov (TIOCFLAG_SOFTCAR | TIOCFLAG_CLOCAL |
854 1.1 petrov TIOCFLAG_CRTSCTS | TIOCFLAG_MDMBUF);
855 1.1 petrov break;
856 1.1 petrov default:
857 1.1 petrov error = ENOTTY;
858 1.1 petrov }
859 1.1 petrov
860 1.1 petrov return (error);
861 1.1 petrov }
862 1.1 petrov
863 1.1 petrov struct tty *
864 1.1 petrov sabtty(dev)
865 1.1 petrov dev_t dev;
866 1.1 petrov {
867 1.1 petrov struct sabtty_softc *sc = device_lookup(&sabtty_cd, SABUNIT(dev));
868 1.1 petrov
869 1.1 petrov return (sc->sc_tty);
870 1.1 petrov }
871 1.1 petrov
872 1.1 petrov void
873 1.1 petrov sabstop(tp, flag)
874 1.1 petrov struct tty *tp;
875 1.1 petrov int flag;
876 1.1 petrov {
877 1.1 petrov struct sabtty_softc *sc = device_lookup(&sabtty_cd, SABUNIT(tp->t_dev));
878 1.1 petrov int s;
879 1.1 petrov
880 1.1 petrov s = spltty();
881 1.1 petrov if (tp->t_state & TS_BUSY) {
882 1.1 petrov if ((tp->t_state & TS_TTSTOP) == 0)
883 1.1 petrov tp->t_state |= TS_FLUSH;
884 1.1 petrov sc->sc_flags |= SABTTYF_STOP;
885 1.1 petrov sc->sc_imr1 &= ~SAB_IMR1_ALLS;
886 1.1 petrov SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
887 1.1 petrov }
888 1.1 petrov splx(s);
889 1.1 petrov }
890 1.1 petrov
891 1.1 petrov int
892 1.13 fvdl sabpoll(dev, events, p)
893 1.1 petrov dev_t dev;
894 1.1 petrov int events;
895 1.13 fvdl struct proc *p;
896 1.1 petrov {
897 1.1 petrov struct sabtty_softc *sc = device_lookup(&sabtty_cd, SABUNIT(dev));
898 1.1 petrov struct tty *tp = sc->sc_tty;
899 1.1 petrov
900 1.13 fvdl return ((*tp->t_linesw->l_poll)(tp, events, p));
901 1.1 petrov }
902 1.1 petrov
903 1.1 petrov int
904 1.1 petrov sabtty_mdmctrl(sc, bits, how)
905 1.1 petrov struct sabtty_softc *sc;
906 1.1 petrov int bits, how;
907 1.1 petrov {
908 1.1 petrov u_int8_t r;
909 1.1 petrov int s;
910 1.1 petrov
911 1.1 petrov s = spltty();
912 1.1 petrov switch (how) {
913 1.1 petrov case DMGET:
914 1.1 petrov bits = 0;
915 1.1 petrov if (SAB_READ(sc, SAB_STAR) & SAB_STAR_CTS)
916 1.1 petrov bits |= TIOCM_CTS;
917 1.1 petrov if ((SAB_READ(sc, SAB_VSTR) & SAB_VSTR_CD) == 0)
918 1.1 petrov bits |= TIOCM_CD;
919 1.1 petrov
920 1.1 petrov r = SAB_READ(sc, SAB_PVR);
921 1.1 petrov if ((r & sc->sc_pvr_dtr) == 0)
922 1.1 petrov bits |= TIOCM_DTR;
923 1.1 petrov if ((r & sc->sc_pvr_dsr) == 0)
924 1.1 petrov bits |= TIOCM_DSR;
925 1.1 petrov
926 1.1 petrov r = SAB_READ(sc, SAB_MODE);
927 1.1 petrov if ((r & (SAB_MODE_RTS|SAB_MODE_FRTS)) == SAB_MODE_RTS)
928 1.1 petrov bits |= TIOCM_RTS;
929 1.1 petrov break;
930 1.1 petrov case DMSET:
931 1.1 petrov r = SAB_READ(sc, SAB_MODE);
932 1.1 petrov if (bits & TIOCM_RTS) {
933 1.1 petrov r &= ~SAB_MODE_FRTS;
934 1.1 petrov r |= SAB_MODE_RTS;
935 1.1 petrov } else
936 1.1 petrov r |= SAB_MODE_FRTS | SAB_MODE_RTS;
937 1.1 petrov SAB_WRITE(sc, SAB_MODE, r);
938 1.1 petrov
939 1.1 petrov r = SAB_READ(sc, SAB_PVR);
940 1.1 petrov if (bits & TIOCM_DTR)
941 1.1 petrov r &= ~sc->sc_pvr_dtr;
942 1.1 petrov else
943 1.1 petrov r |= sc->sc_pvr_dtr;
944 1.1 petrov SAB_WRITE(sc, SAB_PVR, r);
945 1.1 petrov break;
946 1.1 petrov case DMBIS:
947 1.1 petrov if (bits & TIOCM_RTS) {
948 1.1 petrov r = SAB_READ(sc, SAB_MODE);
949 1.1 petrov r &= ~SAB_MODE_FRTS;
950 1.1 petrov r |= SAB_MODE_RTS;
951 1.1 petrov SAB_WRITE(sc, SAB_MODE, r);
952 1.1 petrov }
953 1.1 petrov if (bits & TIOCM_DTR) {
954 1.1 petrov r = SAB_READ(sc, SAB_PVR);
955 1.1 petrov r &= ~sc->sc_pvr_dtr;
956 1.1 petrov SAB_WRITE(sc, SAB_PVR, r);
957 1.1 petrov }
958 1.1 petrov break;
959 1.1 petrov case DMBIC:
960 1.1 petrov if (bits & TIOCM_RTS) {
961 1.1 petrov r = SAB_READ(sc, SAB_MODE);
962 1.1 petrov r |= SAB_MODE_FRTS | SAB_MODE_RTS;
963 1.1 petrov SAB_WRITE(sc, SAB_MODE, r);
964 1.1 petrov }
965 1.1 petrov if (bits & TIOCM_DTR) {
966 1.1 petrov r = SAB_READ(sc, SAB_PVR);
967 1.1 petrov r |= sc->sc_pvr_dtr;
968 1.1 petrov SAB_WRITE(sc, SAB_PVR, r);
969 1.1 petrov }
970 1.1 petrov break;
971 1.1 petrov }
972 1.1 petrov splx(s);
973 1.1 petrov return (bits);
974 1.1 petrov }
975 1.1 petrov
976 1.1 petrov int
977 1.1 petrov sabttyparam(sc, tp, t)
978 1.1 petrov struct sabtty_softc *sc;
979 1.1 petrov struct tty *tp;
980 1.1 petrov struct termios *t;
981 1.1 petrov {
982 1.1 petrov int s, ospeed;
983 1.1 petrov tcflag_t cflag;
984 1.1 petrov u_int8_t dafo, r;
985 1.1 petrov
986 1.1 petrov ospeed = sabtty_speed(t->c_ospeed);
987 1.1 petrov if (ospeed < 0 || (t->c_ispeed && t->c_ispeed != t->c_ospeed))
988 1.1 petrov return (EINVAL);
989 1.1 petrov
990 1.1 petrov s = spltty();
991 1.1 petrov
992 1.1 petrov /* hang up line if ospeed is zero, otherwise raise dtr */
993 1.1 petrov sabtty_mdmctrl(sc, TIOCM_DTR,
994 1.1 petrov (t->c_ospeed == 0) ? DMBIC : DMBIS);
995 1.1 petrov
996 1.1 petrov dafo = SAB_READ(sc, SAB_DAFO);
997 1.1 petrov
998 1.1 petrov cflag = t->c_cflag;
999 1.1 petrov
1000 1.1 petrov if (sc->sc_flags & (SABTTYF_CONS_IN | SABTTYF_CONS_OUT)) {
1001 1.1 petrov cflag |= CLOCAL;
1002 1.1 petrov cflag &= ~HUPCL;
1003 1.1 petrov }
1004 1.1 petrov
1005 1.1 petrov if (cflag & CSTOPB)
1006 1.1 petrov dafo |= SAB_DAFO_STOP;
1007 1.1 petrov else
1008 1.1 petrov dafo &= ~SAB_DAFO_STOP;
1009 1.1 petrov
1010 1.1 petrov dafo &= ~SAB_DAFO_CHL_CSIZE;
1011 1.1 petrov switch (cflag & CSIZE) {
1012 1.1 petrov case CS5:
1013 1.1 petrov dafo |= SAB_DAFO_CHL_CS5;
1014 1.1 petrov break;
1015 1.1 petrov case CS6:
1016 1.1 petrov dafo |= SAB_DAFO_CHL_CS6;
1017 1.1 petrov break;
1018 1.1 petrov case CS7:
1019 1.1 petrov dafo |= SAB_DAFO_CHL_CS7;
1020 1.1 petrov break;
1021 1.1 petrov default:
1022 1.1 petrov dafo |= SAB_DAFO_CHL_CS8;
1023 1.1 petrov break;
1024 1.1 petrov }
1025 1.1 petrov
1026 1.1 petrov dafo &= ~SAB_DAFO_PARMASK;
1027 1.1 petrov if (cflag & PARENB) {
1028 1.1 petrov if (cflag & PARODD)
1029 1.1 petrov dafo |= SAB_DAFO_PAR_ODD;
1030 1.1 petrov else
1031 1.1 petrov dafo |= SAB_DAFO_PAR_EVEN;
1032 1.1 petrov } else
1033 1.1 petrov dafo |= SAB_DAFO_PAR_NONE;
1034 1.1 petrov
1035 1.1 petrov if (ospeed != 0) {
1036 1.1 petrov SAB_WRITE(sc, SAB_BGR, ospeed & 0xff);
1037 1.1 petrov r = SAB_READ(sc, SAB_CCR2);
1038 1.1 petrov r &= ~(SAB_CCR2_BR9 | SAB_CCR2_BR8);
1039 1.1 petrov r |= (ospeed >> 2) & (SAB_CCR2_BR9 | SAB_CCR2_BR8);
1040 1.1 petrov SAB_WRITE(sc, SAB_CCR2, r);
1041 1.1 petrov }
1042 1.1 petrov
1043 1.1 petrov r = SAB_READ(sc, SAB_MODE);
1044 1.1 petrov r |= SAB_MODE_RAC;
1045 1.1 petrov if (cflag & CRTSCTS) {
1046 1.1 petrov r &= ~(SAB_MODE_RTS | SAB_MODE_FCTS);
1047 1.1 petrov r |= SAB_MODE_FRTS;
1048 1.1 petrov sc->sc_imr1 &= ~SAB_IMR1_CSC;
1049 1.1 petrov } else {
1050 1.1 petrov r |= SAB_MODE_RTS | SAB_MODE_FCTS;
1051 1.1 petrov r &= ~SAB_MODE_FRTS;
1052 1.1 petrov sc->sc_imr1 |= SAB_IMR1_CSC;
1053 1.1 petrov }
1054 1.1 petrov SAB_WRITE(sc, SAB_MODE, r);
1055 1.1 petrov SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
1056 1.1 petrov
1057 1.1 petrov tp->t_cflag = cflag;
1058 1.1 petrov
1059 1.1 petrov splx(s);
1060 1.1 petrov return (0);
1061 1.1 petrov }
1062 1.1 petrov
1063 1.1 petrov int
1064 1.1 petrov sabtty_param(tp, t)
1065 1.1 petrov struct tty *tp;
1066 1.1 petrov struct termios *t;
1067 1.1 petrov {
1068 1.1 petrov struct sabtty_softc *sc = device_lookup(&sabtty_cd, SABUNIT(tp->t_dev));
1069 1.1 petrov
1070 1.1 petrov return (sabttyparam(sc, tp, t));
1071 1.1 petrov }
1072 1.1 petrov
1073 1.1 petrov void
1074 1.1 petrov sabtty_start(tp)
1075 1.1 petrov struct tty *tp;
1076 1.1 petrov {
1077 1.1 petrov struct sabtty_softc *sc = device_lookup(&sabtty_cd, SABUNIT(tp->t_dev));
1078 1.1 petrov int s;
1079 1.1 petrov
1080 1.1 petrov s = spltty();
1081 1.1 petrov if ((tp->t_state & (TS_TTSTOP | TS_TIMEOUT | TS_BUSY)) == 0) {
1082 1.1 petrov if (tp->t_outq.c_cc <= tp->t_lowat) {
1083 1.1 petrov if (tp->t_state & TS_ASLEEP) {
1084 1.1 petrov tp->t_state &= ~TS_ASLEEP;
1085 1.1 petrov wakeup(&tp->t_outq);
1086 1.1 petrov }
1087 1.1 petrov selwakeup(&tp->t_wsel);
1088 1.1 petrov }
1089 1.1 petrov if (tp->t_outq.c_cc) {
1090 1.1 petrov sc->sc_txc = ndqb(&tp->t_outq, 0);
1091 1.1 petrov sc->sc_txp = tp->t_outq.c_cf;
1092 1.1 petrov tp->t_state |= TS_BUSY;
1093 1.11 petrov sc->sc_imr1 &= ~(SAB_ISR1_XPR | SAB_ISR1_ALLS);
1094 1.1 petrov SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
1095 1.1 petrov }
1096 1.1 petrov }
1097 1.1 petrov splx(s);
1098 1.1 petrov }
1099 1.1 petrov
1100 1.1 petrov void
1101 1.1 petrov sabtty_cec_wait(sc)
1102 1.1 petrov struct sabtty_softc *sc;
1103 1.1 petrov {
1104 1.1 petrov int i = 50000;
1105 1.1 petrov
1106 1.1 petrov for (;;) {
1107 1.1 petrov if ((SAB_READ(sc, SAB_STAR) & SAB_STAR_CEC) == 0)
1108 1.1 petrov return;
1109 1.1 petrov if (--i == 0)
1110 1.1 petrov break;
1111 1.1 petrov DELAY(1);
1112 1.1 petrov }
1113 1.1 petrov }
1114 1.1 petrov
1115 1.1 petrov void
1116 1.1 petrov sabtty_tec_wait(sc)
1117 1.1 petrov struct sabtty_softc *sc;
1118 1.1 petrov {
1119 1.1 petrov int i = 200000;
1120 1.1 petrov
1121 1.1 petrov for (;;) {
1122 1.1 petrov if ((SAB_READ(sc, SAB_STAR) & SAB_STAR_TEC) == 0)
1123 1.1 petrov return;
1124 1.1 petrov if (--i == 0)
1125 1.1 petrov break;
1126 1.1 petrov DELAY(1);
1127 1.1 petrov }
1128 1.1 petrov }
1129 1.1 petrov
1130 1.1 petrov void
1131 1.1 petrov sabtty_reset(sc)
1132 1.1 petrov struct sabtty_softc *sc;
1133 1.1 petrov {
1134 1.1 petrov /* power down */
1135 1.1 petrov SAB_WRITE(sc, SAB_CCR0, 0);
1136 1.1 petrov
1137 1.1 petrov /* set basic configuration */
1138 1.1 petrov SAB_WRITE(sc, SAB_CCR0,
1139 1.1 petrov SAB_CCR0_MCE | SAB_CCR0_SC_NRZ | SAB_CCR0_SM_ASYNC);
1140 1.1 petrov SAB_WRITE(sc, SAB_CCR1, SAB_CCR1_ODS | SAB_CCR1_BCR | SAB_CCR1_CM_7);
1141 1.1 petrov SAB_WRITE(sc, SAB_CCR2, SAB_CCR2_BDF | SAB_CCR2_SSEL | SAB_CCR2_TOE);
1142 1.1 petrov SAB_WRITE(sc, SAB_CCR3, 0);
1143 1.1 petrov SAB_WRITE(sc, SAB_CCR4, SAB_CCR4_MCK4 | SAB_CCR4_EBRG);
1144 1.1 petrov SAB_WRITE(sc, SAB_MODE, SAB_MODE_RTS | SAB_MODE_FCTS | SAB_MODE_RAC);
1145 1.1 petrov SAB_WRITE(sc, SAB_RFC,
1146 1.1 petrov SAB_RFC_DPS | SAB_RFC_RFDF | SAB_RFC_RFTH_32CHAR);
1147 1.1 petrov
1148 1.1 petrov /* clear interrupts */
1149 1.1 petrov sc->sc_imr0 = sc->sc_imr1 = 0xff;
1150 1.1 petrov SAB_WRITE(sc, SAB_IMR0, sc->sc_imr0);
1151 1.1 petrov SAB_WRITE(sc, SAB_IMR1, sc->sc_imr1);
1152 1.1 petrov SAB_READ(sc, SAB_ISR0);
1153 1.1 petrov SAB_READ(sc, SAB_ISR1);
1154 1.1 petrov }
1155 1.1 petrov
1156 1.1 petrov void
1157 1.1 petrov sabtty_flush(sc)
1158 1.1 petrov struct sabtty_softc *sc;
1159 1.1 petrov {
1160 1.1 petrov /* clear rx fifo */
1161 1.1 petrov sabtty_cec_wait(sc);
1162 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RRES);
1163 1.1 petrov
1164 1.1 petrov /* clear tx fifo */
1165 1.1 petrov sabtty_cec_wait(sc);
1166 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_XRES);
1167 1.1 petrov }
1168 1.1 petrov
1169 1.1 petrov int
1170 1.1 petrov sabtty_speed(rate)
1171 1.1 petrov int rate;
1172 1.1 petrov {
1173 1.1 petrov int i, len, r;
1174 1.1 petrov
1175 1.1 petrov if (rate == 0)
1176 1.1 petrov return (0);
1177 1.1 petrov len = sizeof(sabtty_baudtable)/sizeof(sabtty_baudtable[0]);
1178 1.1 petrov for (i = 0; i < len; i++) {
1179 1.1 petrov if (rate == sabtty_baudtable[i].baud) {
1180 1.1 petrov r = sabtty_baudtable[i].n |
1181 1.1 petrov (sabtty_baudtable[i].m << 6);
1182 1.1 petrov return (r);
1183 1.1 petrov }
1184 1.1 petrov }
1185 1.1 petrov return (-1);
1186 1.1 petrov }
1187 1.1 petrov
1188 1.1 petrov void
1189 1.1 petrov sabtty_cnputc(sc, c)
1190 1.1 petrov struct sabtty_softc *sc;
1191 1.1 petrov int c;
1192 1.1 petrov {
1193 1.1 petrov sabtty_tec_wait(sc);
1194 1.1 petrov SAB_WRITE(sc, SAB_TIC, c);
1195 1.1 petrov sabtty_tec_wait(sc);
1196 1.1 petrov }
1197 1.1 petrov
1198 1.1 petrov int
1199 1.1 petrov sabtty_cngetc(sc)
1200 1.1 petrov struct sabtty_softc *sc;
1201 1.1 petrov {
1202 1.1 petrov u_int8_t r, len;
1203 1.1 petrov
1204 1.1 petrov again:
1205 1.1 petrov do {
1206 1.1 petrov r = SAB_READ(sc, SAB_STAR);
1207 1.1 petrov } while ((r & SAB_STAR_RFNE) == 0);
1208 1.1 petrov
1209 1.1 petrov /*
1210 1.1 petrov * Ok, at least one byte in RFIFO, ask for permission to access RFIFO
1211 1.1 petrov * (I hate this chip... hate hate hate).
1212 1.1 petrov */
1213 1.1 petrov sabtty_cec_wait(sc);
1214 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RFRD);
1215 1.1 petrov
1216 1.1 petrov /* Wait for RFIFO to come ready */
1217 1.1 petrov do {
1218 1.1 petrov r = SAB_READ(sc, SAB_ISR0);
1219 1.1 petrov } while ((r & SAB_ISR0_TCD) == 0);
1220 1.1 petrov
1221 1.1 petrov len = SAB_READ(sc, SAB_RBCL) & (32 - 1);
1222 1.1 petrov if (len == 0)
1223 1.1 petrov goto again; /* Shouldn't happen... */
1224 1.1 petrov
1225 1.1 petrov r = SAB_READ(sc, SAB_RFIFO);
1226 1.1 petrov
1227 1.1 petrov /*
1228 1.1 petrov * Blow away everything left in the FIFO...
1229 1.1 petrov */
1230 1.1 petrov sabtty_cec_wait(sc);
1231 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RMC);
1232 1.1 petrov return (r);
1233 1.1 petrov }
1234 1.1 petrov
1235 1.1 petrov void
1236 1.1 petrov sabtty_cnpollc(sc, on)
1237 1.1 petrov struct sabtty_softc *sc;
1238 1.1 petrov int on;
1239 1.1 petrov {
1240 1.1 petrov u_int8_t r;
1241 1.1 petrov
1242 1.1 petrov if (on) {
1243 1.1 petrov if (sc->sc_polling)
1244 1.1 petrov return;
1245 1.1 petrov SAB_WRITE(sc, SAB_IPC, SAB_READ(sc, SAB_IPC) | SAB_IPC_VIS);
1246 1.1 petrov r = sc->sc_pollrfc = SAB_READ(sc, SAB_RFC);
1247 1.1 petrov r &= ~(SAB_RFC_RFDF);
1248 1.1 petrov SAB_WRITE(sc, SAB_RFC, r);
1249 1.1 petrov sabtty_cec_wait(sc);
1250 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RRES);
1251 1.1 petrov sc->sc_polling = 1;
1252 1.1 petrov } else {
1253 1.1 petrov if (!sc->sc_polling)
1254 1.1 petrov return;
1255 1.1 petrov SAB_WRITE(sc, SAB_IPC, SAB_READ(sc, SAB_IPC) & ~SAB_IPC_VIS);
1256 1.1 petrov SAB_WRITE(sc, SAB_RFC, sc->sc_pollrfc);
1257 1.1 petrov sabtty_cec_wait(sc);
1258 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RRES);
1259 1.1 petrov sc->sc_polling = 0;
1260 1.1 petrov }
1261 1.1 petrov }
1262 1.1 petrov
1263 1.1 petrov void
1264 1.1 petrov sab_cnputc(dev, c)
1265 1.1 petrov dev_t dev;
1266 1.1 petrov int c;
1267 1.1 petrov {
1268 1.1 petrov struct sabtty_softc *sc = sabtty_cons_output;
1269 1.1 petrov
1270 1.1 petrov if (sc == NULL)
1271 1.1 petrov return;
1272 1.1 petrov sabtty_cnputc(sc, c);
1273 1.1 petrov }
1274 1.1 petrov
1275 1.1 petrov void
1276 1.1 petrov sab_cnpollc(dev, on)
1277 1.1 petrov dev_t dev;
1278 1.1 petrov int on;
1279 1.1 petrov {
1280 1.1 petrov struct sabtty_softc *sc = sabtty_cons_input;
1281 1.1 petrov
1282 1.1 petrov sabtty_cnpollc(sc, on);
1283 1.1 petrov }
1284 1.1 petrov
1285 1.1 petrov int
1286 1.1 petrov sab_cngetc(dev)
1287 1.1 petrov dev_t dev;
1288 1.1 petrov {
1289 1.1 petrov struct sabtty_softc *sc = sabtty_cons_input;
1290 1.1 petrov
1291 1.1 petrov if (sc == NULL)
1292 1.1 petrov return (-1);
1293 1.1 petrov return (sabtty_cngetc(sc));
1294 1.1 petrov }
1295 1.1 petrov
1296 1.1 petrov void
1297 1.1 petrov sabtty_console_flags(sc)
1298 1.1 petrov struct sabtty_softc *sc;
1299 1.1 petrov {
1300 1.1 petrov int node, channel, cookie;
1301 1.3 petrov u_int options;
1302 1.1 petrov char buf[255];
1303 1.1 petrov
1304 1.1 petrov node = sc->sc_parent->sc_node;
1305 1.1 petrov channel = sc->sc_portno;
1306 1.1 petrov
1307 1.3 petrov options = OF_finddevice("/options");
1308 1.1 petrov
1309 1.1 petrov /* Default to channel 0 if there are no explicit prom args */
1310 1.1 petrov cookie = 0;
1311 1.1 petrov
1312 1.1 petrov if (node == OF_instance_to_package(OF_stdin())) {
1313 1.3 petrov if (OF_getprop(options, "input-device", buf,
1314 1.1 petrov sizeof(buf)) != -1) {
1315 1.1 petrov if (strcmp("ttyb", buf) == 0)
1316 1.1 petrov cookie = 1;
1317 1.1 petrov }
1318 1.1 petrov
1319 1.1 petrov if (channel == cookie)
1320 1.1 petrov sc->sc_flags |= SABTTYF_CONS_IN;
1321 1.1 petrov }
1322 1.1 petrov
1323 1.1 petrov /* Default to same channel if there are no explicit prom args */
1324 1.1 petrov
1325 1.1 petrov if (node == OF_instance_to_package(OF_stdout())) {
1326 1.3 petrov if (OF_getprop(options, "output-device", buf,
1327 1.1 petrov sizeof(buf)) != -1) {
1328 1.1 petrov if (strcmp("ttyb", buf) == 0)
1329 1.1 petrov cookie = 1;
1330 1.1 petrov }
1331 1.1 petrov
1332 1.1 petrov if (channel == cookie)
1333 1.1 petrov sc->sc_flags |= SABTTYF_CONS_OUT;
1334 1.1 petrov }
1335 1.1 petrov }
1336 1.1 petrov
1337 1.1 petrov void
1338 1.1 petrov sabtty_abort(sc)
1339 1.1 petrov struct sabtty_softc *sc;
1340 1.1 petrov {
1341 1.1 petrov
1342 1.1 petrov if (sc->sc_flags & SABTTYF_CONS_IN) {
1343 1.1 petrov #ifdef DDB
1344 1.1 petrov cn_trap();
1345 1.1 petrov #else
1346 1.1 petrov callrom();
1347 1.1 petrov #endif
1348 1.1 petrov }
1349 1.1 petrov }
1350 1.1 petrov
1351 1.1 petrov void
1352 1.1 petrov sabtty_shutdown(vsc)
1353 1.1 petrov void *vsc;
1354 1.1 petrov {
1355 1.1 petrov struct sabtty_softc *sc = vsc;
1356 1.1 petrov
1357 1.1 petrov /* Have to put the chip back into single char mode */
1358 1.1 petrov sc->sc_flags |= SABTTYF_DONTDDB;
1359 1.1 petrov SAB_WRITE(sc, SAB_RFC, SAB_READ(sc, SAB_RFC) & ~SAB_RFC_RFDF);
1360 1.1 petrov sabtty_cec_wait(sc);
1361 1.1 petrov SAB_WRITE(sc, SAB_CMDR, SAB_CMDR_RRES);
1362 1.1 petrov sabtty_cec_wait(sc);
1363 1.1 petrov }
1364