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