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