sbjcn.c revision 1.2 1 1.2 gehenna /* $NetBSD: sbjcn.c,v 1.2 2002/09/06 13:18:43 gehenna Exp $ */
2 1.1 simonb
3 1.1 simonb /*
4 1.1 simonb * Copyright 2000, 2001
5 1.1 simonb * Broadcom Corporation. All rights reserved.
6 1.1 simonb *
7 1.1 simonb * This software is furnished under license and may be used and copied only
8 1.1 simonb * in accordance with the following terms and conditions. Subject to these
9 1.1 simonb * conditions, you may download, copy, install, use, modify and distribute
10 1.1 simonb * modified or unmodified copies of this software in source and/or binary
11 1.1 simonb * form. No title or ownership is transferred hereby.
12 1.1 simonb *
13 1.1 simonb * 1) Any source code used, modified or distributed must reproduce and
14 1.1 simonb * retain this copyright notice and list of conditions as they appear in
15 1.1 simonb * the source file.
16 1.1 simonb *
17 1.1 simonb * 2) No right is granted to use any trade name, trademark, or logo of
18 1.1 simonb * Broadcom Corporation. Neither the "Broadcom Corporation" name nor any
19 1.1 simonb * trademark or logo of Broadcom Corporation may be used to endorse or
20 1.1 simonb * promote products derived from this software without the prior written
21 1.1 simonb * permission of Broadcom Corporation.
22 1.1 simonb *
23 1.1 simonb * 3) THIS SOFTWARE IS PROVIDED "AS-IS" AND ANY EXPRESS OR IMPLIED
24 1.1 simonb * WARRANTIES, INCLUDING BUT NOT LIMITED TO, ANY IMPLIED WARRANTIES OF
25 1.1 simonb * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE, OR
26 1.1 simonb * NON-INFRINGEMENT ARE DISCLAIMED. IN NO EVENT SHALL BROADCOM BE LIABLE
27 1.1 simonb * FOR ANY DAMAGES WHATSOEVER, AND IN PARTICULAR, BROADCOM SHALL NOT BE
28 1.1 simonb * LIABLE FOR DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
29 1.1 simonb * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
30 1.1 simonb * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
31 1.1 simonb * BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
32 1.1 simonb * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
33 1.1 simonb * OR OTHERWISE), EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
34 1.1 simonb */
35 1.1 simonb
36 1.1 simonb #define SBJCN_DEBUG
37 1.1 simonb
38 1.1 simonb /* from: $NetBSD: com.c,v 1.172 2000/05/03 19:19:04 thorpej Exp */
39 1.1 simonb
40 1.1 simonb /*-
41 1.1 simonb * Copyright (c) 1998, 1999 The NetBSD Foundation, Inc.
42 1.1 simonb * All rights reserved.
43 1.1 simonb *
44 1.1 simonb * This code is derived from software contributed to The NetBSD Foundation
45 1.1 simonb * by Charles M. Hannum.
46 1.1 simonb *
47 1.1 simonb * Redistribution and use in source and binary forms, with or without
48 1.1 simonb * modification, are permitted provided that the following conditions
49 1.1 simonb * are met:
50 1.1 simonb * 1. Redistributions of source code must retain the above copyright
51 1.1 simonb * notice, this list of conditions and the following disclaimer.
52 1.1 simonb * 2. Redistributions in binary form must reproduce the above copyright
53 1.1 simonb * notice, this list of conditions and the following disclaimer in the
54 1.1 simonb * documentation and/or other materials provided with the distribution.
55 1.1 simonb * 3. All advertising materials mentioning features or use of this software
56 1.1 simonb * must display the following acknowledgement:
57 1.1 simonb * This product includes software developed by the NetBSD
58 1.1 simonb * Foundation, Inc. and its contributors.
59 1.1 simonb * 4. Neither the name of The NetBSD Foundation nor the names of its
60 1.1 simonb * contributors may be used to endorse or promote products derived
61 1.1 simonb * from this software without specific prior written permission.
62 1.1 simonb *
63 1.1 simonb * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
64 1.1 simonb * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
65 1.1 simonb * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
66 1.1 simonb * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
67 1.1 simonb * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
68 1.1 simonb * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
69 1.1 simonb * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
70 1.1 simonb * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
71 1.1 simonb * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
72 1.1 simonb * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
73 1.1 simonb * POSSIBILITY OF SUCH DAMAGE.
74 1.1 simonb */
75 1.1 simonb
76 1.1 simonb /*
77 1.1 simonb * Copyright (c) 1991 The Regents of the University of California.
78 1.1 simonb * All rights reserved.
79 1.1 simonb *
80 1.1 simonb * Redistribution and use in source and binary forms, with or without
81 1.1 simonb * modification, are permitted provided that the following conditions
82 1.1 simonb * are met:
83 1.1 simonb * 1. Redistributions of source code must retain the above copyright
84 1.1 simonb * notice, this list of conditions and the following disclaimer.
85 1.1 simonb * 2. Redistributions in binary form must reproduce the above copyright
86 1.1 simonb * notice, this list of conditions and the following disclaimer in the
87 1.1 simonb * documentation and/or other materials provided with the distribution.
88 1.1 simonb * 3. All advertising materials mentioning features or use of this software
89 1.1 simonb * must display the following acknowledgement:
90 1.1 simonb * This product includes software developed by the University of
91 1.1 simonb * California, Berkeley and its contributors.
92 1.1 simonb * 4. Neither the name of the University nor the names of its contributors
93 1.1 simonb * may be used to endorse or promote products derived from this software
94 1.1 simonb * without specific prior written permission.
95 1.1 simonb *
96 1.1 simonb * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
97 1.1 simonb * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
98 1.1 simonb * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
99 1.1 simonb * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
100 1.1 simonb * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
101 1.1 simonb * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
102 1.1 simonb * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
103 1.1 simonb * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
104 1.1 simonb * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
105 1.1 simonb * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
106 1.1 simonb * SUCH DAMAGE.
107 1.1 simonb *
108 1.1 simonb * @(#)com.c 7.5 (Berkeley) 5/16/91
109 1.1 simonb */
110 1.1 simonb
111 1.1 simonb /*
112 1.1 simonb * `sbjcn' driver, supports console over SiByte SB-1250 JTAG.
113 1.1 simonb *
114 1.1 simonb * Accesses a section of JTAG memory space to mimic a console,
115 1.1 simonb * if there's a matching program outside to communicate with.
116 1.1 simonb * If nobody is there, things will be very quiet.
117 1.1 simonb */
118 1.1 simonb
119 1.1 simonb #include "opt_ddb.h"
120 1.1 simonb
121 1.1 simonb #include <sys/param.h>
122 1.1 simonb #include <sys/systm.h>
123 1.1 simonb #include <sys/ioctl.h>
124 1.1 simonb #include <sys/select.h>
125 1.1 simonb #include <sys/tty.h>
126 1.1 simonb #include <sys/proc.h>
127 1.1 simonb #include <sys/user.h>
128 1.1 simonb #include <sys/conf.h>
129 1.1 simonb #include <sys/file.h>
130 1.1 simonb #include <sys/uio.h>
131 1.1 simonb #include <sys/kernel.h>
132 1.1 simonb #include <sys/syslog.h>
133 1.1 simonb #include <sys/types.h>
134 1.1 simonb #include <sys/device.h>
135 1.1 simonb #include <sys/malloc.h>
136 1.1 simonb #include <sys/vnode.h>
137 1.1 simonb
138 1.1 simonb #include <sbmips/dev/sbscd/sbscdvar.h>
139 1.1 simonb #include <sbmips/dev/sbscd/sbjcnvar.h>
140 1.1 simonb #include <dev/cons.h>
141 1.1 simonb #include <machine/locore.h>
142 1.1 simonb
143 1.1 simonb void sbjcn_attach_channel(struct sbjcn_softc *sc, int chan, int intr);
144 1.1 simonb static void sbjcncn_grabdword(struct sbjcn_channel *ch);
145 1.1 simonb static char sbjcncn_nextbyte(struct sbjcn_channel *ch);
146 1.1 simonb static void sbjcn_cngrabdword(void);
147 1.1 simonb
148 1.1 simonb #if defined(DDB) || defined(KGDB)
149 1.1 simonb static void sbjcn_enable_debugport(struct sbjcn_channel *ch);
150 1.1 simonb #endif
151 1.1 simonb void sbjcn_config(struct sbjcn_channel *ch);
152 1.1 simonb void sbjcn_shutdown(struct sbjcn_channel *ch);
153 1.1 simonb int sbjcn_speed(long, long *);
154 1.1 simonb static int cflag2modes(tcflag_t, u_char *, u_char *);
155 1.1 simonb int sbjcn_param(struct tty *, struct termios *);
156 1.1 simonb void sbjcn_start(struct tty *);
157 1.1 simonb int sbjcn_hwiflow(struct tty *, int);
158 1.1 simonb
159 1.1 simonb void sbjcn_loadchannelregs(struct sbjcn_channel *);
160 1.1 simonb void sbjcn_dohwiflow(struct sbjcn_channel *);
161 1.1 simonb void sbjcn_break(struct sbjcn_channel *, int);
162 1.1 simonb void sbjcn_modem(struct sbjcn_channel *, int);
163 1.1 simonb void tiocm_to_sbjcn(struct sbjcn_channel *, int, int);
164 1.1 simonb int sbjcn_to_tiocm(struct sbjcn_channel *);
165 1.1 simonb void sbjcn_iflush(struct sbjcn_channel *);
166 1.1 simonb
167 1.1 simonb int sbjcn_init(u_long addr, int chan, int rate, tcflag_t cflag);
168 1.1 simonb int sbjcn_common_getc(u_long addr, int chan);
169 1.1 simonb void sbjcn_common_putc(u_long addr, int chan, int c);
170 1.1 simonb
171 1.1 simonb int sbjcn_cngetc(dev_t dev);
172 1.1 simonb void sbjcn_cnputc(dev_t dev, int c);
173 1.1 simonb void sbjcn_cnpollc(dev_t dev, int on);
174 1.1 simonb
175 1.1 simonb extern struct cfdriver sbjcn_cd;
176 1.1 simonb
177 1.2 gehenna dev_type_open(sbjcnopen);
178 1.2 gehenna dev_type_close(sbjcnclose);
179 1.2 gehenna dev_type_read(sbjcnread);
180 1.2 gehenna dev_type_write(sbjcnwrite);
181 1.2 gehenna dev_type_ioctl(sbjcnioctl);
182 1.2 gehenna dev_type_stop(sbjcnstop);
183 1.2 gehenna dev_type_tty(sbjcntty);
184 1.2 gehenna
185 1.2 gehenna const struct cdevsw sbjcn_cdevsw = {
186 1.2 gehenna sbjcnopen, sbjcnclose, sbjcnread, sbjcnwrite, sbjcnioctl,
187 1.2 gehenna sbjcnstop, sbjcntty, nopoll, nommap, D_TTY
188 1.2 gehenna };
189 1.2 gehenna
190 1.1 simonb #define integrate static inline
191 1.1 simonb integrate void sbjcn_rxsoft(struct sbjcn_channel *, struct tty *);
192 1.1 simonb integrate void sbjcn_txsoft(struct sbjcn_channel *, struct tty *);
193 1.1 simonb integrate void sbjcn_stsoft(struct sbjcn_channel *, struct tty *);
194 1.1 simonb integrate void sbjcn_schedrx(struct sbjcn_channel *);
195 1.1 simonb integrate void sbjcn_recv(struct sbjcn_channel *ch);
196 1.1 simonb void sbjcn_diag(void *);
197 1.1 simonb void sbjcn_callout(void *);
198 1.1 simonb
199 1.1 simonb /*
200 1.1 simonb * Make this an option variable one can patch.
201 1.1 simonb * But be warned: this must be a power of 2!
202 1.1 simonb */
203 1.1 simonb u_int sbjcn_rbuf_size = SBJCN_RING_SIZE;
204 1.1 simonb
205 1.1 simonb /* Stop input when 3/4 of the ring is full; restart when only 1/4 is full. */
206 1.1 simonb u_int sbjcn_rbuf_hiwat = (SBJCN_RING_SIZE * 1) / 4;
207 1.1 simonb u_int sbjcn_rbuf_lowat = (SBJCN_RING_SIZE * 3) / 4;
208 1.1 simonb
209 1.1 simonb static int sbjcn_cons_present;
210 1.1 simonb static int sbjcn_cons_attached;
211 1.1 simonb static u_long sbjcn_cons_addr;
212 1.1 simonb static int sbjcn_cons_chan;
213 1.1 simonb static int sbjcn_cons_rate;
214 1.1 simonb static tcflag_t sbjcn_cons_cflag;
215 1.1 simonb static int sbjcn_cons_waiting_input;
216 1.1 simonb static uint64_t sbjcn_cons_input_buf;
217 1.1 simonb
218 1.1 simonb #ifdef KGDB
219 1.1 simonb #include <sys/kgdb.h>
220 1.1 simonb
221 1.1 simonb static int sbjcn_kgdb_present;
222 1.1 simonb static int sbjcn_kgdb_attached;
223 1.1 simonb static u_long sbjcn_kgdb_addr;
224 1.1 simonb static int sbjcn_kgdb_chan;
225 1.1 simonb
226 1.1 simonb int sbjcn_kgdb_getc(void *);
227 1.1 simonb void sbjcn_kgdb_putc(void *, int);
228 1.1 simonb #endif /* KGDB */
229 1.1 simonb
230 1.1 simonb static int sbjcn_match(struct device *, struct cfdata *, void *);
231 1.1 simonb static void sbjcn_attach(struct device *, struct device *, void *);
232 1.1 simonb
233 1.1 simonb const struct cfattach sbjcn_ca = {
234 1.1 simonb sizeof(struct sbjcn_softc), sbjcn_match, sbjcn_attach,
235 1.1 simonb };
236 1.1 simonb
237 1.1 simonb #define READ_REG(rp) (mips3_ld((uint64_t *)(rp)))
238 1.1 simonb #define WRITE_REG(rp, val) (mips3_sd((uint64_t *)(rp), (val)))
239 1.1 simonb
240 1.1 simonb #define JTAG_CONS_CONTROL 0x00
241 1.1 simonb #define JTAG_CONS_INPUT 0x20
242 1.1 simonb #define JTAG_CONS_OUTPUT 0x40
243 1.1 simonb #define JTAG_CONS_MAGICNUM 0x50FABEEF12349873
244 1.1 simonb
245 1.1 simonb #define jtag_input_len(data) (((data) >> 56) & 0xFF)
246 1.1 simonb
247 1.1 simonb
248 1.1 simonb static int
249 1.1 simonb sbjcn_match(struct device *parent, struct cfdata *match, void *aux)
250 1.1 simonb {
251 1.1 simonb struct sbscd_attach_args *sap = aux;
252 1.1 simonb
253 1.1 simonb if (sap->sa_locs.sa_type != SBSCD_DEVTYPE_JTAGCONS)
254 1.1 simonb return (0);
255 1.1 simonb
256 1.1 simonb return 1;
257 1.1 simonb }
258 1.1 simonb
259 1.1 simonb static void
260 1.1 simonb sbjcn_attach(struct device *parent, struct device *self, void *aux)
261 1.1 simonb {
262 1.1 simonb struct sbjcn_softc *sc = (struct sbjcn_softc *)self;
263 1.1 simonb struct sbscd_attach_args *sap = aux;
264 1.1 simonb
265 1.1 simonb sc->sc_addr = sap->sa_base + sap->sa_locs.sa_offset;
266 1.1 simonb
267 1.1 simonb printf("\n");
268 1.1 simonb sbjcn_attach_channel(sc, 0, sap->sa_locs.sa_intr[0]);
269 1.1 simonb }
270 1.1 simonb
271 1.1 simonb void
272 1.1 simonb sbjcn_attach_channel(struct sbjcn_softc *sc, int chan, int intr)
273 1.1 simonb {
274 1.1 simonb struct sbjcn_channel *ch = &sc->sc_channels[chan];
275 1.1 simonb u_long chan_addr;
276 1.1 simonb struct tty *tp;
277 1.1 simonb
278 1.1 simonb ch->ch_sc = sc;
279 1.1 simonb ch->ch_num = chan;
280 1.1 simonb
281 1.1 simonb chan_addr = sc->sc_addr + (0x100 * chan);
282 1.1 simonb ch->ch_base = (void *)MIPS_PHYS_TO_KSEG1(chan_addr);
283 1.1 simonb ch->ch_input_reg =
284 1.1 simonb (void *)MIPS_PHYS_TO_KSEG1(sc->sc_addr + JTAG_CONS_INPUT);
285 1.1 simonb ch->ch_output_reg =
286 1.1 simonb (void *)MIPS_PHYS_TO_KSEG1(sc->sc_addr + JTAG_CONS_OUTPUT);
287 1.1 simonb ch->ch_control_reg =
288 1.1 simonb (void *)MIPS_PHYS_TO_KSEG1(sc->sc_addr + JTAG_CONS_CONTROL);
289 1.1 simonb ch->ch_waiting_input = 0;
290 1.1 simonb
291 1.1 simonb ch->ch_i_dcd = ch->ch_i_dcd_pin = 0 /* XXXCGD */;
292 1.1 simonb ch->ch_i_cts = ch->ch_i_cts_pin = 0 /* XXXCGD */;
293 1.1 simonb ch->ch_i_dsr = ch->ch_i_dsr_pin = 0 /* XXXCGD */;
294 1.1 simonb ch->ch_i_ri = ch->ch_i_ri_pin = 0 /* XXXCGD */;
295 1.1 simonb ch->ch_i_mask =
296 1.1 simonb ch->ch_i_dcd | ch->ch_i_cts | ch->ch_i_dsr | ch->ch_i_ri;
297 1.1 simonb ch->ch_o_dtr = ch->ch_o_dtr_pin = 0 /* XXXCGD */;
298 1.1 simonb ch->ch_o_rts = ch->ch_o_rts_pin = 0 /* XXXCGD */;
299 1.1 simonb ch->ch_o_mask = ch->ch_o_dtr | ch->ch_o_rts;
300 1.1 simonb
301 1.1 simonb callout_init(&ch->ch_diag_callout);
302 1.1 simonb callout_init(&ch->ch_callout);
303 1.1 simonb
304 1.1 simonb /* Disable interrupts before configuring the device. */
305 1.1 simonb ch->ch_imr = 0;
306 1.1 simonb
307 1.1 simonb if (sbjcn_cons_present &&
308 1.1 simonb sbjcn_cons_addr == chan_addr && sbjcn_cons_chan == chan) {
309 1.1 simonb sbjcn_cons_attached = 1;
310 1.1 simonb
311 1.1 simonb /* Make sure the console is always "hardwired". */
312 1.1 simonb delay(1000); /* wait for output to finish */
313 1.1 simonb SET(ch->ch_hwflags, SBJCN_HW_CONSOLE);
314 1.1 simonb SET(ch->ch_swflags, TIOCFLAG_SOFTCAR);
315 1.1 simonb }
316 1.1 simonb
317 1.1 simonb tp = ttymalloc();
318 1.1 simonb tp->t_oproc = sbjcn_start;
319 1.1 simonb tp->t_param = sbjcn_param;
320 1.1 simonb tp->t_hwiflow = sbjcn_hwiflow;
321 1.1 simonb
322 1.1 simonb ch->ch_tty = tp;
323 1.1 simonb ch->ch_rbuf = malloc(sbjcn_rbuf_size << 1, M_DEVBUF, M_NOWAIT);
324 1.1 simonb if (ch->ch_rbuf == NULL) {
325 1.1 simonb printf("%s: channel %d: unable to allocate ring buffer\n",
326 1.1 simonb sc->sc_dev.dv_xname, chan);
327 1.1 simonb return;
328 1.1 simonb }
329 1.1 simonb ch->ch_ebuf = ch->ch_rbuf + (sbjcn_rbuf_size << 1);
330 1.1 simonb
331 1.1 simonb tty_attach(tp);
332 1.1 simonb
333 1.1 simonb if (ISSET(ch->ch_hwflags, SBJCN_HW_CONSOLE)) {
334 1.1 simonb int maj;
335 1.1 simonb
336 1.1 simonb /* locate the major number */
337 1.2 gehenna maj = cdevsw_lookup_major(&sbjcn_cdevsw);
338 1.1 simonb
339 1.1 simonb cn_tab->cn_dev = makedev(maj, (sc->sc_dev.dv_unit << 1) + chan);
340 1.1 simonb
341 1.1 simonb printf("%s: channel %d: console\n", sc->sc_dev.dv_xname, chan);
342 1.1 simonb }
343 1.1 simonb
344 1.1 simonb #ifdef KGDB
345 1.1 simonb /*
346 1.1 simonb * Allow kgdb to "take over" this port. If this is
347 1.1 simonb * the kgdb device, it has exclusive use.
348 1.1 simonb */
349 1.1 simonb if (sbjcn_kgdb_present &&
350 1.1 simonb sbjcn_kgdb_addr == chan_addr && sbjcn_kgdb_chan == chan) {
351 1.1 simonb sbjcn_kgdb_attached = 1;
352 1.1 simonb
353 1.1 simonb SET(ch->ch_hwflags, SBJCN_HW_KGDB);
354 1.1 simonb printf("%s: channel %d: kgdb\n", sc->sc_dev.dv_xname, chan);
355 1.1 simonb }
356 1.1 simonb #endif
357 1.1 simonb
358 1.1 simonb sbjcn_config(ch);
359 1.1 simonb
360 1.1 simonb callout_reset(&ch->ch_callout, hz/10, sbjcn_callout, ch);
361 1.1 simonb
362 1.1 simonb SET(ch->ch_hwflags, SBJCN_HW_DEV_OK);
363 1.1 simonb }
364 1.1 simonb
365 1.1 simonb int
366 1.1 simonb sbjcn_speed(long speed, long *brcp)
367 1.1 simonb {
368 1.1 simonb #define divrnd(n, q) (((n)*2/(q)+1)/2) /* divide and round off */
369 1.1 simonb
370 1.1 simonb int x, err;
371 1.1 simonb int frequency = 100000000;
372 1.1 simonb
373 1.1 simonb *brcp = divrnd(frequency / 20, speed) - 1;
374 1.1 simonb
375 1.1 simonb if (speed <= 0)
376 1.1 simonb return (-1);
377 1.1 simonb x = divrnd(frequency / 20, speed);
378 1.1 simonb if (x <= 0)
379 1.1 simonb return (-1);
380 1.1 simonb err = divrnd(((quad_t)frequency) * 1000 / 20, speed * x) - 1000;
381 1.1 simonb if (err < 0)
382 1.1 simonb err = -err;
383 1.1 simonb if (err > SBJCN_TOLERANCE)
384 1.1 simonb return (-1);
385 1.1 simonb *brcp = x - 1;
386 1.1 simonb return (0);
387 1.1 simonb
388 1.1 simonb #undef divrnd
389 1.1 simonb }
390 1.1 simonb
391 1.1 simonb #ifdef SBJCN_DEBUG
392 1.1 simonb void sbjcn_status(struct sbjcn_channel *, char *);
393 1.1 simonb
394 1.1 simonb int sbjcn_debug = 1 /* XXXCGD */;
395 1.1 simonb
396 1.1 simonb void
397 1.1 simonb sbjcn_status(struct sbjcn_channel *ch, char *str)
398 1.1 simonb {
399 1.1 simonb struct sbjcn_softc *sc = ch->ch_sc;
400 1.1 simonb struct tty *tp = ch->ch_tty;
401 1.1 simonb
402 1.1 simonb printf("%s: chan %d: %s %sclocal %sdcd %sts_carr_on %sdtr %stx_stopped\n",
403 1.1 simonb sc->sc_dev.dv_xname, ch->ch_num, str,
404 1.1 simonb ISSET(tp->t_cflag, CLOCAL) ? "+" : "-",
405 1.1 simonb ISSET(ch->ch_iports, ch->ch_i_dcd) ? "+" : "-",
406 1.1 simonb ISSET(tp->t_state, TS_CARR_ON) ? "+" : "-",
407 1.1 simonb ISSET(ch->ch_oports, ch->ch_o_dtr) ? "+" : "-",
408 1.1 simonb ch->ch_tx_stopped ? "+" : "-");
409 1.1 simonb
410 1.1 simonb printf("%s: chan %d: %s %scrtscts %scts %sts_ttstop %srts %xrx_flags\n",
411 1.1 simonb sc->sc_dev.dv_xname, ch->ch_num, str,
412 1.1 simonb ISSET(tp->t_cflag, CRTSCTS) ? "+" : "-",
413 1.1 simonb ISSET(ch->ch_iports, ch->ch_i_cts) ? "+" : "-",
414 1.1 simonb ISSET(tp->t_state, TS_TTSTOP) ? "+" : "-",
415 1.1 simonb ISSET(ch->ch_oports, ch->ch_o_rts) ? "+" : "-",
416 1.1 simonb ch->ch_rx_flags);
417 1.1 simonb }
418 1.1 simonb #endif
419 1.1 simonb
420 1.1 simonb #if defined(DDB) || defined(KGDB)
421 1.1 simonb static void
422 1.1 simonb sbjcn_enable_debugport(struct sbjcn_channel *ch)
423 1.1 simonb {
424 1.1 simonb int s;
425 1.1 simonb
426 1.1 simonb /* Turn on line break interrupt, set carrier. */
427 1.1 simonb s = splserial();
428 1.1 simonb
429 1.1 simonb ch->ch_imr = 0x04;
430 1.1 simonb SET(ch->ch_oports, ch->ch_o_dtr | ch->ch_o_rts);
431 1.1 simonb
432 1.1 simonb splx(s);
433 1.1 simonb }
434 1.1 simonb #endif
435 1.1 simonb
436 1.1 simonb void
437 1.1 simonb sbjcn_config(struct sbjcn_channel *ch)
438 1.1 simonb {
439 1.1 simonb
440 1.1 simonb /* Disable interrupts before configuring the device. */
441 1.1 simonb ch->ch_imr = 0x00;
442 1.1 simonb
443 1.1 simonb #ifdef DDB
444 1.1 simonb if (ISSET(ch->ch_hwflags, SBJCN_HW_CONSOLE))
445 1.1 simonb sbjcn_enable_debugport(ch);
446 1.1 simonb #endif
447 1.1 simonb
448 1.1 simonb #ifdef KGDB
449 1.1 simonb /*
450 1.1 simonb * Allow kgdb to "take over" this port. If this is
451 1.1 simonb * the kgdb device, it has exclusive use.
452 1.1 simonb */
453 1.1 simonb if (ISSET(ch->ch_hwflags, SBJCN_HW_KGDB))
454 1.1 simonb sbjcn_enable_debugport(ch);
455 1.1 simonb #endif
456 1.1 simonb }
457 1.1 simonb
458 1.1 simonb void
459 1.1 simonb sbjcn_shutdown(struct sbjcn_channel *ch)
460 1.1 simonb {
461 1.1 simonb struct tty *tp = ch->ch_tty;
462 1.1 simonb int s;
463 1.1 simonb
464 1.1 simonb s = splserial();
465 1.1 simonb
466 1.1 simonb /* If we were asserting flow control, then deassert it. */
467 1.1 simonb SET(ch->ch_rx_flags, RX_IBUF_BLOCKED);
468 1.1 simonb sbjcn_dohwiflow(ch);
469 1.1 simonb
470 1.1 simonb /* Clear any break condition set with TIOCSBRK. */
471 1.1 simonb sbjcn_break(ch, 0);
472 1.1 simonb
473 1.1 simonb /*
474 1.1 simonb * Hang up if necessary. Wait a bit, so the other side has time to
475 1.1 simonb * notice even if we immediately open the port again.
476 1.1 simonb */
477 1.1 simonb if (ISSET(tp->t_cflag, HUPCL)) {
478 1.1 simonb sbjcn_modem(ch, 0);
479 1.1 simonb (void) tsleep(ch, TTIPRI, ttclos, hz);
480 1.1 simonb }
481 1.1 simonb
482 1.1 simonb /* Turn off interrupts. */
483 1.1 simonb #ifdef DDB
484 1.1 simonb if (ISSET(ch->ch_hwflags, SBJCN_HW_CONSOLE))
485 1.1 simonb ch->ch_imr = 0x04; /* interrupt on break */
486 1.1 simonb else
487 1.1 simonb #endif
488 1.1 simonb ch->ch_imr = 0;
489 1.1 simonb
490 1.1 simonb splx(s);
491 1.1 simonb }
492 1.1 simonb
493 1.1 simonb int
494 1.1 simonb sbjcnopen(dev_t dev, int flag, int mode, struct proc *p)
495 1.1 simonb {
496 1.1 simonb int unit = SBJCN_UNIT(dev);
497 1.1 simonb int chan = SBJCN_CHAN(dev);
498 1.1 simonb struct sbjcn_softc *sc;
499 1.1 simonb struct sbjcn_channel *ch;
500 1.1 simonb struct tty *tp;
501 1.1 simonb int s, s2;
502 1.1 simonb int error;
503 1.1 simonb
504 1.1 simonb if (unit >= sbjcn_cd.cd_ndevs)
505 1.1 simonb return (ENXIO);
506 1.1 simonb sc = sbjcn_cd.cd_devs[unit];
507 1.1 simonb if (sc == 0)
508 1.1 simonb return (ENXIO);
509 1.1 simonb ch = &sc->sc_channels[chan];
510 1.1 simonb if (!ISSET(ch->ch_hwflags, SBJCN_HW_DEV_OK) || ch->ch_rbuf == NULL)
511 1.1 simonb return (ENXIO);
512 1.1 simonb
513 1.1 simonb #ifdef KGDB
514 1.1 simonb /*
515 1.1 simonb * If this is the kgdb port, no other use is permitted.
516 1.1 simonb */
517 1.1 simonb if (ISSET(ch->ch_hwflags, SBJCN_HW_KGDB))
518 1.1 simonb return (EBUSY);
519 1.1 simonb #endif
520 1.1 simonb
521 1.1 simonb tp = ch->ch_tty;
522 1.1 simonb
523 1.1 simonb if (ISSET(tp->t_state, TS_ISOPEN) &&
524 1.1 simonb ISSET(tp->t_state, TS_XCLUDE) &&
525 1.1 simonb p->p_ucred->cr_uid != 0)
526 1.1 simonb return (EBUSY);
527 1.1 simonb
528 1.1 simonb s = spltty();
529 1.1 simonb
530 1.1 simonb /*
531 1.1 simonb * Do the following iff this is a first open.
532 1.1 simonb */
533 1.1 simonb if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
534 1.1 simonb struct termios t;
535 1.1 simonb
536 1.1 simonb tp->t_dev = dev;
537 1.1 simonb
538 1.1 simonb s2 = splserial();
539 1.1 simonb
540 1.1 simonb /* Turn on receive, break, and status change interrupts. */
541 1.1 simonb ch->ch_imr = 0xe;
542 1.1 simonb
543 1.1 simonb /* Fetch the current modem control status, needed later. */
544 1.1 simonb ch->ch_iports = 0;
545 1.1 simonb ch->ch_iports_delta = 0;
546 1.1 simonb splx(s2);
547 1.1 simonb
548 1.1 simonb /*
549 1.1 simonb * Initialize the termios status to the defaults. Add in the
550 1.1 simonb * sticky bits from TIOCSFLAGS.
551 1.1 simonb */
552 1.1 simonb t.c_ispeed = 0;
553 1.1 simonb if (ISSET(ch->ch_hwflags, SBJCN_HW_CONSOLE)) {
554 1.1 simonb t.c_ospeed = sbjcn_cons_rate;
555 1.1 simonb t.c_cflag = sbjcn_cons_cflag;
556 1.1 simonb } else {
557 1.1 simonb t.c_ospeed = TTYDEF_SPEED;
558 1.1 simonb t.c_cflag = TTYDEF_CFLAG;
559 1.1 simonb }
560 1.1 simonb if (ISSET(ch->ch_swflags, TIOCFLAG_CLOCAL))
561 1.1 simonb SET(t.c_cflag, CLOCAL);
562 1.1 simonb if (ISSET(ch->ch_swflags, TIOCFLAG_CRTSCTS))
563 1.1 simonb SET(t.c_cflag, CRTSCTS);
564 1.1 simonb if (ISSET(ch->ch_swflags, TIOCFLAG_MDMBUF))
565 1.1 simonb SET(t.c_cflag, MDMBUF);
566 1.1 simonb /* Make sure sbjcn_param() will do something. */
567 1.1 simonb tp->t_ospeed = 0;
568 1.1 simonb (void) sbjcn_param(tp, &t);
569 1.1 simonb tp->t_iflag = TTYDEF_IFLAG;
570 1.1 simonb tp->t_oflag = TTYDEF_OFLAG;
571 1.1 simonb tp->t_lflag = TTYDEF_LFLAG;
572 1.1 simonb ttychars(tp);
573 1.1 simonb ttsetwater(tp);
574 1.1 simonb
575 1.1 simonb s2 = splserial();
576 1.1 simonb
577 1.1 simonb /*
578 1.1 simonb * Turn on DTR. We must always do this, even if carrier is not
579 1.1 simonb * present, because otherwise we'd have to use TIOCSDTR
580 1.1 simonb * immediately after setting CLOCAL, which applications do not
581 1.1 simonb * expect. We always assert DTR while the device is open
582 1.1 simonb * unless explicitly requested to deassert it.
583 1.1 simonb */
584 1.1 simonb sbjcn_modem(ch, 1);
585 1.1 simonb
586 1.1 simonb /* Clear the input ring, and unblock. */
587 1.1 simonb ch->ch_rbput = ch->ch_rbget = ch->ch_rbuf;
588 1.1 simonb ch->ch_rbavail = sbjcn_rbuf_size;
589 1.1 simonb sbjcn_iflush(ch);
590 1.1 simonb CLR(ch->ch_rx_flags, RX_ANY_BLOCK);
591 1.1 simonb sbjcn_dohwiflow(ch);
592 1.1 simonb
593 1.1 simonb #ifdef SBJCN_DEBUG
594 1.1 simonb if (sbjcn_debug)
595 1.1 simonb sbjcn_status(ch, "sbjcnopen ");
596 1.1 simonb #endif
597 1.1 simonb
598 1.1 simonb splx(s2);
599 1.1 simonb }
600 1.1 simonb
601 1.1 simonb splx(s);
602 1.1 simonb
603 1.1 simonb error = ttyopen(tp, SBJCN_DIALOUT(dev), ISSET(flag, O_NONBLOCK));
604 1.1 simonb if (error)
605 1.1 simonb goto bad;
606 1.1 simonb
607 1.1 simonb error = (*tp->t_linesw->l_open)(dev, tp);
608 1.1 simonb if (error)
609 1.1 simonb goto bad;
610 1.1 simonb
611 1.1 simonb return (0);
612 1.1 simonb
613 1.1 simonb bad:
614 1.1 simonb if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
615 1.1 simonb /*
616 1.1 simonb * We failed to open the device, and nobody else had it opened.
617 1.1 simonb * Clean up the state as appropriate.
618 1.1 simonb */
619 1.1 simonb sbjcn_shutdown(ch);
620 1.1 simonb }
621 1.1 simonb
622 1.1 simonb return (error);
623 1.1 simonb }
624 1.1 simonb
625 1.1 simonb int
626 1.1 simonb sbjcnclose(dev_t dev, int flag, int mode, struct proc *p)
627 1.1 simonb {
628 1.1 simonb struct sbjcn_softc *sc = sbjcn_cd.cd_devs[SBJCN_UNIT(dev)];
629 1.1 simonb struct sbjcn_channel *ch = &sc->sc_channels[SBJCN_CHAN(dev)];
630 1.1 simonb struct tty *tp = ch->ch_tty;
631 1.1 simonb
632 1.1 simonb /* XXX This is for cons.c. */
633 1.1 simonb if (!ISSET(tp->t_state, TS_ISOPEN))
634 1.1 simonb return (0);
635 1.1 simonb
636 1.1 simonb (*tp->t_linesw->l_close)(tp, flag);
637 1.1 simonb ttyclose(tp);
638 1.1 simonb
639 1.1 simonb if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
640 1.1 simonb /*
641 1.1 simonb * Although we got a last close, the device may still be in
642 1.1 simonb * use; e.g. if this was the dialout node, and there are still
643 1.1 simonb * processes waiting for carrier on the non-dialout node.
644 1.1 simonb */
645 1.1 simonb sbjcn_shutdown(ch);
646 1.1 simonb }
647 1.1 simonb
648 1.1 simonb return (0);
649 1.1 simonb }
650 1.1 simonb
651 1.1 simonb int
652 1.1 simonb sbjcnread(dev_t dev, struct uio *uio, int flag)
653 1.1 simonb {
654 1.1 simonb struct sbjcn_softc *sc = sbjcn_cd.cd_devs[SBJCN_UNIT(dev)];
655 1.1 simonb struct sbjcn_channel *ch = &sc->sc_channels[SBJCN_CHAN(dev)];
656 1.1 simonb struct tty *tp = ch->ch_tty;
657 1.1 simonb
658 1.1 simonb return ((*tp->t_linesw->l_read)(tp, uio, flag));
659 1.1 simonb }
660 1.1 simonb
661 1.1 simonb int
662 1.1 simonb sbjcnwrite(dev_t dev, struct uio *uio, int flag)
663 1.1 simonb {
664 1.1 simonb struct sbjcn_softc *sc = sbjcn_cd.cd_devs[SBJCN_UNIT(dev)];
665 1.1 simonb struct sbjcn_channel *ch = &sc->sc_channels[SBJCN_CHAN(dev)];
666 1.1 simonb struct tty *tp = ch->ch_tty;
667 1.1 simonb
668 1.1 simonb return ((*tp->t_linesw->l_write)(tp, uio, flag));
669 1.1 simonb }
670 1.1 simonb
671 1.1 simonb struct tty *
672 1.1 simonb sbjcntty(dev_t dev)
673 1.1 simonb {
674 1.1 simonb struct sbjcn_softc *sc = sbjcn_cd.cd_devs[SBJCN_UNIT(dev)];
675 1.1 simonb struct sbjcn_channel *ch = &sc->sc_channels[SBJCN_CHAN(dev)];
676 1.1 simonb struct tty *tp = ch->ch_tty;
677 1.1 simonb
678 1.1 simonb return (tp);
679 1.1 simonb }
680 1.1 simonb
681 1.1 simonb int
682 1.1 simonb sbjcnioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
683 1.1 simonb {
684 1.1 simonb struct sbjcn_softc *sc = sbjcn_cd.cd_devs[SBJCN_UNIT(dev)];
685 1.1 simonb struct sbjcn_channel *ch = &sc->sc_channels[SBJCN_CHAN(dev)];
686 1.1 simonb struct tty *tp = ch->ch_tty;
687 1.1 simonb int error;
688 1.1 simonb int s;
689 1.1 simonb
690 1.1 simonb error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flag, p);
691 1.1 simonb if (error >= 0)
692 1.1 simonb return (error);
693 1.1 simonb
694 1.1 simonb error = ttioctl(tp, cmd, data, flag, p);
695 1.1 simonb if (error >= 0)
696 1.1 simonb return (error);
697 1.1 simonb
698 1.1 simonb error = 0;
699 1.1 simonb
700 1.1 simonb s = splserial();
701 1.1 simonb
702 1.1 simonb switch (cmd) {
703 1.1 simonb case TIOCSBRK:
704 1.1 simonb sbjcn_break(ch, 1);
705 1.1 simonb break;
706 1.1 simonb
707 1.1 simonb case TIOCCBRK:
708 1.1 simonb sbjcn_break(ch, 0);
709 1.1 simonb break;
710 1.1 simonb
711 1.1 simonb case TIOCSDTR:
712 1.1 simonb sbjcn_modem(ch, 1);
713 1.1 simonb break;
714 1.1 simonb
715 1.1 simonb case TIOCCDTR:
716 1.1 simonb sbjcn_modem(ch, 0);
717 1.1 simonb break;
718 1.1 simonb
719 1.1 simonb case TIOCGFLAGS:
720 1.1 simonb *(int *)data = ch->ch_swflags;
721 1.1 simonb break;
722 1.1 simonb
723 1.1 simonb case TIOCSFLAGS:
724 1.1 simonb error = suser(p->p_ucred, &p->p_acflag);
725 1.1 simonb if (error)
726 1.1 simonb break;
727 1.1 simonb ch->ch_swflags = *(int *)data;
728 1.1 simonb break;
729 1.1 simonb
730 1.1 simonb case TIOCMSET:
731 1.1 simonb case TIOCMBIS:
732 1.1 simonb case TIOCMBIC:
733 1.1 simonb tiocm_to_sbjcn(ch, cmd, *(int *)data);
734 1.1 simonb break;
735 1.1 simonb
736 1.1 simonb case TIOCMGET:
737 1.1 simonb *(int *)data = sbjcn_to_tiocm(ch);
738 1.1 simonb break;
739 1.1 simonb
740 1.1 simonb default:
741 1.1 simonb error = ENOTTY;
742 1.1 simonb break;
743 1.1 simonb }
744 1.1 simonb
745 1.1 simonb splx(s);
746 1.1 simonb
747 1.1 simonb #ifdef SBJCN_DEBUG
748 1.1 simonb if (sbjcn_debug)
749 1.1 simonb sbjcn_status(ch, "sbjcn_ioctl ");
750 1.1 simonb #endif
751 1.1 simonb
752 1.1 simonb return (error);
753 1.1 simonb }
754 1.1 simonb
755 1.1 simonb integrate void
756 1.1 simonb sbjcn_schedrx(struct sbjcn_channel *ch)
757 1.1 simonb {
758 1.1 simonb
759 1.1 simonb ch->ch_rx_ready = 1;
760 1.1 simonb
761 1.1 simonb /* Next callout will detect this flag. */
762 1.1 simonb }
763 1.1 simonb
764 1.1 simonb void
765 1.1 simonb sbjcn_break(struct sbjcn_channel *ch, int onoff)
766 1.1 simonb {
767 1.1 simonb /* XXXKW do something? */
768 1.1 simonb }
769 1.1 simonb
770 1.1 simonb void
771 1.1 simonb sbjcn_modem(struct sbjcn_channel *ch, int onoff)
772 1.1 simonb {
773 1.1 simonb
774 1.1 simonb if (ch->ch_o_dtr == 0)
775 1.1 simonb return;
776 1.1 simonb
777 1.1 simonb if (onoff)
778 1.1 simonb SET(ch->ch_oports, ch->ch_o_dtr);
779 1.1 simonb else
780 1.1 simonb CLR(ch->ch_oports, ch->ch_o_dtr);
781 1.1 simonb
782 1.1 simonb if (!ch->ch_heldchange) {
783 1.1 simonb if (ch->ch_tx_busy) {
784 1.1 simonb ch->ch_heldtbc = ch->ch_tbc;
785 1.1 simonb ch->ch_tbc = 0;
786 1.1 simonb ch->ch_heldchange = 1;
787 1.1 simonb } else
788 1.1 simonb sbjcn_loadchannelregs(ch);
789 1.1 simonb }
790 1.1 simonb }
791 1.1 simonb
792 1.1 simonb void
793 1.1 simonb tiocm_to_sbjcn(struct sbjcn_channel *ch, int how, int ttybits)
794 1.1 simonb {
795 1.1 simonb u_char bits;
796 1.1 simonb
797 1.1 simonb bits = 0;
798 1.1 simonb if (ISSET(ttybits, TIOCM_DTR))
799 1.1 simonb SET(bits, ch->ch_o_dtr);
800 1.1 simonb if (ISSET(ttybits, TIOCM_RTS))
801 1.1 simonb SET(bits, ch->ch_o_rts);
802 1.1 simonb
803 1.1 simonb switch (how) {
804 1.1 simonb case TIOCMBIC:
805 1.1 simonb CLR(ch->ch_oports, bits);
806 1.1 simonb break;
807 1.1 simonb
808 1.1 simonb case TIOCMBIS:
809 1.1 simonb SET(ch->ch_oports, bits);
810 1.1 simonb break;
811 1.1 simonb
812 1.1 simonb case TIOCMSET:
813 1.1 simonb ch->ch_oports = bits;
814 1.1 simonb break;
815 1.1 simonb }
816 1.1 simonb
817 1.1 simonb if (!ch->ch_heldchange) {
818 1.1 simonb if (ch->ch_tx_busy) {
819 1.1 simonb ch->ch_heldtbc = ch->ch_tbc;
820 1.1 simonb ch->ch_tbc = 0;
821 1.1 simonb ch->ch_heldchange = 1;
822 1.1 simonb } else
823 1.1 simonb sbjcn_loadchannelregs(ch);
824 1.1 simonb }
825 1.1 simonb }
826 1.1 simonb
827 1.1 simonb int
828 1.1 simonb sbjcn_to_tiocm(struct sbjcn_channel *ch)
829 1.1 simonb {
830 1.1 simonb u_char hwbits;
831 1.1 simonb int ttybits = 0;
832 1.1 simonb
833 1.1 simonb hwbits = ch->ch_oports;
834 1.1 simonb if (ISSET(hwbits, ch->ch_o_dtr))
835 1.1 simonb SET(ttybits, TIOCM_DTR);
836 1.1 simonb if (ISSET(hwbits, ch->ch_o_rts))
837 1.1 simonb SET(ttybits, TIOCM_RTS);
838 1.1 simonb
839 1.1 simonb hwbits = ch->ch_iports;
840 1.1 simonb if (ISSET(hwbits, ch->ch_i_dcd))
841 1.1 simonb SET(ttybits, TIOCM_CD);
842 1.1 simonb if (ISSET(hwbits, ch->ch_i_cts))
843 1.1 simonb SET(ttybits, TIOCM_CTS);
844 1.1 simonb if (ISSET(hwbits, ch->ch_i_dsr))
845 1.1 simonb SET(ttybits, TIOCM_DSR);
846 1.1 simonb if (ISSET(hwbits, ch->ch_i_ri))
847 1.1 simonb SET(ttybits, TIOCM_RI);
848 1.1 simonb
849 1.1 simonb if (ch->ch_imr != 0)
850 1.1 simonb SET(ttybits, TIOCM_LE);
851 1.1 simonb
852 1.1 simonb return (ttybits);
853 1.1 simonb }
854 1.1 simonb
855 1.1 simonb static int
856 1.1 simonb cflag2modes(cflag, mode1p, mode2p)
857 1.1 simonb tcflag_t cflag;
858 1.1 simonb u_char *mode1p;
859 1.1 simonb u_char *mode2p;
860 1.1 simonb {
861 1.1 simonb u_char mode1;
862 1.1 simonb u_char mode2;
863 1.1 simonb int err = 0;
864 1.1 simonb
865 1.1 simonb mode1 = mode2 = 0;
866 1.1 simonb
867 1.1 simonb switch (ISSET(cflag, CSIZE)) {
868 1.1 simonb case CS7:
869 1.1 simonb mode1 |= 2; /* XXX */
870 1.1 simonb break;
871 1.1 simonb default:
872 1.1 simonb err = -1;
873 1.1 simonb /* FALLTHRU for sanity */
874 1.1 simonb case CS8:
875 1.1 simonb mode1 |= 3; /* XXX */
876 1.1 simonb break;
877 1.1 simonb }
878 1.1 simonb if (!ISSET(cflag, PARENB))
879 1.1 simonb mode1 |= 2 << 3;
880 1.1 simonb else {
881 1.1 simonb mode1 |= 0 << 3;
882 1.1 simonb if (ISSET(cflag, PARODD))
883 1.1 simonb mode1 |= 1 << 2;
884 1.1 simonb }
885 1.1 simonb
886 1.1 simonb if (ISSET(cflag, CSTOPB))
887 1.1 simonb mode2 |= 1 << 3; /* two stop bits XXX not std */
888 1.1 simonb
889 1.1 simonb if (ISSET(cflag, CRTSCTS)) {
890 1.1 simonb mode1 |= 1 << 7;
891 1.1 simonb mode2 |= 1 << 4;
892 1.1 simonb }
893 1.1 simonb
894 1.1 simonb *mode1p = mode1;
895 1.1 simonb *mode2p = mode2;
896 1.1 simonb return (err);
897 1.1 simonb }
898 1.1 simonb
899 1.1 simonb int
900 1.1 simonb sbjcn_param(struct tty *tp, struct termios *t)
901 1.1 simonb {
902 1.1 simonb struct sbjcn_softc *sc = sbjcn_cd.cd_devs[SBJCN_UNIT(tp->t_dev)];
903 1.1 simonb struct sbjcn_channel *ch = &sc->sc_channels[SBJCN_CHAN(tp->t_dev)];
904 1.1 simonb long brc;
905 1.1 simonb u_char mode1, mode2;
906 1.1 simonb int s;
907 1.1 simonb
908 1.1 simonb /* XXX reset to console parameters if console? */
909 1.1 simonb #if 0
910 1.1 simonb XXX disable, enable.
911 1.1 simonb #endif
912 1.1 simonb
913 1.1 simonb /* Check requested parameters. */
914 1.1 simonb if (sbjcn_speed(t->c_ospeed, &brc) < 0)
915 1.1 simonb return (EINVAL);
916 1.1 simonb if (t->c_ispeed && t->c_ispeed != t->c_ospeed)
917 1.1 simonb return (EINVAL);
918 1.1 simonb
919 1.1 simonb /*
920 1.1 simonb * For the console, always force CLOCAL and !HUPCL, so that the port
921 1.1 simonb * is always active.
922 1.1 simonb */
923 1.1 simonb if (ISSET(ch->ch_swflags, TIOCFLAG_SOFTCAR) ||
924 1.1 simonb ISSET(ch->ch_hwflags, SBJCN_HW_CONSOLE)) {
925 1.1 simonb SET(t->c_cflag, CLOCAL);
926 1.1 simonb CLR(t->c_cflag, HUPCL);
927 1.1 simonb }
928 1.1 simonb
929 1.1 simonb /*
930 1.1 simonb * If there were no changes, don't do anything. This avoids dropping
931 1.1 simonb * input and improves performance when all we did was frob things like
932 1.1 simonb * VMIN and VTIME.
933 1.1 simonb */
934 1.1 simonb if (tp->t_ospeed == t->c_ospeed &&
935 1.1 simonb tp->t_cflag == t->c_cflag)
936 1.1 simonb return (0);
937 1.1 simonb
938 1.1 simonb if (cflag2modes(t->c_cflag, &mode1, &mode2) < 0)
939 1.1 simonb return (EINVAL);
940 1.1 simonb
941 1.1 simonb s = splserial();
942 1.1 simonb
943 1.1 simonb ch->ch_mode1 = mode1;
944 1.1 simonb ch->ch_mode2 = mode2;
945 1.1 simonb
946 1.1 simonb /*
947 1.1 simonb * If we're not in a mode that assumes a connection is present, then
948 1.1 simonb * ignore carrier changes.
949 1.1 simonb */
950 1.1 simonb if (ISSET(t->c_cflag, CLOCAL | MDMBUF))
951 1.1 simonb ch->ch_i_dcd = 0;
952 1.1 simonb else
953 1.1 simonb ch->ch_i_dcd = ch->ch_i_dcd_pin;
954 1.1 simonb /*
955 1.1 simonb * Set the flow control pins depending on the current flow control
956 1.1 simonb * mode.
957 1.1 simonb */
958 1.1 simonb if (ISSET(t->c_cflag, CRTSCTS)) {
959 1.1 simonb ch->ch_o_dtr = ch->ch_o_dtr_pin;
960 1.1 simonb ch->ch_o_rts = ch->ch_o_rts_pin;
961 1.1 simonb ch->ch_i_cts = ch->ch_i_cts_pin;
962 1.1 simonb /* hw controle enable bits in mod regs set by cflag2modes */
963 1.1 simonb } else if (ISSET(t->c_cflag, MDMBUF)) {
964 1.1 simonb /*
965 1.1 simonb * For DTR/DCD flow control, make sure we don't toggle DTR for
966 1.1 simonb * carrier detection.
967 1.1 simonb */
968 1.1 simonb ch->ch_o_dtr = 0;
969 1.1 simonb ch->ch_o_rts = ch->ch_o_dtr_pin;
970 1.1 simonb ch->ch_i_cts = ch->ch_i_dcd_pin;
971 1.1 simonb } else {
972 1.1 simonb /*
973 1.1 simonb * If no flow control, then always set RTS. This will make
974 1.1 simonb * the other side happy if it mistakenly thinks we're doing
975 1.1 simonb * RTS/CTS flow control.
976 1.1 simonb */
977 1.1 simonb ch->ch_o_dtr = ch->ch_o_dtr_pin | ch->ch_o_rts_pin;
978 1.1 simonb ch->ch_o_rts = 0;
979 1.1 simonb ch->ch_i_cts = 0;
980 1.1 simonb if (ISSET(ch->ch_oports, ch->ch_o_dtr_pin))
981 1.1 simonb SET(ch->ch_oports, ch->ch_o_rts_pin);
982 1.1 simonb else
983 1.1 simonb CLR(ch->ch_oports, ch->ch_o_rts_pin);
984 1.1 simonb }
985 1.1 simonb /* XXX maybe mask the ports which generate intrs? */
986 1.1 simonb
987 1.1 simonb ch->ch_brc = brc;
988 1.1 simonb
989 1.1 simonb /* XXX maybe set fifo-full receive mode if RTSCTS and high speed? */
990 1.1 simonb
991 1.1 simonb /* And copy to tty. */
992 1.1 simonb tp->t_ispeed = 0;
993 1.1 simonb tp->t_ospeed = t->c_ospeed;
994 1.1 simonb tp->t_cflag = t->c_cflag;
995 1.1 simonb
996 1.1 simonb if (!ch->ch_heldchange) {
997 1.1 simonb if (ch->ch_tx_busy) {
998 1.1 simonb ch->ch_heldtbc = ch->ch_tbc;
999 1.1 simonb ch->ch_tbc = 0;
1000 1.1 simonb ch->ch_heldchange = 1;
1001 1.1 simonb } else
1002 1.1 simonb sbjcn_loadchannelregs(ch);
1003 1.1 simonb }
1004 1.1 simonb
1005 1.1 simonb if (!ISSET(t->c_cflag, CHWFLOW)) {
1006 1.1 simonb /* Disable the high water mark. */
1007 1.1 simonb ch->ch_r_hiwat = 0;
1008 1.1 simonb ch->ch_r_lowat = 0;
1009 1.1 simonb if (ISSET(ch->ch_rx_flags, RX_TTY_OVERFLOWED)) {
1010 1.1 simonb CLR(ch->ch_rx_flags, RX_TTY_OVERFLOWED);
1011 1.1 simonb sbjcn_schedrx(ch);
1012 1.1 simonb }
1013 1.1 simonb if (ISSET(ch->ch_rx_flags, RX_TTY_BLOCKED|RX_IBUF_BLOCKED)) {
1014 1.1 simonb CLR(ch->ch_rx_flags, RX_TTY_BLOCKED|RX_IBUF_BLOCKED);
1015 1.1 simonb sbjcn_dohwiflow(ch);
1016 1.1 simonb }
1017 1.1 simonb } else {
1018 1.1 simonb ch->ch_r_hiwat = sbjcn_rbuf_hiwat;
1019 1.1 simonb ch->ch_r_lowat = sbjcn_rbuf_lowat;
1020 1.1 simonb }
1021 1.1 simonb
1022 1.1 simonb splx(s);
1023 1.1 simonb
1024 1.1 simonb /*
1025 1.1 simonb * Update the tty layer's idea of the carrier bit, in case we changed
1026 1.1 simonb * CLOCAL or MDMBUF. We don't hang up here; we only do that by
1027 1.1 simonb * explicit request.
1028 1.1 simonb */
1029 1.1 simonb (void) (*tp->t_linesw->l_modem)(tp,
1030 1.1 simonb ISSET(ch->ch_iports, ch->ch_i_dcd));
1031 1.1 simonb
1032 1.1 simonb #ifdef SBJCN_DEBUG
1033 1.1 simonb if (sbjcn_debug)
1034 1.1 simonb sbjcn_status(ch, "sbjcnparam ");
1035 1.1 simonb #endif
1036 1.1 simonb
1037 1.1 simonb if (!ISSET(t->c_cflag, CHWFLOW)) {
1038 1.1 simonb if (ch->ch_tx_stopped) {
1039 1.1 simonb ch->ch_tx_stopped = 0;
1040 1.1 simonb sbjcn_start(tp);
1041 1.1 simonb }
1042 1.1 simonb }
1043 1.1 simonb
1044 1.1 simonb return (0);
1045 1.1 simonb }
1046 1.1 simonb
1047 1.1 simonb void
1048 1.1 simonb sbjcn_iflush(struct sbjcn_channel *ch)
1049 1.1 simonb {
1050 1.1 simonb uint64_t reg;
1051 1.1 simonb int timo;
1052 1.1 simonb
1053 1.1 simonb timo = 50000;
1054 1.1 simonb /* flush any pending I/O */
1055 1.1 simonb while (((reg = READ_REG(ch->ch_input_reg)) != 0) && --timo)
1056 1.1 simonb ;
1057 1.1 simonb
1058 1.1 simonb #ifdef DIAGNOSTIC
1059 1.1 simonb if (!timo)
1060 1.1 simonb printf("%s: sbjcn_iflush timeout %02x\n",
1061 1.1 simonb ch->ch_sc->sc_dev.dv_xname, reg);
1062 1.1 simonb #endif
1063 1.1 simonb }
1064 1.1 simonb
1065 1.1 simonb void
1066 1.1 simonb sbjcn_loadchannelregs(struct sbjcn_channel *ch)
1067 1.1 simonb {
1068 1.1 simonb }
1069 1.1 simonb
1070 1.1 simonb int
1071 1.1 simonb sbjcn_hwiflow(struct tty *tp, int block)
1072 1.1 simonb {
1073 1.1 simonb struct sbjcn_softc *sc = sbjcn_cd.cd_devs[SBJCN_UNIT(tp->t_dev)];
1074 1.1 simonb struct sbjcn_channel *ch = &sc->sc_channels[SBJCN_CHAN(tp->t_dev)];
1075 1.1 simonb int s;
1076 1.1 simonb
1077 1.1 simonb if (ch->ch_o_rts == 0)
1078 1.1 simonb return (0);
1079 1.1 simonb
1080 1.1 simonb s = splserial();
1081 1.1 simonb if (block) {
1082 1.1 simonb if (!ISSET(ch->ch_rx_flags, RX_TTY_BLOCKED)) {
1083 1.1 simonb SET(ch->ch_rx_flags, RX_TTY_BLOCKED);
1084 1.1 simonb sbjcn_dohwiflow(ch);
1085 1.1 simonb }
1086 1.1 simonb } else {
1087 1.1 simonb if (ISSET(ch->ch_rx_flags, RX_TTY_OVERFLOWED)) {
1088 1.1 simonb CLR(ch->ch_rx_flags, RX_TTY_OVERFLOWED);
1089 1.1 simonb sbjcn_schedrx(ch);
1090 1.1 simonb }
1091 1.1 simonb if (ISSET(ch->ch_rx_flags, RX_TTY_BLOCKED)) {
1092 1.1 simonb CLR(ch->ch_rx_flags, RX_TTY_BLOCKED);
1093 1.1 simonb sbjcn_dohwiflow(ch);
1094 1.1 simonb }
1095 1.1 simonb }
1096 1.1 simonb splx(s);
1097 1.1 simonb return (1);
1098 1.1 simonb }
1099 1.1 simonb
1100 1.1 simonb /*
1101 1.1 simonb * (un)block input via hw flowcontrol
1102 1.1 simonb */
1103 1.1 simonb void
1104 1.1 simonb sbjcn_dohwiflow(struct sbjcn_channel *ch)
1105 1.1 simonb {
1106 1.1 simonb
1107 1.1 simonb if (ch->ch_o_rts == 0)
1108 1.1 simonb return;
1109 1.1 simonb
1110 1.1 simonb if (ISSET(ch->ch_rx_flags, RX_ANY_BLOCK)) {
1111 1.1 simonb CLR(ch->ch_oports, ch->ch_o_rts);
1112 1.1 simonb CLR(ch->ch_oports_active, ch->ch_o_rts);
1113 1.1 simonb } else {
1114 1.1 simonb SET(ch->ch_oports, ch->ch_o_rts);
1115 1.1 simonb SET(ch->ch_oports_active, ch->ch_o_rts);
1116 1.1 simonb }
1117 1.1 simonb }
1118 1.1 simonb
1119 1.1 simonb void
1120 1.1 simonb sbjcn_start(struct tty *tp)
1121 1.1 simonb {
1122 1.1 simonb struct sbjcn_softc *sc = sbjcn_cd.cd_devs[SBJCN_UNIT(tp->t_dev)];
1123 1.1 simonb struct sbjcn_channel *ch = &sc->sc_channels[SBJCN_CHAN(tp->t_dev)];
1124 1.1 simonb int s;
1125 1.1 simonb
1126 1.1 simonb s = spltty();
1127 1.1 simonb if (ISSET(tp->t_state, TS_BUSY | TS_TIMEOUT | TS_TTSTOP))
1128 1.1 simonb goto out;
1129 1.1 simonb if (ch->ch_tx_stopped)
1130 1.1 simonb goto out;
1131 1.1 simonb
1132 1.1 simonb if (tp->t_outq.c_cc <= tp->t_lowat) {
1133 1.1 simonb if (ISSET(tp->t_state, TS_ASLEEP)) {
1134 1.1 simonb CLR(tp->t_state, TS_ASLEEP);
1135 1.1 simonb wakeup(&tp->t_outq);
1136 1.1 simonb }
1137 1.1 simonb selwakeup(&tp->t_wsel);
1138 1.1 simonb if (tp->t_outq.c_cc == 0)
1139 1.1 simonb goto out;
1140 1.1 simonb }
1141 1.1 simonb
1142 1.1 simonb /* Grab the first contiguous region of buffer space. */
1143 1.1 simonb {
1144 1.1 simonb u_char *tba;
1145 1.1 simonb int tbc;
1146 1.1 simonb
1147 1.1 simonb tba = tp->t_outq.c_cf;
1148 1.1 simonb tbc = ndqb(&tp->t_outq, 0);
1149 1.1 simonb
1150 1.1 simonb (void)splserial();
1151 1.1 simonb
1152 1.1 simonb ch->ch_tba = tba;
1153 1.1 simonb ch->ch_tbc = tbc;
1154 1.1 simonb }
1155 1.1 simonb
1156 1.1 simonb SET(tp->t_state, TS_BUSY);
1157 1.1 simonb ch->ch_tx_busy = 1;
1158 1.1 simonb
1159 1.1 simonb /* Output the first chunk of the contiguous buffer. */
1160 1.1 simonb {
1161 1.1 simonb while (ch->ch_tbc) {
1162 1.1 simonb uint64_t data;
1163 1.1 simonb int bytes, i;
1164 1.1 simonb
1165 1.1 simonb bytes = (ch->ch_tbc > 7) ? 7 : ch->ch_tbc;
1166 1.1 simonb data = bytes;
1167 1.1 simonb for (i=0; i<bytes; i++) {
1168 1.1 simonb data <<= 8;
1169 1.1 simonb data |= *ch->ch_tba++;
1170 1.1 simonb }
1171 1.1 simonb if (bytes < 7)
1172 1.1 simonb data <<= 56-(bytes<<3);
1173 1.1 simonb ch->ch_tbc -= bytes;
1174 1.1 simonb WRITE_REG(ch->ch_output_reg, data);
1175 1.1 simonb }
1176 1.1 simonb ch->ch_tx_busy = 0;
1177 1.1 simonb ch->ch_tx_done = 1;
1178 1.1 simonb }
1179 1.1 simonb out:
1180 1.1 simonb splx(s);
1181 1.1 simonb return;
1182 1.1 simonb }
1183 1.1 simonb
1184 1.1 simonb /*
1185 1.1 simonb * Stop output on a line.
1186 1.1 simonb */
1187 1.1 simonb void
1188 1.1 simonb sbjcnstop(struct tty *tp, int flag)
1189 1.1 simonb {
1190 1.1 simonb struct sbjcn_softc *sc = sbjcn_cd.cd_devs[SBJCN_UNIT(tp->t_dev)];
1191 1.1 simonb struct sbjcn_channel *ch = &sc->sc_channels[SBJCN_CHAN(tp->t_dev)];
1192 1.1 simonb int s;
1193 1.1 simonb
1194 1.1 simonb s = splserial();
1195 1.1 simonb if (ISSET(tp->t_state, TS_BUSY)) {
1196 1.1 simonb /* Stop transmitting at the next chunk. */
1197 1.1 simonb ch->ch_tbc = 0;
1198 1.1 simonb ch->ch_heldtbc = 0;
1199 1.1 simonb if (!ISSET(tp->t_state, TS_TTSTOP))
1200 1.1 simonb SET(tp->t_state, TS_FLUSH);
1201 1.1 simonb }
1202 1.1 simonb splx(s);
1203 1.1 simonb }
1204 1.1 simonb
1205 1.1 simonb void
1206 1.1 simonb sbjcn_diag(arg)
1207 1.1 simonb void *arg;
1208 1.1 simonb {
1209 1.1 simonb struct sbjcn_channel *ch = arg;
1210 1.1 simonb struct sbjcn_softc *sc = ch->ch_sc;
1211 1.1 simonb int overflows, floods;
1212 1.1 simonb int s;
1213 1.1 simonb
1214 1.1 simonb s = splserial();
1215 1.1 simonb overflows = ch->ch_overflows;
1216 1.1 simonb ch->ch_overflows = 0;
1217 1.1 simonb floods = ch->ch_floods;
1218 1.1 simonb ch->ch_floods = 0;
1219 1.1 simonb ch->ch_errors = 0;
1220 1.1 simonb splx(s);
1221 1.1 simonb
1222 1.1 simonb log(LOG_WARNING, "%s: channel %d: %d fifo overflow%s, %d ibuf flood%s\n",
1223 1.1 simonb sc->sc_dev.dv_xname, ch->ch_num,
1224 1.1 simonb overflows, overflows == 1 ? "" : "s",
1225 1.1 simonb floods, floods == 1 ? "" : "s");
1226 1.1 simonb }
1227 1.1 simonb
1228 1.1 simonb integrate void
1229 1.1 simonb sbjcn_rxsoft(struct sbjcn_channel *ch, struct tty *tp)
1230 1.1 simonb {
1231 1.1 simonb int (*rint)(int c, struct tty *tp) = tp->t_linesw->l_rint;
1232 1.1 simonb u_char *get, *end;
1233 1.1 simonb u_int cc, scc;
1234 1.1 simonb u_char sr;
1235 1.1 simonb int code;
1236 1.1 simonb int s;
1237 1.1 simonb
1238 1.1 simonb end = ch->ch_ebuf;
1239 1.1 simonb get = ch->ch_rbget;
1240 1.1 simonb scc = cc = sbjcn_rbuf_size - ch->ch_rbavail;
1241 1.1 simonb
1242 1.1 simonb if (cc == sbjcn_rbuf_size) {
1243 1.1 simonb ch->ch_floods++;
1244 1.1 simonb if (ch->ch_errors++ == 0)
1245 1.1 simonb callout_reset(&ch->ch_diag_callout, 60 * hz,
1246 1.1 simonb sbjcn_diag, ch);
1247 1.1 simonb }
1248 1.1 simonb
1249 1.1 simonb while (cc) {
1250 1.1 simonb code = get[0];
1251 1.1 simonb sr = get[1];
1252 1.1 simonb if (ISSET(sr, 0xf0)) {
1253 1.1 simonb if (ISSET(sr, 0x10)) {
1254 1.1 simonb ch->ch_overflows++;
1255 1.1 simonb if (ch->ch_errors++ == 0)
1256 1.1 simonb callout_reset(&ch->ch_diag_callout,
1257 1.1 simonb 60 * hz, sbjcn_diag, ch);
1258 1.1 simonb }
1259 1.1 simonb if (ISSET(sr, 0xc0))
1260 1.1 simonb SET(code, TTY_FE);
1261 1.1 simonb if (ISSET(sr, 0x20))
1262 1.1 simonb SET(code, TTY_PE);
1263 1.1 simonb }
1264 1.1 simonb if ((*rint)(code, tp) == -1) {
1265 1.1 simonb /*
1266 1.1 simonb * The line discipline's buffer is out of space.
1267 1.1 simonb */
1268 1.1 simonb if (!ISSET(ch->ch_rx_flags, RX_TTY_BLOCKED)) {
1269 1.1 simonb /*
1270 1.1 simonb * We're either not using flow control, or the
1271 1.1 simonb * line discipline didn't tell us to block for
1272 1.1 simonb * some reason. Either way, we have no way to
1273 1.1 simonb * know when there's more space available, so
1274 1.1 simonb * just drop the rest of the data.
1275 1.1 simonb */
1276 1.1 simonb get += cc << 1;
1277 1.1 simonb if (get >= end)
1278 1.1 simonb get -= sbjcn_rbuf_size << 1;
1279 1.1 simonb cc = 0;
1280 1.1 simonb } else {
1281 1.1 simonb /*
1282 1.1 simonb * Don't schedule any more receive processing
1283 1.1 simonb * until the line discipline tells us there's
1284 1.1 simonb * space available (through comhwiflow()).
1285 1.1 simonb * Leave the rest of the data in the input
1286 1.1 simonb * buffer.
1287 1.1 simonb */
1288 1.1 simonb SET(ch->ch_rx_flags, RX_TTY_OVERFLOWED);
1289 1.1 simonb }
1290 1.1 simonb break;
1291 1.1 simonb }
1292 1.1 simonb get += 2;
1293 1.1 simonb if (get >= end)
1294 1.1 simonb get = ch->ch_rbuf;
1295 1.1 simonb cc--;
1296 1.1 simonb }
1297 1.1 simonb
1298 1.1 simonb if (cc != scc) {
1299 1.1 simonb ch->ch_rbget = get;
1300 1.1 simonb s = splserial();
1301 1.1 simonb cc = ch->ch_rbavail += scc - cc;
1302 1.1 simonb /* Buffers should be ok again, release possible block. */
1303 1.1 simonb if (cc >= ch->ch_r_lowat) {
1304 1.1 simonb if (ISSET(ch->ch_rx_flags, RX_IBUF_OVERFLOWED)) {
1305 1.1 simonb CLR(ch->ch_rx_flags, RX_IBUF_OVERFLOWED);
1306 1.1 simonb SET(ch->ch_imr, 0x02);
1307 1.1 simonb }
1308 1.1 simonb if (ISSET(ch->ch_rx_flags, RX_IBUF_BLOCKED)) {
1309 1.1 simonb CLR(ch->ch_rx_flags, RX_IBUF_BLOCKED);
1310 1.1 simonb sbjcn_dohwiflow(ch);
1311 1.1 simonb }
1312 1.1 simonb }
1313 1.1 simonb splx(s);
1314 1.1 simonb }
1315 1.1 simonb }
1316 1.1 simonb
1317 1.1 simonb integrate void
1318 1.1 simonb sbjcn_txsoft(struct sbjcn_channel *ch, struct tty *tp)
1319 1.1 simonb {
1320 1.1 simonb
1321 1.1 simonb CLR(tp->t_state, TS_BUSY);
1322 1.1 simonb if (ISSET(tp->t_state, TS_FLUSH))
1323 1.1 simonb CLR(tp->t_state, TS_FLUSH);
1324 1.1 simonb else
1325 1.1 simonb ndflush(&tp->t_outq, (int)(ch->ch_tba - tp->t_outq.c_cf));
1326 1.1 simonb (*tp->t_linesw->l_start)(tp);
1327 1.1 simonb }
1328 1.1 simonb
1329 1.1 simonb integrate void
1330 1.1 simonb sbjcn_stsoft(struct sbjcn_channel *ch, struct tty *tp)
1331 1.1 simonb {
1332 1.1 simonb u_char iports, delta;
1333 1.1 simonb int s;
1334 1.1 simonb
1335 1.1 simonb s = splserial();
1336 1.1 simonb iports = ch->ch_iports;
1337 1.1 simonb delta = ch->ch_iports_delta;
1338 1.1 simonb ch->ch_iports_delta = 0;
1339 1.1 simonb splx(s);
1340 1.1 simonb
1341 1.1 simonb if (ISSET(delta, ch->ch_i_dcd)) {
1342 1.1 simonb /*
1343 1.1 simonb * Inform the tty layer that carrier detect changed.
1344 1.1 simonb */
1345 1.1 simonb (void) (*tp->t_linesw->l_modem)(tp,
1346 1.1 simonb ISSET(iports, ch->ch_i_dcd));
1347 1.1 simonb }
1348 1.1 simonb
1349 1.1 simonb if (ISSET(delta, ch->ch_i_cts)) {
1350 1.1 simonb /* Block or unblock output according to flow control. */
1351 1.1 simonb if (ISSET(iports, ch->ch_i_cts)) {
1352 1.1 simonb ch->ch_tx_stopped = 0;
1353 1.1 simonb (*tp->t_linesw->l_start)(tp);
1354 1.1 simonb } else {
1355 1.1 simonb ch->ch_tx_stopped = 1;
1356 1.1 simonb }
1357 1.1 simonb }
1358 1.1 simonb
1359 1.1 simonb #ifdef SBJCN_DEBUG
1360 1.1 simonb if (sbjcn_debug)
1361 1.1 simonb sbjcn_status(ch, "sbjcn_stsoft");
1362 1.1 simonb #endif
1363 1.1 simonb }
1364 1.1 simonb
1365 1.1 simonb integrate void
1366 1.1 simonb sbjcn_recv(struct sbjcn_channel *ch)
1367 1.1 simonb {
1368 1.1 simonb u_char *put, *end;
1369 1.1 simonb u_int cc;
1370 1.1 simonb
1371 1.1 simonb end = ch->ch_ebuf;
1372 1.1 simonb put = ch->ch_rbput;
1373 1.1 simonb cc = ch->ch_rbavail;
1374 1.1 simonb
1375 1.1 simonb /* XXX process break */
1376 1.1 simonb
1377 1.1 simonb sbjcncn_grabdword(ch);
1378 1.1 simonb if (ch->ch_waiting_input) {
1379 1.1 simonb if (!ISSET(ch->ch_rx_flags, RX_IBUF_OVERFLOWED)) {
1380 1.1 simonb while (cc > 0) {
1381 1.1 simonb put[0] = sbjcncn_nextbyte(ch);
1382 1.1 simonb put[1] = 1; /* XXXKW ? */
1383 1.1 simonb put += 2;
1384 1.1 simonb if (put >= end)
1385 1.1 simonb put = ch->ch_rbuf;
1386 1.1 simonb cc--;
1387 1.1 simonb
1388 1.1 simonb if (!ch->ch_waiting_input)
1389 1.1 simonb break;
1390 1.1 simonb }
1391 1.1 simonb
1392 1.1 simonb /*
1393 1.1 simonb * Current string of incoming characters ended
1394 1.1 simonb * because no more data was available or we
1395 1.1 simonb * ran out of space. Schedule a receive event
1396 1.1 simonb * if any data was received. If we're out of
1397 1.1 simonb * space, turn off receive interrupts.
1398 1.1 simonb */
1399 1.1 simonb ch->ch_rbput = put;
1400 1.1 simonb ch->ch_rbavail = cc;
1401 1.1 simonb if (!ISSET(ch->ch_rx_flags, RX_TTY_OVERFLOWED))
1402 1.1 simonb ch->ch_rx_ready = 1;
1403 1.1 simonb
1404 1.1 simonb /*
1405 1.1 simonb * See if we are in danger of overflowing a
1406 1.1 simonb * buffer. If so, use hardware flow control
1407 1.1 simonb * to ease the pressure.
1408 1.1 simonb */
1409 1.1 simonb if (!ISSET(ch->ch_rx_flags, RX_IBUF_BLOCKED) &&
1410 1.1 simonb cc < ch->ch_r_hiwat) {
1411 1.1 simonb SET(ch->ch_rx_flags, RX_IBUF_BLOCKED);
1412 1.1 simonb sbjcn_dohwiflow(ch);
1413 1.1 simonb }
1414 1.1 simonb
1415 1.1 simonb /*
1416 1.1 simonb * If we're out of space, disable receive
1417 1.1 simonb * interrupts until the queue has drained
1418 1.1 simonb * a bit.
1419 1.1 simonb */
1420 1.1 simonb if (!cc) {
1421 1.1 simonb SET(ch->ch_rx_flags,
1422 1.1 simonb RX_IBUF_OVERFLOWED);
1423 1.1 simonb CLR(ch->ch_imr, 0x02);
1424 1.1 simonb }
1425 1.1 simonb } else {
1426 1.1 simonb /* XXX panic? */
1427 1.1 simonb CLR(ch->ch_imr, 0x02);
1428 1.1 simonb // continue;
1429 1.1 simonb }
1430 1.1 simonb }
1431 1.1 simonb
1432 1.1 simonb /*
1433 1.1 simonb * If we've delayed a parameter change, do it now, and restart
1434 1.1 simonb * output.
1435 1.1 simonb */
1436 1.1 simonb if (ch->ch_heldchange) {
1437 1.1 simonb sbjcn_loadchannelregs(ch);
1438 1.1 simonb ch->ch_heldchange = 0;
1439 1.1 simonb ch->ch_tbc = ch->ch_heldtbc;
1440 1.1 simonb ch->ch_heldtbc = 0;
1441 1.1 simonb }
1442 1.1 simonb }
1443 1.1 simonb
1444 1.1 simonb void
1445 1.1 simonb sbjcn_callout(void *arg)
1446 1.1 simonb {
1447 1.1 simonb struct sbjcn_channel *ch = arg;
1448 1.1 simonb struct tty *tp = ch->ch_tty;
1449 1.1 simonb
1450 1.1 simonb /* XXX get stuff */
1451 1.1 simonb sbjcn_recv(ch);
1452 1.1 simonb
1453 1.1 simonb /* XXX check receive */
1454 1.1 simonb if (ch->ch_rx_ready) {
1455 1.1 simonb ch->ch_rx_ready = 0;
1456 1.1 simonb sbjcn_rxsoft(ch, tp);
1457 1.1 simonb }
1458 1.1 simonb
1459 1.1 simonb /* XXX check transmit */
1460 1.1 simonb if (ch->ch_tx_done) {
1461 1.1 simonb ch->ch_tx_done = 0;
1462 1.1 simonb sbjcn_txsoft(ch, tp);
1463 1.1 simonb }
1464 1.1 simonb
1465 1.1 simonb callout_reset(&ch->ch_callout, hz/10, sbjcn_callout, ch);
1466 1.1 simonb }
1467 1.1 simonb
1468 1.1 simonb static char sbjcncn_nextbyte(struct sbjcn_channel *ch)
1469 1.1 simonb {
1470 1.1 simonb char c;
1471 1.1 simonb
1472 1.1 simonb sbjcncn_grabdword(ch);
1473 1.1 simonb c = (ch->ch_input_buf >> 56) & 0xff;
1474 1.1 simonb ch->ch_input_buf <<= 8;
1475 1.1 simonb ch->ch_waiting_input--;
1476 1.1 simonb return c;
1477 1.1 simonb }
1478 1.1 simonb
1479 1.1 simonb static void sbjcncn_grabdword(struct sbjcn_channel *ch)
1480 1.1 simonb {
1481 1.1 simonb uint64_t inbuf;
1482 1.1 simonb
1483 1.1 simonb if (ch->ch_waiting_input)
1484 1.1 simonb return;
1485 1.1 simonb
1486 1.1 simonb inbuf = READ_REG(ch->ch_input_reg);
1487 1.1 simonb ch->ch_waiting_input = jtag_input_len(inbuf);
1488 1.1 simonb ch->ch_input_buf = inbuf << 8;
1489 1.1 simonb }
1490 1.1 simonb
1491 1.1 simonb /*
1492 1.1 simonb * Initialize UART for use as console or KGDB line.
1493 1.1 simonb */
1494 1.1 simonb int
1495 1.1 simonb sbjcn_init(u_long addr, int chan, int rate, tcflag_t cflag)
1496 1.1 simonb {
1497 1.1 simonb /* XXXKW Anything to do here? */
1498 1.1 simonb return (0);
1499 1.1 simonb }
1500 1.1 simonb
1501 1.1 simonb /*
1502 1.1 simonb * Following are all routines needed for sbjcn to act as console
1503 1.1 simonb */
1504 1.1 simonb int
1505 1.1 simonb sbjcn_cnattach(u_long addr, int chan, int rate, tcflag_t cflag)
1506 1.1 simonb {
1507 1.1 simonb int res;
1508 1.1 simonb uint64_t ctrl_val;
1509 1.1 simonb static struct consdev sbjcn_cons = {
1510 1.1 simonb NULL, NULL, sbjcn_cngetc, sbjcn_cnputc, sbjcn_cnpollc, NULL,
1511 1.1 simonb NODEV, CN_NORMAL
1512 1.1 simonb };
1513 1.1 simonb
1514 1.1 simonb res = sbjcn_init(addr, chan, rate, cflag);
1515 1.1 simonb if (res)
1516 1.1 simonb return (res);
1517 1.1 simonb
1518 1.1 simonb cn_tab = &sbjcn_cons;
1519 1.1 simonb
1520 1.1 simonb sbjcn_cons_present = 1;
1521 1.1 simonb sbjcn_cons_addr = addr;
1522 1.1 simonb sbjcn_cons_waiting_input = 0;
1523 1.1 simonb sbjcn_cons_chan = chan;
1524 1.1 simonb sbjcn_cons_rate = rate;
1525 1.1 simonb sbjcn_cons_cflag = cflag;
1526 1.1 simonb
1527 1.1 simonb /* Wait for sign of life from the other end */
1528 1.1 simonb while ((ctrl_val = READ_REG(MIPS_PHYS_TO_KSEG1(sbjcn_cons_addr + JTAG_CONS_CONTROL))) == 0)
1529 1.1 simonb ;
1530 1.1 simonb
1531 1.1 simonb return (ctrl_val != JTAG_CONS_MAGICNUM);
1532 1.1 simonb }
1533 1.1 simonb
1534 1.1 simonb int
1535 1.1 simonb sbjcn_cngetc(dev_t dev)
1536 1.1 simonb {
1537 1.1 simonb char c;
1538 1.1 simonb
1539 1.1 simonb while (sbjcn_cons_waiting_input == 0)
1540 1.1 simonb sbjcn_cngrabdword();
1541 1.1 simonb
1542 1.1 simonb c = (sbjcn_cons_input_buf >> 56) & 0xff;
1543 1.1 simonb sbjcn_cons_input_buf <<= 8;
1544 1.1 simonb sbjcn_cons_waiting_input--;
1545 1.1 simonb
1546 1.1 simonb return c;
1547 1.1 simonb }
1548 1.1 simonb
1549 1.1 simonb /*
1550 1.1 simonb * Console kernel output character routine.
1551 1.1 simonb */
1552 1.1 simonb void
1553 1.1 simonb sbjcn_cnputc(dev_t dev, int c)
1554 1.1 simonb {
1555 1.1 simonb uint64_t outbuf;
1556 1.1 simonb
1557 1.1 simonb outbuf = (1LL << 56) | (((uint64_t)c) << 48);
1558 1.1 simonb WRITE_REG(MIPS_PHYS_TO_KSEG1(sbjcn_cons_addr + JTAG_CONS_OUTPUT), outbuf);
1559 1.1 simonb }
1560 1.1 simonb
1561 1.1 simonb void
1562 1.1 simonb sbjcn_cnpollc(dev_t dev, int on)
1563 1.1 simonb {
1564 1.1 simonb
1565 1.1 simonb }
1566 1.1 simonb
1567 1.1 simonb static void sbjcn_cngrabdword(void)
1568 1.1 simonb {
1569 1.1 simonb uint64_t inbuf;
1570 1.1 simonb
1571 1.1 simonb if (sbjcn_cons_waiting_input)
1572 1.1 simonb return;
1573 1.1 simonb
1574 1.1 simonb inbuf = READ_REG(MIPS_PHYS_TO_KSEG1(sbjcn_cons_addr + JTAG_CONS_INPUT));
1575 1.1 simonb sbjcn_cons_waiting_input = jtag_input_len(inbuf);
1576 1.1 simonb sbjcn_cons_input_buf = inbuf << 8;
1577 1.1 simonb }
1578 1.1 simonb
1579 1.1 simonb #ifdef KGDB
1580 1.1 simonb int
1581 1.1 simonb sbjcn_kgdb_attach(u_long addr, int chan, int rate, tcflag_t cflag)
1582 1.1 simonb {
1583 1.1 simonb int res;
1584 1.1 simonb
1585 1.1 simonb if (!sbjcn_cons_present &&
1586 1.1 simonb sbjcn_cons_addr == addr && sbjcn_cons_chan == chan)
1587 1.1 simonb return (EBUSY); /* cannot share with console */
1588 1.1 simonb
1589 1.1 simonb res = sbjcn_init(addr, chan, rate, cflag);
1590 1.1 simonb if (res)
1591 1.1 simonb return (res);
1592 1.1 simonb
1593 1.1 simonb kgdb_attach(sbjcn_kgdb_getc, sbjcn_kgdb_putc, NULL);
1594 1.1 simonb kgdb_dev = 123; /* unneeded, only to satisfy some tests */
1595 1.1 simonb kgdb_rate = rate;
1596 1.1 simonb
1597 1.1 simonb sbjcn_kgdb_present = 1;
1598 1.1 simonb /* XXX sbjcn_init wants addr, but we need the offset addr */
1599 1.1 simonb sbjcn_kgdb_addr = addr + (chan * 0x100);
1600 1.1 simonb sbjcn_kgdb_chan = chan;
1601 1.1 simonb
1602 1.1 simonb return (0);
1603 1.1 simonb }
1604 1.1 simonb
1605 1.1 simonb /* ARGSUSED */
1606 1.1 simonb int
1607 1.1 simonb sbjcn_kgdb_getc(arg)
1608 1.1 simonb void *arg;
1609 1.1 simonb {
1610 1.1 simonb
1611 1.1 simonb return (sbjcn_common_getc(sbjcn_kgdb_addr, sbjcn_kgdb_chan));
1612 1.1 simonb }
1613 1.1 simonb
1614 1.1 simonb /* ARGSUSED */
1615 1.1 simonb void
1616 1.1 simonb sbjcn_kgdb_putc(arg, c)
1617 1.1 simonb void *arg;
1618 1.1 simonb int c;
1619 1.1 simonb {
1620 1.1 simonb
1621 1.1 simonb sbjcn_common_putc(sbjcn_kgdb_addr, sbjcn_kgdb_chan, c);
1622 1.1 simonb }
1623 1.1 simonb #endif /* KGDB */
1624 1.1 simonb
1625 1.1 simonb /*
1626 1.1 simonb * helper function to identify the sbjcn channels used by
1627 1.1 simonb * console or KGDB (and not yet autoconf attached)
1628 1.1 simonb */
1629 1.1 simonb int
1630 1.1 simonb sbjcn_is_console(u_long addr, int chan)
1631 1.1 simonb {
1632 1.1 simonb
1633 1.1 simonb if (sbjcn_cons_present && !sbjcn_cons_attached &&
1634 1.1 simonb sbjcn_cons_addr == addr && sbjcn_cons_chan == chan)
1635 1.1 simonb return (1);
1636 1.1 simonb #ifdef KGDB
1637 1.1 simonb if (sbjcn_kgdb_present && !sbjcn_kgdb_attached &&
1638 1.1 simonb sbjcn_kgdb_addr == addr && sbjcn_kgdb_chan == chan)
1639 1.1 simonb return (1);
1640 1.1 simonb #endif
1641 1.1 simonb return (0);
1642 1.1 simonb }
1643