msc.c revision 1.19.8.4 1 1.19.8.4 nathanw /* $NetBSD: msc.c,v 1.19.8.4 2002/09/17 21:13:08 nathanw Exp $ */
2 1.19.8.2 nathanw
3 1.19.8.2 nathanw /*
4 1.19.8.2 nathanw * Copyright (c) 1993 Zik.
5 1.19.8.2 nathanw * Copyright (c) 1995 Jukka Marin <jmarin (at) jmp.fi>.
6 1.19.8.2 nathanw * Copyright (c) 1995 Timo Rossi <trossi (at) jyu.fi>.
7 1.19.8.2 nathanw * Copyright (c) 1995 Rob Healey <rhealey (at) kas.helios.mn.org>.
8 1.19.8.2 nathanw * Copyright (c) 1982, 1986, 1990 The Regents of the University of California.
9 1.19.8.2 nathanw * All rights reserved.
10 1.19.8.2 nathanw *
11 1.19.8.2 nathanw * Redistribution and use in source and binary forms, with or without
12 1.19.8.2 nathanw * modification, are permitted provided that the following conditions
13 1.19.8.2 nathanw * are met:
14 1.19.8.2 nathanw * 1. Redistributions of source code must retain the above copyright
15 1.19.8.2 nathanw * notice, this list of conditions and the following disclaimer.
16 1.19.8.2 nathanw * 2. Redistributions in binary form must reproduce the above copyright
17 1.19.8.2 nathanw * notice, this list of conditions and the following disclaimer in the
18 1.19.8.2 nathanw * documentation and/or other materials provided with the distribution.
19 1.19.8.2 nathanw * 3. All advertising materials mentioning features or use of this software
20 1.19.8.2 nathanw * must display the following acknowledgement:
21 1.19.8.2 nathanw * This product includes software developed by the University of
22 1.19.8.2 nathanw * California, Berkeley and its contributors.
23 1.19.8.2 nathanw * 4. Neither the name of the University nor the names of its contributors
24 1.19.8.2 nathanw * may be used to endorse or promote products derived from this software
25 1.19.8.2 nathanw * without specific prior written permission.
26 1.19.8.2 nathanw *
27 1.19.8.2 nathanw * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
28 1.19.8.2 nathanw * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
29 1.19.8.2 nathanw * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
30 1.19.8.2 nathanw * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
31 1.19.8.2 nathanw * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
32 1.19.8.2 nathanw * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
33 1.19.8.2 nathanw * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
34 1.19.8.2 nathanw * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
35 1.19.8.2 nathanw * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
36 1.19.8.2 nathanw * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
37 1.19.8.2 nathanw * SUCH DAMAGE.
38 1.19.8.2 nathanw *
39 1.19.8.2 nathanw * - converted from NetBSD Amiga serial driver to A2232 serial driver
40 1.19.8.2 nathanw * by zik 931207
41 1.19.8.2 nathanw * - added ttyflags hooks rfh 940419
42 1.19.8.2 nathanw * - added new style config support rfh 940601
43 1.19.8.2 nathanw * - added code to halt board during memory load so board doesn't flip
44 1.19.8.2 nathanw * out. /dev/reload works now. Also created mschwiflow function so BSD can
45 1.19.8.2 nathanw * attempt to use board RTS flow control now. rfh 950108
46 1.19.8.2 nathanw * - Integrated work from Jukka Marin <jmarin (at) jmp.fi> and
47 1.19.8.2 nathanw * Timo Rossi <trossi (at) jyu.fi> The mscmint() code is Jukka's. 950916
48 1.19.8.2 nathanw * Integrated more bug fixes by Jukka Marin <jmarin (at) jmp.fi> 950918
49 1.19.8.2 nathanw * Also added Jukka's turbo board code. 950918
50 1.19.8.2 nathanw * - Reformatted to NetBSD style format.
51 1.19.8.2 nathanw * - Rewritten the carrier detect system to prevent lock-ups (jm 951029)
52 1.19.8.2 nathanw */
53 1.19.8.2 nathanw
54 1.19.8.2 nathanw #include <sys/cdefs.h>
55 1.19.8.4 nathanw __KERNEL_RCSID(0, "$NetBSD: msc.c,v 1.19.8.4 2002/09/17 21:13:08 nathanw Exp $");
56 1.19.8.2 nathanw
57 1.19.8.2 nathanw #include "msc.h"
58 1.19.8.2 nathanw
59 1.19.8.2 nathanw #if NMSC > 0
60 1.19.8.2 nathanw #include <sys/param.h>
61 1.19.8.2 nathanw #include <sys/systm.h>
62 1.19.8.2 nathanw #include <sys/ioctl.h>
63 1.19.8.2 nathanw #include <sys/tty.h>
64 1.19.8.2 nathanw #include <sys/proc.h>
65 1.19.8.2 nathanw #include <sys/file.h>
66 1.19.8.2 nathanw #include <sys/malloc.h>
67 1.19.8.2 nathanw #include <sys/uio.h>
68 1.19.8.2 nathanw #include <sys/kernel.h>
69 1.19.8.2 nathanw #include <sys/syslog.h>
70 1.19.8.2 nathanw #include <sys/device.h>
71 1.19.8.4 nathanw #include <sys/conf.h>
72 1.19.8.2 nathanw
73 1.19.8.2 nathanw #include <amiga/amiga/device.h>
74 1.19.8.2 nathanw #include <amiga/dev/zbusvar.h>
75 1.19.8.2 nathanw #include <amiga/dev/mscreg.h>
76 1.19.8.2 nathanw #include <machine/cpu.h>
77 1.19.8.2 nathanw
78 1.19.8.2 nathanw #include <amiga/amiga/custom.h>
79 1.19.8.2 nathanw #include <amiga/amiga/cia.h>
80 1.19.8.2 nathanw #include <amiga/amiga/cc.h>
81 1.19.8.2 nathanw
82 1.19.8.2 nathanw /* 6502 code for A2232 card */
83 1.19.8.2 nathanw #include "msc6502.h"
84 1.19.8.2 nathanw
85 1.19.8.2 nathanw /*
86 1.19.8.2 nathanw * Note: These are Zik's original comments:
87 1.19.8.2 nathanw * There is a bit of a "gotcha" concerning the numbering
88 1.19.8.2 nathanw * of msc devices and the specification of the number of serial
89 1.19.8.2 nathanw * lines in the kernel.
90 1.19.8.2 nathanw *
91 1.19.8.2 nathanw * Each board has seven lines, but for programming convenience
92 1.19.8.2 nathanw * and compatibility with Amiga UNIX the boards' minor device
93 1.19.8.2 nathanw * numbers are allocated in groups of sixteen:
94 1.19.8.2 nathanw *
95 1.19.8.2 nathanw * minor device numbers
96 1.19.8.2 nathanw * First board 0 2 4 6 8 10 12
97 1.19.8.2 nathanw * Second board 16 18 20 22 24 26 28
98 1.19.8.2 nathanw * Third board 32 34 36 38 40 42 44
99 1.19.8.2 nathanw *
100 1.19.8.2 nathanw * The intermediate minor device numbers are dialin versions
101 1.19.8.2 nathanw * of the same devices. ie. 10 is dialout line 6 and 11 is
102 1.19.8.2 nathanw * the dialin version of line 6.
103 1.19.8.2 nathanw *
104 1.19.8.2 nathanw * On the other hand, I have made the NMSC config option refer
105 1.19.8.2 nathanw * to the total number of a2232 cards, not the maximum
106 1.19.8.2 nathanw * minor device number. So you might have NMSC=3, in which case
107 1.19.8.2 nathanw * you have three boards with minor device numbers from 0 to 45.
108 1.19.8.2 nathanw */
109 1.19.8.2 nathanw
110 1.19.8.2 nathanw int mscparam(struct tty *, struct termios *);
111 1.19.8.2 nathanw void mscstart(struct tty *);
112 1.19.8.2 nathanw int mschwiflow(struct tty *, int);
113 1.19.8.2 nathanw int mscinitcard(struct zbus_args *);
114 1.19.8.2 nathanw
115 1.19.8.2 nathanw int mscdefaultrate = TTYDEF_SPEED;
116 1.19.8.2 nathanw
117 1.19.8.2 nathanw struct mscdevice mscdev[MSCSLOTS]; /* device structs for all lines */
118 1.19.8.2 nathanw struct tty *msc_tty[MSCTTYS]; /* ttys for all lines */
119 1.19.8.2 nathanw
120 1.19.8.2 nathanw struct vbl_node msc_vbl_node[NMSC]; /* vbl interrupt node per board */
121 1.19.8.2 nathanw
122 1.19.8.2 nathanw struct speedtab mscspeedtab_normal[] = {
123 1.19.8.2 nathanw { 0, 0 },
124 1.19.8.2 nathanw { 50, MSCPARAM_B50 },
125 1.19.8.2 nathanw { 75, MSCPARAM_B75 },
126 1.19.8.2 nathanw { 110, MSCPARAM_B110 },
127 1.19.8.2 nathanw { 134, MSCPARAM_B134 },
128 1.19.8.2 nathanw { 150, MSCPARAM_B150 },
129 1.19.8.2 nathanw { 300, MSCPARAM_B300 },
130 1.19.8.2 nathanw { 600, MSCPARAM_B600 },
131 1.19.8.2 nathanw { 1200, MSCPARAM_B1200 },
132 1.19.8.2 nathanw { 1800, MSCPARAM_B1800 },
133 1.19.8.2 nathanw { 2400, MSCPARAM_B2400 },
134 1.19.8.2 nathanw { 3600, MSCPARAM_B3600 },
135 1.19.8.2 nathanw { 4800, MSCPARAM_B4800 },
136 1.19.8.2 nathanw { 7200, MSCPARAM_B7200 },
137 1.19.8.2 nathanw { 9600, MSCPARAM_B9600 },
138 1.19.8.2 nathanw { 19200, MSCPARAM_B19200 },
139 1.19.8.2 nathanw { 115200, MSCPARAM_B115200 },
140 1.19.8.2 nathanw { -1, -1 }
141 1.19.8.2 nathanw };
142 1.19.8.2 nathanw
143 1.19.8.2 nathanw struct speedtab mscspeedtab_turbo[] = {
144 1.19.8.2 nathanw { 0, 0 },
145 1.19.8.2 nathanw { 100, MSCPARAM_B50 },
146 1.19.8.2 nathanw { 150, MSCPARAM_B75 },
147 1.19.8.2 nathanw { 220, MSCPARAM_B110 },
148 1.19.8.2 nathanw { 269, MSCPARAM_B134 },
149 1.19.8.2 nathanw { 300, MSCPARAM_B150 },
150 1.19.8.2 nathanw { 600, MSCPARAM_B300 },
151 1.19.8.2 nathanw { 1200, MSCPARAM_B600 },
152 1.19.8.2 nathanw { 2400, MSCPARAM_B1200 },
153 1.19.8.2 nathanw { 3600, MSCPARAM_B1800 },
154 1.19.8.2 nathanw { 4800, MSCPARAM_B2400 },
155 1.19.8.2 nathanw { 7200, MSCPARAM_B3600 },
156 1.19.8.2 nathanw { 9600, MSCPARAM_B4800 },
157 1.19.8.2 nathanw { 14400, MSCPARAM_B7200 },
158 1.19.8.2 nathanw { 19200, MSCPARAM_B9600 },
159 1.19.8.2 nathanw { 38400, MSCPARAM_B19200 },
160 1.19.8.2 nathanw { 230400, MSCPARAM_B115200 },
161 1.19.8.2 nathanw { -1, -1 }
162 1.19.8.2 nathanw };
163 1.19.8.2 nathanw
164 1.19.8.2 nathanw struct speedtab *mscspeedtab;
165 1.19.8.2 nathanw
166 1.19.8.2 nathanw int mscmctl(dev_t dev, int bits, int howto);
167 1.19.8.2 nathanw void mscmint(register void *data);
168 1.19.8.2 nathanw
169 1.19.8.2 nathanw int mscmatch(struct device *, struct cfdata *, void *);
170 1.19.8.2 nathanw void mscattach(struct device *, struct device *, void *);
171 1.19.8.2 nathanw
172 1.19.8.2 nathanw #define SWFLAGS(dev) (msc->openflags | (MSCDIALIN(dev) ? 0 : TIOCFLAG_SOFTCAR))
173 1.19.8.2 nathanw #define DEBUG_CD 0
174 1.19.8.2 nathanw
175 1.19.8.2 nathanw struct cfattach msc_ca = {
176 1.19.8.2 nathanw sizeof(struct device), mscmatch, mscattach
177 1.19.8.2 nathanw };
178 1.19.8.2 nathanw
179 1.19.8.4 nathanw dev_type_open(mscopen);
180 1.19.8.4 nathanw dev_type_close(mscclose);
181 1.19.8.4 nathanw dev_type_read(mscread);
182 1.19.8.4 nathanw dev_type_write(mscwrite);
183 1.19.8.4 nathanw dev_type_ioctl(mscioctl);
184 1.19.8.4 nathanw dev_type_stop(mscstop);
185 1.19.8.4 nathanw dev_type_tty(msctty);
186 1.19.8.4 nathanw dev_type_poll(mscpoll);
187 1.19.8.4 nathanw
188 1.19.8.4 nathanw const struct cdevsw msc_cdevsw = {
189 1.19.8.4 nathanw mscopen, mscclose, mscread, mscwrite, mscioctl,
190 1.19.8.4 nathanw mscstop, msctty, mscpoll, nommap, D_TTY
191 1.19.8.4 nathanw };
192 1.19.8.4 nathanw
193 1.19.8.2 nathanw int
194 1.19.8.2 nathanw mscmatch(struct device *pdp, struct cfdata *cfp, void *auxp)
195 1.19.8.2 nathanw {
196 1.19.8.2 nathanw struct zbus_args *zap;
197 1.19.8.2 nathanw
198 1.19.8.2 nathanw zap = auxp;
199 1.19.8.2 nathanw if (zap->manid == 514 && (zap->prodid == 70 || zap->prodid == 69))
200 1.19.8.2 nathanw return(1);
201 1.19.8.2 nathanw
202 1.19.8.2 nathanw return (0);
203 1.19.8.2 nathanw }
204 1.19.8.2 nathanw
205 1.19.8.2 nathanw void
206 1.19.8.2 nathanw mscattach(struct device *pdp, struct device *dp, void *auxp)
207 1.19.8.2 nathanw {
208 1.19.8.2 nathanw volatile struct mscmemory *mscmem;
209 1.19.8.2 nathanw struct mscdevice *msc;
210 1.19.8.2 nathanw struct zbus_args *zap;
211 1.19.8.2 nathanw int unit;
212 1.19.8.2 nathanw int Count;
213 1.19.8.2 nathanw
214 1.19.8.2 nathanw zap = (struct zbus_args *)auxp;
215 1.19.8.2 nathanw unit = dp->dv_unit;
216 1.19.8.2 nathanw
217 1.19.8.2 nathanw /*
218 1.19.8.2 nathanw * Make config msgs look nicer.
219 1.19.8.2 nathanw */
220 1.19.8.2 nathanw printf("\n");
221 1.19.8.2 nathanw
222 1.19.8.2 nathanw if (mscinitcard(zap) != 0) {
223 1.19.8.2 nathanw printf("msc%d: Board initialize failed, bad download code.\n", unit);
224 1.19.8.2 nathanw return;
225 1.19.8.2 nathanw }
226 1.19.8.2 nathanw
227 1.19.8.2 nathanw printf("msc%d: Board successfully initialized.\n", unit);
228 1.19.8.2 nathanw
229 1.19.8.2 nathanw mscmem = (struct mscmemory *) zap->va;
230 1.19.8.2 nathanw
231 1.19.8.2 nathanw if (mscmem->Common.Crystal == MSC_UNKNOWN) {
232 1.19.8.2 nathanw printf("msc%d: Unable to detect crystal frequency.\n", unit);
233 1.19.8.2 nathanw return;
234 1.19.8.2 nathanw }
235 1.19.8.2 nathanw
236 1.19.8.2 nathanw if (mscmem->Common.Crystal == MSC_TURBO) {
237 1.19.8.2 nathanw printf("msc%d: Turbo version detected (%02x%02x:%d)\n", unit,
238 1.19.8.2 nathanw mscmem->Common.TimerH, mscmem->Common.TimerL,
239 1.19.8.2 nathanw mscmem->Common.Pad_a);
240 1.19.8.2 nathanw mscspeedtab = mscspeedtab_turbo;
241 1.19.8.2 nathanw } else {
242 1.19.8.2 nathanw printf("msc%d: Normal version detected (%02x%02x:%d)\n", unit,
243 1.19.8.2 nathanw mscmem->Common.TimerH, mscmem->Common.TimerL,
244 1.19.8.2 nathanw mscmem->Common.Pad_a);
245 1.19.8.2 nathanw mscspeedtab = mscspeedtab_normal;
246 1.19.8.2 nathanw }
247 1.19.8.2 nathanw
248 1.19.8.2 nathanw mscmem->Common.CDStatus = 0; /* common status for all 7 ports */
249 1.19.8.2 nathanw
250 1.19.8.2 nathanw /* XXX 8 is a constant */
251 1.19.8.2 nathanw for (Count = 0; Count < 8 && MSCSLOTUL(unit, Count) < MSCSLOTS; Count++) {
252 1.19.8.2 nathanw msc = &mscdev[MSCSLOTUL(unit, Count)];
253 1.19.8.2 nathanw msc->board = mscmem;
254 1.19.8.2 nathanw msc->port = Count;
255 1.19.8.2 nathanw msc->flags = 0;
256 1.19.8.2 nathanw msc->openflags = 0;
257 1.19.8.2 nathanw msc->active = 1;
258 1.19.8.2 nathanw msc->unit = unit;
259 1.19.8.2 nathanw msc->closing = FALSE;
260 1.19.8.2 nathanw msc_tty[MSCTTYSLOT(MSCSLOTUL(unit, Count))] = NULL;
261 1.19.8.2 nathanw msc_tty[MSCTTYSLOT(MSCSLOTUL(unit, Count)) + 1] = NULL;
262 1.19.8.2 nathanw }
263 1.19.8.2 nathanw
264 1.19.8.2 nathanw /* disable the non-existent eighth port */
265 1.19.8.2 nathanw if (MSCSLOTUL(unit, NUMLINES) < MSCSLOTS)
266 1.19.8.2 nathanw mscdev[MSCSLOTUL(unit, NUMLINES)].active = 0;
267 1.19.8.2 nathanw
268 1.19.8.2 nathanw msc_vbl_node[unit].function = (void (*) (void *)) mscmint;
269 1.19.8.2 nathanw msc_vbl_node[unit].data = (void *) unit;
270 1.19.8.2 nathanw
271 1.19.8.2 nathanw add_vbl_function (&msc_vbl_node[unit], MSC_VBL_PRIORITY, (void *)unit);
272 1.19.8.2 nathanw
273 1.19.8.2 nathanw return;
274 1.19.8.2 nathanw }
275 1.19.8.2 nathanw
276 1.19.8.2 nathanw /* ARGSUSED */
277 1.19.8.2 nathanw int
278 1.19.8.2 nathanw mscopen(dev_t dev, int flag, int mode, struct proc *p)
279 1.19.8.2 nathanw {
280 1.19.8.2 nathanw register struct tty *tp;
281 1.19.8.2 nathanw struct mscdevice *msc;
282 1.19.8.2 nathanw volatile struct mscstatus *ms;
283 1.19.8.2 nathanw int error = 0;
284 1.19.8.2 nathanw int s, slot, ttyn;
285 1.19.8.2 nathanw
286 1.19.8.2 nathanw /* get the device structure */
287 1.19.8.2 nathanw slot = MSCSLOT(dev);
288 1.19.8.2 nathanw ttyn = MSCTTY(dev);
289 1.19.8.2 nathanw
290 1.19.8.2 nathanw if (slot >= MSCSLOTS)
291 1.19.8.2 nathanw return ENXIO;
292 1.19.8.2 nathanw
293 1.19.8.2 nathanw if (MSCLINE(dev) >= NUMLINES)
294 1.19.8.2 nathanw return ENXIO;
295 1.19.8.2 nathanw
296 1.19.8.2 nathanw msc = &mscdev[slot];
297 1.19.8.2 nathanw ms = &msc->board->Status[msc->port];
298 1.19.8.2 nathanw
299 1.19.8.2 nathanw if (!msc->active)
300 1.19.8.2 nathanw return ENXIO;
301 1.19.8.2 nathanw
302 1.19.8.2 nathanw /*
303 1.19.8.2 nathanw * RFH: WHY here? Put down by while like other serial drivers
304 1.19.8.2 nathanw * But if we do that it makes things bomb.
305 1.19.8.2 nathanw */
306 1.19.8.2 nathanw s = spltty();
307 1.19.8.2 nathanw
308 1.19.8.2 nathanw if (!msc_tty[ttyn]) {
309 1.19.8.2 nathanw
310 1.19.8.2 nathanw tp = ttymalloc();
311 1.19.8.2 nathanw tty_attach(tp);
312 1.19.8.2 nathanw msc_tty[ttyn] = tp;
313 1.19.8.2 nathanw msc_tty[ttyn+1] = (struct tty *)NULL;
314 1.19.8.2 nathanw
315 1.19.8.2 nathanw #if 0
316 1.19.8.2 nathanw /* default values are not optimal for this device, increase buffers. */
317 1.19.8.2 nathanw clfree(&tp->t_rawq);
318 1.19.8.2 nathanw clfree(&tp->t_canq);
319 1.19.8.2 nathanw clfree(&tp->t_outq);
320 1.19.8.2 nathanw clalloc(&tp->t_rawq, 8192, 1);
321 1.19.8.2 nathanw clalloc(&tp->t_canq, 8192, 1);
322 1.19.8.2 nathanw clalloc(&tp->t_outq, 8192, 0);
323 1.19.8.2 nathanw #endif
324 1.19.8.2 nathanw
325 1.19.8.2 nathanw } else
326 1.19.8.2 nathanw tp = msc_tty[ttyn];
327 1.19.8.2 nathanw
328 1.19.8.2 nathanw tp->t_oproc = (void (*) (struct tty *)) mscstart;
329 1.19.8.2 nathanw tp->t_param = mscparam;
330 1.19.8.2 nathanw tp->t_dev = dev;
331 1.19.8.2 nathanw tp->t_hwiflow = mschwiflow;
332 1.19.8.2 nathanw
333 1.19.8.2 nathanw /* if port is still closing, just bitbucket remaining characters */
334 1.19.8.2 nathanw if (msc->closing) {
335 1.19.8.2 nathanw ms->OutFlush = TRUE;
336 1.19.8.2 nathanw msc->closing = FALSE;
337 1.19.8.2 nathanw }
338 1.19.8.2 nathanw
339 1.19.8.2 nathanw /* initialize tty */
340 1.19.8.2 nathanw if ((tp->t_state & TS_ISOPEN) == 0 && tp->t_wopen == 0) {
341 1.19.8.2 nathanw ttychars(tp);
342 1.19.8.2 nathanw if (tp->t_ispeed == 0) {
343 1.19.8.2 nathanw tp->t_iflag = TTYDEF_IFLAG;
344 1.19.8.2 nathanw tp->t_oflag = TTYDEF_OFLAG;
345 1.19.8.2 nathanw tp->t_cflag = TTYDEF_CFLAG;
346 1.19.8.2 nathanw tp->t_lflag = TTYDEF_LFLAG;
347 1.19.8.2 nathanw tp->t_ispeed = tp->t_ospeed = mscdefaultrate;
348 1.19.8.2 nathanw }
349 1.19.8.2 nathanw
350 1.19.8.2 nathanw /* flags changed to be private to every unit by JM */
351 1.19.8.2 nathanw if (msc->openflags & TIOCFLAG_CLOCAL)
352 1.19.8.2 nathanw tp->t_cflag |= CLOCAL;
353 1.19.8.2 nathanw if (msc->openflags & TIOCFLAG_CRTSCTS)
354 1.19.8.2 nathanw tp->t_cflag |= CRTSCTS;
355 1.19.8.2 nathanw if (msc->openflags & TIOCFLAG_MDMBUF)
356 1.19.8.2 nathanw tp->t_cflag |= MDMBUF;
357 1.19.8.2 nathanw
358 1.19.8.2 nathanw mscparam(tp, &tp->t_termios);
359 1.19.8.2 nathanw ttsetwater(tp);
360 1.19.8.2 nathanw
361 1.19.8.2 nathanw (void) mscmctl(dev, TIOCM_DTR | TIOCM_RTS, DMSET);
362 1.19.8.2 nathanw
363 1.19.8.2 nathanw if ((SWFLAGS(dev) & TIOCFLAG_SOFTCAR) ||
364 1.19.8.2 nathanw (mscmctl(dev, 0, DMGET) & TIOCM_CD))
365 1.19.8.2 nathanw tp->t_state |= TS_CARR_ON;
366 1.19.8.2 nathanw else
367 1.19.8.2 nathanw tp->t_state &= ~TS_CARR_ON;
368 1.19.8.2 nathanw
369 1.19.8.2 nathanw } else {
370 1.19.8.2 nathanw if (tp->t_state & TS_XCLUDE && p->p_ucred->cr_uid != 0) {
371 1.19.8.2 nathanw splx(s);
372 1.19.8.2 nathanw return (EBUSY);
373 1.19.8.2 nathanw }
374 1.19.8.2 nathanw }
375 1.19.8.2 nathanw
376 1.19.8.2 nathanw /*
377 1.19.8.2 nathanw * if NONBLOCK requested, ignore carrier
378 1.19.8.2 nathanw */
379 1.19.8.2 nathanw if (flag & O_NONBLOCK) {
380 1.19.8.2 nathanw #if DEBUG_CD
381 1.19.8.2 nathanw printf("msc%d: %d open nonblock\n", msc->unit, MSCLINE(dev));
382 1.19.8.2 nathanw #endif
383 1.19.8.2 nathanw goto done;
384 1.19.8.2 nathanw }
385 1.19.8.2 nathanw
386 1.19.8.2 nathanw /*
387 1.19.8.2 nathanw * s = spltty();
388 1.19.8.2 nathanw *
389 1.19.8.2 nathanw * This causes hangs when put here, like other TTY drivers do, rather than
390 1.19.8.2 nathanw * above, WHY? RFH
391 1.19.8.2 nathanw *
392 1.19.8.2 nathanw */
393 1.19.8.2 nathanw
394 1.19.8.2 nathanw while ((tp->t_state & TS_CARR_ON) == 0 && (tp->t_cflag & CLOCAL) == 0) {
395 1.19.8.2 nathanw tp->t_wopen++;
396 1.19.8.2 nathanw
397 1.19.8.2 nathanw #if DEBUG_CD
398 1.19.8.2 nathanw printf("msc%d: %d waiting for CD\n", msc->unit, MSCLINE(dev));
399 1.19.8.2 nathanw #endif
400 1.19.8.2 nathanw error = ttysleep(tp, (caddr_t)&tp->t_rawq, TTIPRI | PCATCH, ttopen, 0);
401 1.19.8.2 nathanw tp->t_wopen--;
402 1.19.8.2 nathanw
403 1.19.8.2 nathanw if (error) {
404 1.19.8.2 nathanw splx(s);
405 1.19.8.2 nathanw return(error);
406 1.19.8.2 nathanw }
407 1.19.8.2 nathanw }
408 1.19.8.2 nathanw
409 1.19.8.2 nathanw #if DEBUG_CD
410 1.19.8.2 nathanw printf("msc%d: %d got CD\n", msc->unit, MSCLINE(dev));
411 1.19.8.2 nathanw #endif
412 1.19.8.2 nathanw
413 1.19.8.2 nathanw done:
414 1.19.8.2 nathanw /* This is a way to handle lost XON characters */
415 1.19.8.2 nathanw if ((flag & O_TRUNC) && (tp->t_state & TS_TTSTOP)) {
416 1.19.8.2 nathanw tp->t_state &= ~TS_TTSTOP;
417 1.19.8.2 nathanw ttstart (tp);
418 1.19.8.2 nathanw }
419 1.19.8.2 nathanw
420 1.19.8.2 nathanw splx(s);
421 1.19.8.2 nathanw
422 1.19.8.2 nathanw /*
423 1.19.8.2 nathanw * Reset the tty pointer, as there could have been a dialout
424 1.19.8.2 nathanw * use of the tty with a dialin open waiting.
425 1.19.8.2 nathanw */
426 1.19.8.2 nathanw tp->t_dev = dev;
427 1.19.8.2 nathanw
428 1.19.8.2 nathanw return tp->t_linesw->l_open(dev, tp);
429 1.19.8.2 nathanw }
430 1.19.8.2 nathanw
431 1.19.8.2 nathanw
432 1.19.8.2 nathanw int
433 1.19.8.2 nathanw mscclose(dev_t dev, int flag, int mode, struct proc *p)
434 1.19.8.2 nathanw {
435 1.19.8.2 nathanw register struct tty *tp;
436 1.19.8.2 nathanw int slot;
437 1.19.8.2 nathanw volatile struct mscstatus *ms;
438 1.19.8.2 nathanw struct mscdevice *msc;
439 1.19.8.2 nathanw
440 1.19.8.2 nathanw /* get the device structure */
441 1.19.8.2 nathanw slot = MSCSLOT(dev);
442 1.19.8.2 nathanw
443 1.19.8.2 nathanw if (slot >= MSCSLOTS)
444 1.19.8.2 nathanw return ENXIO;
445 1.19.8.2 nathanw
446 1.19.8.2 nathanw msc = &mscdev[slot];
447 1.19.8.2 nathanw
448 1.19.8.2 nathanw if (!msc->active)
449 1.19.8.2 nathanw return ENXIO;
450 1.19.8.2 nathanw
451 1.19.8.2 nathanw ms = &msc->board->Status[msc->port];
452 1.19.8.2 nathanw
453 1.19.8.2 nathanw tp = msc_tty[MSCTTY(dev)];
454 1.19.8.2 nathanw tp->t_linesw->l_close(tp, flag);
455 1.19.8.2 nathanw
456 1.19.8.2 nathanw (void) mscmctl(dev, 0, DMSET);
457 1.19.8.2 nathanw
458 1.19.8.2 nathanw ttyclose(tp);
459 1.19.8.2 nathanw
460 1.19.8.2 nathanw if (msc->flags & TIOCM_DTR)
461 1.19.8.2 nathanw msc->closing = TRUE; /* flush remaining characters before dropping DTR */
462 1.19.8.2 nathanw else
463 1.19.8.2 nathanw ms->OutFlush = TRUE; /* just bitbucket remaining characters */
464 1.19.8.2 nathanw
465 1.19.8.2 nathanw return (0);
466 1.19.8.2 nathanw }
467 1.19.8.2 nathanw
468 1.19.8.2 nathanw
469 1.19.8.2 nathanw int
470 1.19.8.2 nathanw mscread(dev_t dev, struct uio *uio, int flag)
471 1.19.8.2 nathanw {
472 1.19.8.2 nathanw register struct tty *tp;
473 1.19.8.2 nathanw
474 1.19.8.2 nathanw tp = msc_tty[MSCTTY(dev)];
475 1.19.8.2 nathanw
476 1.19.8.2 nathanw if (! tp)
477 1.19.8.2 nathanw return ENXIO;
478 1.19.8.2 nathanw
479 1.19.8.2 nathanw return tp->t_linesw->l_read(tp, uio, flag);
480 1.19.8.2 nathanw }
481 1.19.8.2 nathanw
482 1.19.8.2 nathanw
483 1.19.8.2 nathanw int
484 1.19.8.2 nathanw mscwrite(dev_t dev, struct uio *uio, int flag)
485 1.19.8.2 nathanw {
486 1.19.8.2 nathanw register struct tty *tp;
487 1.19.8.2 nathanw
488 1.19.8.2 nathanw tp = msc_tty[MSCTTY(dev)];
489 1.19.8.2 nathanw
490 1.19.8.2 nathanw if (! tp)
491 1.19.8.2 nathanw return ENXIO;
492 1.19.8.2 nathanw
493 1.19.8.2 nathanw return tp->t_linesw->l_write(tp, uio, flag);
494 1.19.8.2 nathanw }
495 1.19.8.2 nathanw
496 1.19.8.2 nathanw int
497 1.19.8.2 nathanw mscpoll(dev_t dev, int events, struct proc *p)
498 1.19.8.2 nathanw {
499 1.19.8.2 nathanw register struct tty *tp;
500 1.19.8.2 nathanw
501 1.19.8.2 nathanw tp = msc_tty[MSCTTY(dev)];
502 1.19.8.2 nathanw
503 1.19.8.2 nathanw if (! tp)
504 1.19.8.2 nathanw return ENXIO;
505 1.19.8.2 nathanw
506 1.19.8.2 nathanw return ((*tp->t_linesw->l_poll)(tp, events, p));
507 1.19.8.2 nathanw }
508 1.19.8.2 nathanw
509 1.19.8.2 nathanw /*
510 1.19.8.2 nathanw * This interrupt is periodically invoked in the vertical blank
511 1.19.8.2 nathanw * interrupt. It's used to keep track of the modem control lines
512 1.19.8.2 nathanw * and (new with the fast_int code) to move accumulated data up in
513 1.19.8.2 nathanw * to the tty layer.
514 1.19.8.2 nathanw *
515 1.19.8.2 nathanw * NOTE: MSCCDHACK is an invention of mine for dubious purposes. If you
516 1.19.8.2 nathanw * want to activate it add
517 1.19.8.2 nathanw * options MSCCDHACK
518 1.19.8.2 nathanw * in the kernel conf file. Basically it forces CD->Low transitions
519 1.19.8.2 nathanw * to ALWAYS send a signal to the process, even if the device is in
520 1.19.8.2 nathanw * clocal mode or an outdial device. RFH
521 1.19.8.2 nathanw */
522 1.19.8.2 nathanw void
523 1.19.8.2 nathanw mscmint(register void *data)
524 1.19.8.2 nathanw {
525 1.19.8.2 nathanw register struct tty *tp;
526 1.19.8.2 nathanw struct mscdevice *msc;
527 1.19.8.2 nathanw volatile struct mscstatus *ms;
528 1.19.8.2 nathanw volatile u_char *ibuf, *cbuf;
529 1.19.8.2 nathanw unsigned char newhead; /* was int */
530 1.19.8.2 nathanw unsigned char bufpos; /* was int */
531 1.19.8.2 nathanw unsigned char ncd, ocd, ccd;
532 1.19.8.2 nathanw int unit, slot, maxslot;
533 1.19.8.2 nathanw int s, i;
534 1.19.8.2 nathanw
535 1.19.8.2 nathanw unit = (int) data;
536 1.19.8.2 nathanw
537 1.19.8.2 nathanw /* check each line on this board */
538 1.19.8.2 nathanw maxslot = MSCSLOTUL(unit, NUMLINES);
539 1.19.8.2 nathanw if (maxslot > MSCSLOTS)
540 1.19.8.2 nathanw maxslot = MSCSLOTS;
541 1.19.8.2 nathanw
542 1.19.8.2 nathanw msc = &mscdev[MSCSLOTUL(unit, 0)];
543 1.19.8.2 nathanw
544 1.19.8.2 nathanw newhead = msc->board->Common.CDHead;
545 1.19.8.2 nathanw bufpos = msc->board->Common.CDTail;
546 1.19.8.2 nathanw if (newhead != bufpos) { /* CD events in queue */
547 1.19.8.2 nathanw /* set interrupt priority level */
548 1.19.8.2 nathanw s = spltty();
549 1.19.8.2 nathanw ocd = msc->board->Common.CDStatus; /* get old status bits */
550 1.19.8.2 nathanw while (newhead != bufpos) { /* read all events */
551 1.19.8.2 nathanw ncd = msc->board->CDBuf[bufpos++]; /* get one event */
552 1.19.8.2 nathanw ccd = ncd ^ ocd; /* mask of changed lines*/
553 1.19.8.2 nathanw ocd = ncd; /* save new status bits */
554 1.19.8.2 nathanw #if DEBUG_CD
555 1.19.8.2 nathanw printf("ocd %02x ncd %02x ccd %02x\n", ocd, ncd, ccd);
556 1.19.8.2 nathanw #endif
557 1.19.8.2 nathanw for(i = 0; i < NUMLINES; i++) { /* do for all lines */
558 1.19.8.2 nathanw if (ccd & 1) { /* this one changed */
559 1.19.8.2 nathanw msc = &mscdev[MSCSLOTUL(unit, i)];
560 1.19.8.2 nathanw if (ncd & 1) { /* CD is now OFF */
561 1.19.8.2 nathanw #if DEBUG_CD
562 1.19.8.2 nathanw printf("msc%d: CD OFF %d\n", unit, msc->port);
563 1.19.8.2 nathanw #endif
564 1.19.8.2 nathanw msc->flags &= ~TIOCM_CD;
565 1.19.8.2 nathanw if ((tp = msc_tty[MSCTTYSLOT(MSCSLOTUL(unit, i))]) &&
566 1.19.8.2 nathanw (tp->t_state & TS_ISOPEN) && tp->t_wopen == 0) {
567 1.19.8.2 nathanw
568 1.19.8.2 nathanw #ifndef MSCCDHACK
569 1.19.8.2 nathanw if (MSCDIALIN(tp->t_dev))
570 1.19.8.2 nathanw #endif
571 1.19.8.2 nathanw {
572 1.19.8.2 nathanw if (tp->t_linesw->l_modem(tp, 0) == 0) {
573 1.19.8.2 nathanw /* clear RTS and DTR, bitbucket output */
574 1.19.8.2 nathanw ms = &msc->board->Status[msc->port];
575 1.19.8.2 nathanw ms->Command = (ms->Command & ~MSCCMD_CMask) |
576 1.19.8.2 nathanw MSCCMD_Close;
577 1.19.8.2 nathanw ms->Setup = TRUE;
578 1.19.8.2 nathanw msc->flags &= ~(TIOCM_DTR | TIOCM_RTS);
579 1.19.8.2 nathanw ms->OutFlush = TRUE;
580 1.19.8.2 nathanw }
581 1.19.8.2 nathanw }
582 1.19.8.2 nathanw }
583 1.19.8.2 nathanw } else { /* CD is now ON */
584 1.19.8.2 nathanw #if DEBUG_CD
585 1.19.8.2 nathanw printf("msc%d: CD ON %d\n", unit, msc->port);
586 1.19.8.2 nathanw #endif
587 1.19.8.2 nathanw msc->flags |= TIOCM_CD;
588 1.19.8.2 nathanw if ((tp = msc_tty[MSCTTYSLOT(MSCSLOTUL(unit, i))]) &&
589 1.19.8.2 nathanw (tp->t_state & TS_ISOPEN) && tp->t_wopen == 0) {
590 1.19.8.2 nathanw if (MSCDIALIN(tp->t_dev))
591 1.19.8.2 nathanw tp->t_linesw->l_modem(tp, 1);
592 1.19.8.2 nathanw } /* if tp valid and port open */
593 1.19.8.2 nathanw } /* CD on/off */
594 1.19.8.2 nathanw } /* if CD changed for this line */
595 1.19.8.2 nathanw ccd >>= 1; ncd >>= 1; /* bit for next line */
596 1.19.8.2 nathanw } /* for every line */
597 1.19.8.2 nathanw } /* while events in queue */
598 1.19.8.2 nathanw msc->board->Common.CDStatus = ocd; /* save new status */
599 1.19.8.2 nathanw msc->board->Common.CDTail = bufpos; /* remove events */
600 1.19.8.2 nathanw splx(s);
601 1.19.8.2 nathanw } /* if events in CD queue */
602 1.19.8.2 nathanw
603 1.19.8.2 nathanw for (slot = MSCSLOTUL(unit, 0); slot < maxslot; slot++) {
604 1.19.8.2 nathanw msc = &mscdev[slot];
605 1.19.8.2 nathanw
606 1.19.8.2 nathanw if (!msc->active)
607 1.19.8.2 nathanw continue;
608 1.19.8.2 nathanw
609 1.19.8.2 nathanw tp = msc_tty[MSCTTYSLOT(slot)];
610 1.19.8.2 nathanw ms = &msc->board->Status[msc->port];
611 1.19.8.2 nathanw
612 1.19.8.2 nathanw newhead = ms->InHead; /* 65c02 write pointer */
613 1.19.8.2 nathanw
614 1.19.8.2 nathanw /* yoohoo, is the port open? */
615 1.19.8.2 nathanw if (tp && (tp->t_state & TS_ISOPEN) && tp->t_wopen == 0) {
616 1.19.8.2 nathanw /* port is open, handle all type of events */
617 1.19.8.2 nathanw
618 1.19.8.2 nathanw /* set interrupt priority level */
619 1.19.8.2 nathanw s = spltty();
620 1.19.8.2 nathanw
621 1.19.8.2 nathanw /* check for input for this port */
622 1.19.8.2 nathanw if (newhead != (bufpos = ms->InTail)) {
623 1.19.8.2 nathanw /* buffer for input chars/events */
624 1.19.8.2 nathanw ibuf = &msc->board->InBuf[msc->port][0];
625 1.19.8.2 nathanw
626 1.19.8.2 nathanw /* data types of bytes in ibuf */
627 1.19.8.2 nathanw cbuf = &msc->board->InCtl[msc->port][0];
628 1.19.8.2 nathanw
629 1.19.8.2 nathanw /* do for all chars, if room */
630 1.19.8.2 nathanw while (bufpos != newhead) {
631 1.19.8.2 nathanw /* which type of input data? */
632 1.19.8.2 nathanw switch (cbuf[bufpos]) {
633 1.19.8.2 nathanw /* input event (CD, BREAK, etc.) */
634 1.19.8.2 nathanw case MSCINCTL_EVENT:
635 1.19.8.2 nathanw switch (ibuf[bufpos++]) {
636 1.19.8.2 nathanw case MSCEVENT_Break:
637 1.19.8.2 nathanw tp->t_linesw->l_rint(TTY_FE, tp);
638 1.19.8.2 nathanw break;
639 1.19.8.2 nathanw
640 1.19.8.2 nathanw default:
641 1.19.8.2 nathanw printf("msc%d: unknown event type %d\n",
642 1.19.8.2 nathanw msc->unit, ibuf[(bufpos-1)&0xff]);
643 1.19.8.2 nathanw } /* event type switch */
644 1.19.8.2 nathanw break;
645 1.19.8.2 nathanw
646 1.19.8.2 nathanw case MSCINCTL_CHAR:
647 1.19.8.2 nathanw if (tp->t_state & TS_TBLOCK) {
648 1.19.8.2 nathanw goto NoRoomForYa;
649 1.19.8.2 nathanw }
650 1.19.8.2 nathanw tp->t_linesw->l_rint((int)ibuf[bufpos++], tp);
651 1.19.8.2 nathanw break;
652 1.19.8.2 nathanw
653 1.19.8.2 nathanw default:
654 1.19.8.2 nathanw printf("msc%d: unknown data type %d\n",
655 1.19.8.2 nathanw msc->unit, cbuf[bufpos]);
656 1.19.8.2 nathanw bufpos++;
657 1.19.8.2 nathanw } /* switch on input data type */
658 1.19.8.2 nathanw } /* while there's something in the buffer */
659 1.19.8.2 nathanw NoRoomForYa:
660 1.19.8.2 nathanw ms->InTail = bufpos; /* tell 65C02 what we've read */
661 1.19.8.2 nathanw } /* if there was something in the buffer */
662 1.19.8.2 nathanw
663 1.19.8.2 nathanw /* we get here only when the port is open */
664 1.19.8.2 nathanw /* send output */
665 1.19.8.2 nathanw if (tp->t_state & (TS_BUSY|TS_FLUSH)) {
666 1.19.8.2 nathanw
667 1.19.8.2 nathanw bufpos = ms->OutHead - ms->OutTail;
668 1.19.8.2 nathanw
669 1.19.8.2 nathanw /* busy and below low water mark? */
670 1.19.8.2 nathanw if (tp->t_state & TS_BUSY) {
671 1.19.8.2 nathanw if (bufpos < IOBUFLOWWATER) {
672 1.19.8.2 nathanw tp->t_state &= ~TS_BUSY; /* not busy any more */
673 1.19.8.2 nathanw if (tp->t_linesw)
674 1.19.8.2 nathanw tp->t_linesw->l_start(tp);
675 1.19.8.2 nathanw else
676 1.19.8.2 nathanw mscstart(tp);
677 1.19.8.2 nathanw }
678 1.19.8.2 nathanw }
679 1.19.8.2 nathanw
680 1.19.8.2 nathanw /* waiting for flush and buffer empty? */
681 1.19.8.2 nathanw if (tp->t_state & TS_FLUSH) {
682 1.19.8.2 nathanw if (bufpos == 0)
683 1.19.8.2 nathanw tp->t_state &= ~TS_FLUSH; /* finished flushing */
684 1.19.8.2 nathanw }
685 1.19.8.2 nathanw } /* BUSY or FLUSH */
686 1.19.8.2 nathanw
687 1.19.8.2 nathanw splx(s);
688 1.19.8.2 nathanw
689 1.19.8.2 nathanw } else { /* End of port open */
690 1.19.8.2 nathanw /* port is closed, don't pass on the chars from it */
691 1.19.8.2 nathanw
692 1.19.8.2 nathanw /* check for input for this port */
693 1.19.8.2 nathanw if (newhead != (bufpos = ms->InTail)) {
694 1.19.8.2 nathanw /* buffer for input chars/events */
695 1.19.8.2 nathanw ibuf = &msc->board->InBuf[msc->port][0];
696 1.19.8.2 nathanw
697 1.19.8.2 nathanw /* data types of bytes in ibuf */
698 1.19.8.2 nathanw cbuf = &msc->board->InCtl[msc->port][0];
699 1.19.8.2 nathanw
700 1.19.8.2 nathanw /* do for all chars, if room */
701 1.19.8.2 nathanw while (bufpos != newhead) {
702 1.19.8.2 nathanw /* which type of input data? */
703 1.19.8.2 nathanw switch (cbuf[bufpos]) {
704 1.19.8.2 nathanw /* input event (BREAK, etc.) */
705 1.19.8.2 nathanw case MSCINCTL_EVENT:
706 1.19.8.2 nathanw switch (ibuf[bufpos++]) {
707 1.19.8.2 nathanw default:
708 1.19.8.2 nathanw printf("msc: unknown event type %d\n",
709 1.19.8.2 nathanw ibuf[(bufpos-1)&0xff]);
710 1.19.8.2 nathanw } /* event type switch */
711 1.19.8.2 nathanw break;
712 1.19.8.2 nathanw
713 1.19.8.2 nathanw default:
714 1.19.8.2 nathanw bufpos++;
715 1.19.8.2 nathanw } /* switch on input data type */
716 1.19.8.2 nathanw } /* while there's something in the buffer */
717 1.19.8.2 nathanw
718 1.19.8.2 nathanw ms->InTail = bufpos; /* tell 65C02 what we've read */
719 1.19.8.2 nathanw } /* if there was something in the buffer */
720 1.19.8.2 nathanw } /* End of port open/close */
721 1.19.8.2 nathanw
722 1.19.8.2 nathanw /* is this port closing? */
723 1.19.8.2 nathanw if (msc->closing) {
724 1.19.8.2 nathanw /* if DTR is off, just bitbucket remaining characters */
725 1.19.8.2 nathanw if ( (msc->flags & TIOCM_DTR) == 0) {
726 1.19.8.2 nathanw ms->OutFlush = TRUE;
727 1.19.8.2 nathanw msc->closing = FALSE;
728 1.19.8.2 nathanw }
729 1.19.8.2 nathanw /* if output has drained, drop DTR */
730 1.19.8.2 nathanw else if (ms->OutHead == ms->OutTail) {
731 1.19.8.2 nathanw (void) mscmctl(tp->t_dev, 0, DMSET);
732 1.19.8.2 nathanw msc->closing = FALSE;
733 1.19.8.2 nathanw }
734 1.19.8.2 nathanw }
735 1.19.8.2 nathanw } /* For all ports */
736 1.19.8.2 nathanw }
737 1.19.8.2 nathanw
738 1.19.8.2 nathanw
739 1.19.8.2 nathanw int
740 1.19.8.2 nathanw mscioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
741 1.19.8.2 nathanw {
742 1.19.8.2 nathanw register struct tty *tp;
743 1.19.8.2 nathanw register int slot;
744 1.19.8.2 nathanw register int error;
745 1.19.8.2 nathanw struct mscdevice *msc;
746 1.19.8.2 nathanw volatile struct mscstatus *ms;
747 1.19.8.2 nathanw int s;
748 1.19.8.2 nathanw
749 1.19.8.2 nathanw /* get the device structure */
750 1.19.8.2 nathanw slot = MSCSLOT(dev);
751 1.19.8.2 nathanw
752 1.19.8.2 nathanw if (slot >= MSCSLOTS)
753 1.19.8.2 nathanw return ENXIO;
754 1.19.8.2 nathanw
755 1.19.8.2 nathanw msc = &mscdev[slot];
756 1.19.8.2 nathanw
757 1.19.8.2 nathanw if (!msc->active)
758 1.19.8.2 nathanw return ENXIO;
759 1.19.8.2 nathanw
760 1.19.8.2 nathanw ms = &msc->board->Status[msc->port];
761 1.19.8.2 nathanw if (!(tp = msc_tty[MSCTTY(dev)]))
762 1.19.8.2 nathanw return ENXIO;
763 1.19.8.2 nathanw
764 1.19.8.2 nathanw error = tp->t_linesw->l_ioctl(tp, cmd, data, flag, p);
765 1.19.8.3 nathanw if (error != EPASSTHROUGH)
766 1.19.8.2 nathanw return (error);
767 1.19.8.2 nathanw
768 1.19.8.2 nathanw error = ttioctl(tp, cmd, data, flag, p);
769 1.19.8.3 nathanw if (error != EPASSTHROUGH)
770 1.19.8.2 nathanw return (error);
771 1.19.8.2 nathanw
772 1.19.8.2 nathanw switch (cmd) {
773 1.19.8.2 nathanw
774 1.19.8.2 nathanw /* send break */
775 1.19.8.2 nathanw case TIOCSBRK:
776 1.19.8.2 nathanw s = spltty();
777 1.19.8.2 nathanw ms->Command = (ms->Command & (~MSCCMD_RTSMask)) | MSCCMD_Break;
778 1.19.8.2 nathanw ms->Setup = TRUE;
779 1.19.8.2 nathanw splx(s);
780 1.19.8.2 nathanw break;
781 1.19.8.2 nathanw
782 1.19.8.2 nathanw /* clear break */
783 1.19.8.2 nathanw case TIOCCBRK:
784 1.19.8.2 nathanw s = spltty();
785 1.19.8.2 nathanw ms->Command = (ms->Command & (~MSCCMD_RTSMask)) | MSCCMD_RTSOn;
786 1.19.8.2 nathanw ms->Setup = TRUE;
787 1.19.8.2 nathanw splx(s);
788 1.19.8.2 nathanw break;
789 1.19.8.2 nathanw
790 1.19.8.2 nathanw case TIOCSDTR:
791 1.19.8.2 nathanw (void) mscmctl(dev, TIOCM_DTR | TIOCM_RTS, DMBIS);
792 1.19.8.2 nathanw break;
793 1.19.8.2 nathanw
794 1.19.8.2 nathanw case TIOCCDTR:
795 1.19.8.2 nathanw if (!MSCDIALIN(dev)) /* don't let dialins drop DTR */
796 1.19.8.2 nathanw (void) mscmctl(dev, TIOCM_DTR | TIOCM_RTS, DMBIC);
797 1.19.8.2 nathanw break;
798 1.19.8.2 nathanw
799 1.19.8.2 nathanw case TIOCMSET:
800 1.19.8.2 nathanw (void) mscmctl(dev, *(int *)data, DMSET);
801 1.19.8.2 nathanw break;
802 1.19.8.2 nathanw
803 1.19.8.2 nathanw case TIOCMBIS:
804 1.19.8.2 nathanw (void) mscmctl(dev, *(int *)data, DMBIS);
805 1.19.8.2 nathanw break;
806 1.19.8.2 nathanw
807 1.19.8.2 nathanw case TIOCMBIC:
808 1.19.8.2 nathanw if (MSCDIALIN(dev)) /* don't let dialins drop DTR */
809 1.19.8.2 nathanw (void) mscmctl(dev, *(int *)data & TIOCM_DTR, DMBIC);
810 1.19.8.2 nathanw else
811 1.19.8.2 nathanw (void) mscmctl(dev, *(int *)data, DMBIC);
812 1.19.8.2 nathanw break;
813 1.19.8.2 nathanw
814 1.19.8.2 nathanw case TIOCMGET:
815 1.19.8.2 nathanw *(int *)data = mscmctl(dev, 0, DMGET);
816 1.19.8.2 nathanw break;
817 1.19.8.2 nathanw
818 1.19.8.2 nathanw case TIOCGFLAGS:
819 1.19.8.2 nathanw *(int *)data = SWFLAGS(dev);
820 1.19.8.2 nathanw break;
821 1.19.8.2 nathanw
822 1.19.8.2 nathanw case TIOCSFLAGS:
823 1.19.8.2 nathanw error = suser(p->p_ucred, &p->p_acflag);
824 1.19.8.2 nathanw if (error != 0)
825 1.19.8.2 nathanw return(EPERM);
826 1.19.8.2 nathanw msc->openflags = *(int *)data;
827 1.19.8.2 nathanw /* only allow valid flags */
828 1.19.8.2 nathanw msc->openflags &=
829 1.19.8.2 nathanw (TIOCFLAG_SOFTCAR | TIOCFLAG_CLOCAL | TIOCFLAG_CRTSCTS);
830 1.19.8.2 nathanw break;
831 1.19.8.2 nathanw
832 1.19.8.2 nathanw default:
833 1.19.8.3 nathanw return (EPASSTHROUGH);
834 1.19.8.2 nathanw }
835 1.19.8.2 nathanw
836 1.19.8.2 nathanw return (0);
837 1.19.8.2 nathanw }
838 1.19.8.2 nathanw
839 1.19.8.2 nathanw
840 1.19.8.2 nathanw int
841 1.19.8.2 nathanw mscparam(register struct tty *tp, register struct termios *t)
842 1.19.8.2 nathanw {
843 1.19.8.2 nathanw register int cflag = t->c_cflag;
844 1.19.8.2 nathanw struct mscdevice *msc;
845 1.19.8.2 nathanw volatile struct mscstatus *ms;
846 1.19.8.2 nathanw int s, slot;
847 1.19.8.2 nathanw int ospeed = ttspeedtab(t->c_ospeed, mscspeedtab);
848 1.19.8.2 nathanw
849 1.19.8.2 nathanw /* get the device structure */
850 1.19.8.2 nathanw slot = MSCSLOT(tp->t_dev);
851 1.19.8.2 nathanw
852 1.19.8.2 nathanw if (slot >= MSCSLOTS)
853 1.19.8.2 nathanw return ENXIO;
854 1.19.8.2 nathanw
855 1.19.8.2 nathanw msc = &mscdev[slot];
856 1.19.8.2 nathanw
857 1.19.8.2 nathanw if (!msc->active)
858 1.19.8.2 nathanw return ENXIO;
859 1.19.8.2 nathanw
860 1.19.8.2 nathanw ms = &msc->board->Status[msc->port];
861 1.19.8.2 nathanw
862 1.19.8.2 nathanw /* check requested parameters */
863 1.19.8.2 nathanw if (ospeed < 0 || (t->c_ispeed && t->c_ispeed != t->c_ospeed))
864 1.19.8.2 nathanw return (EINVAL);
865 1.19.8.2 nathanw
866 1.19.8.2 nathanw /* and copy to tty */
867 1.19.8.2 nathanw tp->t_ispeed = t->c_ispeed;
868 1.19.8.2 nathanw tp->t_ospeed = t->c_ospeed;
869 1.19.8.2 nathanw tp->t_cflag = cflag;
870 1.19.8.2 nathanw
871 1.19.8.2 nathanw /* hang up if baud is zero */
872 1.19.8.2 nathanw if (t->c_ospeed == 0) {
873 1.19.8.2 nathanw if (!MSCDIALIN(tp->t_dev)) /* don't let dialins drop DTR */
874 1.19.8.2 nathanw (void) mscmctl(tp->t_dev, 0, DMSET);
875 1.19.8.2 nathanw } else {
876 1.19.8.2 nathanw /* set the baud rate */
877 1.19.8.2 nathanw s = spltty();
878 1.19.8.2 nathanw ms->Param = (ms->Param & ~MSCPARAM_BaudMask) | ospeed | MSCPARAM_RcvBaud;
879 1.19.8.2 nathanw
880 1.19.8.2 nathanw /*
881 1.19.8.2 nathanw * Make sure any previous hangup is undone, ie. reenable DTR.
882 1.19.8.2 nathanw * also mscmctl will cause the speed to be set
883 1.19.8.2 nathanw */
884 1.19.8.2 nathanw (void) mscmctl (tp->t_dev, TIOCM_DTR | TIOCM_RTS, DMSET);
885 1.19.8.2 nathanw
886 1.19.8.2 nathanw splx(s);
887 1.19.8.2 nathanw }
888 1.19.8.2 nathanw
889 1.19.8.2 nathanw return(0);
890 1.19.8.2 nathanw }
891 1.19.8.2 nathanw
892 1.19.8.2 nathanw
893 1.19.8.2 nathanw /*
894 1.19.8.2 nathanw * Jukka's code initializes alot of stuff that other drivers don't
895 1.19.8.2 nathanw * I'm including it here so that this code is a common set of work
896 1.19.8.2 nathanw * done by both of us. rfh
897 1.19.8.2 nathanw */
898 1.19.8.2 nathanw int
899 1.19.8.2 nathanw mschwiflow(struct tty *tp, int flag)
900 1.19.8.2 nathanw {
901 1.19.8.2 nathanw
902 1.19.8.2 nathanw /* Rob's version */
903 1.19.8.2 nathanw #if 1
904 1.19.8.2 nathanw if (flag)
905 1.19.8.2 nathanw mscmctl( tp->t_dev, TIOCM_RTS, DMBIC); /* Clear/Lower RTS */
906 1.19.8.2 nathanw else
907 1.19.8.2 nathanw mscmctl( tp->t_dev, TIOCM_RTS, DMBIS); /* Set/Raise RTS */
908 1.19.8.2 nathanw
909 1.19.8.2 nathanw #else /* Jukka's version */
910 1.19.8.2 nathanw
911 1.19.8.2 nathanw int s, slot;
912 1.19.8.2 nathanw struct mscdevice *msc;
913 1.19.8.2 nathanw volatile struct mscstatus *ms;
914 1.19.8.2 nathanw
915 1.19.8.2 nathanw /* get the device structure */
916 1.19.8.2 nathanw slot = MSCSLOT(tp->t_dev);
917 1.19.8.2 nathanw if (slot >= MSCSLOTS)
918 1.19.8.2 nathanw return ENXIO;
919 1.19.8.2 nathanw msc = &mscdev[slot];
920 1.19.8.2 nathanw if (!msc->active)
921 1.19.8.2 nathanw return ENXIO;
922 1.19.8.2 nathanw ms = &msc->board->Status[msc->port];
923 1.19.8.2 nathanw
924 1.19.8.2 nathanw /* Well, we should really _do_ something here, but the 65c02 code
925 1.19.8.2 nathanw * manages the RTS signal on its own now, so... This will probably
926 1.19.8.2 nathanw * change in the future.
927 1.19.8.2 nathanw */
928 1.19.8.2 nathanw #endif
929 1.19.8.2 nathanw return 1;
930 1.19.8.2 nathanw }
931 1.19.8.2 nathanw
932 1.19.8.2 nathanw
933 1.19.8.2 nathanw void
934 1.19.8.2 nathanw mscstart(register struct tty *tp)
935 1.19.8.2 nathanw {
936 1.19.8.2 nathanw register int cc;
937 1.19.8.2 nathanw register char *cp;
938 1.19.8.2 nathanw register int mhead;
939 1.19.8.2 nathanw int s, slot;
940 1.19.8.2 nathanw struct mscdevice *msc;
941 1.19.8.2 nathanw volatile struct mscstatus *ms;
942 1.19.8.2 nathanw volatile char *mob;
943 1.19.8.2 nathanw int hiwat = 0;
944 1.19.8.2 nathanw int maxout;
945 1.19.8.2 nathanw
946 1.19.8.2 nathanw if (! (tp->t_state & TS_ISOPEN))
947 1.19.8.2 nathanw return;
948 1.19.8.2 nathanw
949 1.19.8.2 nathanw slot = MSCSLOT(tp->t_dev);
950 1.19.8.2 nathanw
951 1.19.8.2 nathanw #if 0
952 1.19.8.2 nathanw printf("starting msc%d\n", slot);
953 1.19.8.2 nathanw #endif
954 1.19.8.2 nathanw
955 1.19.8.2 nathanw s = spltty();
956 1.19.8.2 nathanw
957 1.19.8.2 nathanw /* don't start if explicitly stopped */
958 1.19.8.2 nathanw if (tp->t_state & (TS_TIMEOUT|TS_TTSTOP))
959 1.19.8.2 nathanw goto out;
960 1.19.8.2 nathanw
961 1.19.8.2 nathanw /* wake up if below low water */
962 1.19.8.2 nathanw cc = tp->t_outq.c_cc;
963 1.19.8.2 nathanw
964 1.19.8.2 nathanw if (cc <= tp->t_lowat) {
965 1.19.8.2 nathanw if (tp->t_state & TS_ASLEEP) {
966 1.19.8.2 nathanw tp->t_state &= ~TS_ASLEEP;
967 1.19.8.2 nathanw wakeup((caddr_t)&tp->t_outq);
968 1.19.8.2 nathanw }
969 1.19.8.2 nathanw selwakeup(&tp->t_wsel);
970 1.19.8.2 nathanw }
971 1.19.8.2 nathanw
972 1.19.8.2 nathanw /* don't bother if no characters or busy */
973 1.19.8.2 nathanw if (cc == 0 || (tp->t_state & TS_BUSY))
974 1.19.8.2 nathanw goto out;
975 1.19.8.2 nathanw
976 1.19.8.2 nathanw /*
977 1.19.8.2 nathanw * Limit the amount of output we do in one burst
978 1.19.8.2 nathanw */
979 1.19.8.2 nathanw msc = &mscdev[slot];
980 1.19.8.2 nathanw ms = &msc->board->Status[msc->port];
981 1.19.8.2 nathanw mhead = ms->OutHead;
982 1.19.8.2 nathanw maxout = mhead - ms->OutTail;
983 1.19.8.2 nathanw
984 1.19.8.2 nathanw if (maxout < 0)
985 1.19.8.2 nathanw maxout += IOBUFLEN;
986 1.19.8.2 nathanw
987 1.19.8.2 nathanw maxout = IOBUFLEN - 1 - maxout;
988 1.19.8.2 nathanw
989 1.19.8.2 nathanw if (cc >= maxout) {
990 1.19.8.2 nathanw hiwat++;
991 1.19.8.2 nathanw cc = maxout;
992 1.19.8.2 nathanw }
993 1.19.8.2 nathanw
994 1.19.8.2 nathanw cc = q_to_b (&tp->t_outq, msc->tmpbuf, cc);
995 1.19.8.2 nathanw
996 1.19.8.2 nathanw if (cc > 0) {
997 1.19.8.2 nathanw tp->t_state |= TS_BUSY;
998 1.19.8.2 nathanw
999 1.19.8.2 nathanw mob = &msc->board->OutBuf[msc->port][0];
1000 1.19.8.2 nathanw cp = &msc->tmpbuf[0];
1001 1.19.8.2 nathanw
1002 1.19.8.2 nathanw /* enable output */
1003 1.19.8.2 nathanw ms->OutDisable = FALSE;
1004 1.19.8.2 nathanw
1005 1.19.8.2 nathanw #if 0
1006 1.19.8.2 nathanw msc->tmpbuf[cc] = 0;
1007 1.19.8.2 nathanw printf("sending '%s'\n", msctmpbuf);
1008 1.19.8.2 nathanw #endif
1009 1.19.8.2 nathanw
1010 1.19.8.2 nathanw /* send the first char across to reduce latency */
1011 1.19.8.2 nathanw mob[mhead++] = *cp++;
1012 1.19.8.2 nathanw mhead &= IOBUFLENMASK;
1013 1.19.8.2 nathanw ms->OutHead = mhead;
1014 1.19.8.2 nathanw cc--;
1015 1.19.8.2 nathanw
1016 1.19.8.2 nathanw /* copy the rest of the chars across quickly */
1017 1.19.8.2 nathanw while (cc > 0) {
1018 1.19.8.2 nathanw mob[mhead++] = *cp++;
1019 1.19.8.2 nathanw mhead &= IOBUFLENMASK;
1020 1.19.8.2 nathanw cc--;
1021 1.19.8.2 nathanw }
1022 1.19.8.2 nathanw ms->OutHead = mhead;
1023 1.19.8.2 nathanw
1024 1.19.8.2 nathanw /* leave the device busy if we've filled the buffer */
1025 1.19.8.2 nathanw if (!hiwat)
1026 1.19.8.2 nathanw tp->t_state &= ~TS_BUSY;
1027 1.19.8.2 nathanw }
1028 1.19.8.2 nathanw
1029 1.19.8.2 nathanw out:
1030 1.19.8.2 nathanw splx(s);
1031 1.19.8.2 nathanw }
1032 1.19.8.2 nathanw
1033 1.19.8.2 nathanw
1034 1.19.8.2 nathanw /* XXX */
1035 1.19.8.2 nathanw /*
1036 1.19.8.2 nathanw * Stop output on a line.
1037 1.19.8.2 nathanw */
1038 1.19.8.2 nathanw /*ARGSUSED*/
1039 1.19.8.2 nathanw void
1040 1.19.8.2 nathanw mscstop(register struct tty *tp, int flag)
1041 1.19.8.2 nathanw /* flag variable defaulted to int anyway */
1042 1.19.8.2 nathanw {
1043 1.19.8.2 nathanw register int s;
1044 1.19.8.2 nathanw #if 0
1045 1.19.8.2 nathanw struct mscdevice *msc;
1046 1.19.8.2 nathanw volatile struct mscstatus *ms;
1047 1.19.8.2 nathanw #endif
1048 1.19.8.2 nathanw
1049 1.19.8.2 nathanw s = spltty();
1050 1.19.8.2 nathanw if (tp->t_state & TS_BUSY) {
1051 1.19.8.2 nathanw if ((tp->t_state & TS_TTSTOP) == 0) {
1052 1.19.8.2 nathanw tp->t_state |= TS_FLUSH;
1053 1.19.8.2 nathanw #if 0
1054 1.19.8.2 nathanw msc = &mscdev[MSCSLOT(tp->t_dev)];
1055 1.19.8.2 nathanw ms = &msc->board->Status[msc->port];
1056 1.19.8.2 nathanw printf("stopped output on msc%d\n", MSCSLOT(tp->t_dev));
1057 1.19.8.2 nathanw ms->OutDisable = TRUE;
1058 1.19.8.2 nathanw #endif
1059 1.19.8.2 nathanw }
1060 1.19.8.2 nathanw }
1061 1.19.8.2 nathanw splx(s);
1062 1.19.8.2 nathanw }
1063 1.19.8.2 nathanw
1064 1.19.8.2 nathanw
1065 1.19.8.2 nathanw /*
1066 1.19.8.2 nathanw * bits can be: TIOCM_DTR, TIOCM_RTS, TIOCM_CTS, TIOCM_CD, TIOCM_RI, TIOCM_DSR
1067 1.19.8.2 nathanw */
1068 1.19.8.2 nathanw int
1069 1.19.8.2 nathanw mscmctl(dev_t dev, int bits, int how)
1070 1.19.8.2 nathanw {
1071 1.19.8.2 nathanw struct mscdevice *msc;
1072 1.19.8.2 nathanw volatile struct mscstatus *ms;
1073 1.19.8.2 nathanw int slot;
1074 1.19.8.2 nathanw int s;
1075 1.19.8.2 nathanw u_char newcmd;
1076 1.19.8.2 nathanw int OldFlags;
1077 1.19.8.2 nathanw
1078 1.19.8.2 nathanw /* get the device structure */
1079 1.19.8.2 nathanw slot = MSCSLOT(dev);
1080 1.19.8.2 nathanw
1081 1.19.8.2 nathanw if (slot >= MSCSLOTS)
1082 1.19.8.2 nathanw return ENXIO;
1083 1.19.8.2 nathanw
1084 1.19.8.2 nathanw msc = &mscdev[slot];
1085 1.19.8.2 nathanw
1086 1.19.8.2 nathanw if (!msc->active)
1087 1.19.8.2 nathanw return ENXIO;
1088 1.19.8.2 nathanw
1089 1.19.8.2 nathanw s = spltty();
1090 1.19.8.2 nathanw
1091 1.19.8.2 nathanw if (how != DMGET) {
1092 1.19.8.2 nathanw OldFlags = msc->flags;
1093 1.19.8.2 nathanw bits &= TIOCM_DTR | TIOCM_RTS; /* can only modify DTR and RTS */
1094 1.19.8.2 nathanw
1095 1.19.8.2 nathanw switch (how) {
1096 1.19.8.2 nathanw case DMSET:
1097 1.19.8.2 nathanw msc->flags = (bits | (msc->flags & ~(TIOCM_DTR | TIOCM_RTS)));
1098 1.19.8.2 nathanw break;
1099 1.19.8.2 nathanw
1100 1.19.8.2 nathanw case DMBIC:
1101 1.19.8.2 nathanw msc->flags &= ~bits;
1102 1.19.8.2 nathanw break;
1103 1.19.8.2 nathanw
1104 1.19.8.2 nathanw case DMBIS:
1105 1.19.8.2 nathanw msc->flags |= bits;
1106 1.19.8.2 nathanw break;
1107 1.19.8.2 nathanw }
1108 1.19.8.2 nathanw
1109 1.19.8.2 nathanw /* modify modem control state */
1110 1.19.8.2 nathanw ms = &msc->board->Status[msc->port];
1111 1.19.8.2 nathanw
1112 1.19.8.2 nathanw if (msc->flags & TIOCM_RTS) /* was bits & */
1113 1.19.8.2 nathanw newcmd = MSCCMD_RTSOn;
1114 1.19.8.2 nathanw else /* this doesn't actually work now */
1115 1.19.8.2 nathanw newcmd = MSCCMD_RTSOff;
1116 1.19.8.2 nathanw
1117 1.19.8.2 nathanw if (msc->flags & TIOCM_DTR) /* was bits & */
1118 1.19.8.2 nathanw newcmd |= MSCCMD_Enable;
1119 1.19.8.2 nathanw
1120 1.19.8.2 nathanw ms->Command = (ms->Command & (~MSCCMD_RTSMask & ~MSCCMD_Enable)) | newcmd;
1121 1.19.8.2 nathanw ms->Setup = TRUE;
1122 1.19.8.2 nathanw
1123 1.19.8.2 nathanw /* if we've dropped DTR, bitbucket any pending output */
1124 1.19.8.2 nathanw if ( (OldFlags & TIOCM_DTR) && ((bits & TIOCM_DTR) == 0))
1125 1.19.8.2 nathanw ms->OutFlush = TRUE;
1126 1.19.8.2 nathanw }
1127 1.19.8.2 nathanw
1128 1.19.8.2 nathanw bits = msc->flags;
1129 1.19.8.2 nathanw
1130 1.19.8.2 nathanw (void) splx(s);
1131 1.19.8.2 nathanw
1132 1.19.8.2 nathanw return(bits);
1133 1.19.8.2 nathanw }
1134 1.19.8.2 nathanw
1135 1.19.8.2 nathanw
1136 1.19.8.2 nathanw struct tty *
1137 1.19.8.2 nathanw msctty(dev_t dev)
1138 1.19.8.2 nathanw {
1139 1.19.8.2 nathanw return(msc_tty[MSCTTY(dev)]);
1140 1.19.8.2 nathanw }
1141 1.19.8.2 nathanw
1142 1.19.8.2 nathanw
1143 1.19.8.2 nathanw /*
1144 1.19.8.2 nathanw * Load JM's freely redistributable A2232 6502c code. Let turbo detector
1145 1.19.8.2 nathanw * run for a while too.
1146 1.19.8.2 nathanw */
1147 1.19.8.2 nathanw
1148 1.19.8.2 nathanw int
1149 1.19.8.2 nathanw mscinitcard(struct zbus_args *zap)
1150 1.19.8.2 nathanw {
1151 1.19.8.2 nathanw int bcount;
1152 1.19.8.2 nathanw short start;
1153 1.19.8.2 nathanw u_char *from;
1154 1.19.8.2 nathanw volatile u_char *to;
1155 1.19.8.2 nathanw volatile struct mscmemory *mlm;
1156 1.19.8.2 nathanw
1157 1.19.8.2 nathanw mlm = (volatile struct mscmemory *)zap->va;
1158 1.19.8.2 nathanw (void)mlm->Enable6502Reset;
1159 1.19.8.2 nathanw
1160 1.19.8.2 nathanw /* copy the code across to the board */
1161 1.19.8.2 nathanw to = (u_char *)mlm;
1162 1.19.8.2 nathanw from = msc6502code; bcount = sizeof(msc6502code) - 2;
1163 1.19.8.2 nathanw start = *(short *)from; from += sizeof(start);
1164 1.19.8.2 nathanw to += start;
1165 1.19.8.2 nathanw
1166 1.19.8.2 nathanw while(bcount--) *to++ = *from++;
1167 1.19.8.2 nathanw
1168 1.19.8.2 nathanw mlm->Common.Crystal = MSC_UNKNOWN; /* use automatic speed check */
1169 1.19.8.2 nathanw
1170 1.19.8.2 nathanw /* start 6502 running */
1171 1.19.8.2 nathanw (void)mlm->ResetBoard;
1172 1.19.8.2 nathanw
1173 1.19.8.2 nathanw /* wait until speed detector has finished */
1174 1.19.8.2 nathanw for (bcount = 0; bcount < 200; bcount++) {
1175 1.19.8.2 nathanw delay(10000);
1176 1.19.8.2 nathanw if (mlm->Common.Crystal)
1177 1.19.8.2 nathanw break;
1178 1.19.8.2 nathanw }
1179 1.19.8.2 nathanw
1180 1.19.8.2 nathanw return(0);
1181 1.19.8.2 nathanw }
1182 1.19.8.2 nathanw
1183 1.19.8.2 nathanw #endif /* NMSC > 0 */
1184