Home | History | Annotate | Line # | Download | only in sbus
magma.c revision 1.32.12.1
      1  1.32.12.1      tron /*	$NetBSD: magma.c,v 1.32.12.1 2006/05/24 15:50:29 tron Exp $	*/
      2        1.1        pk /*
      3        1.1        pk  * magma.c
      4        1.1        pk  *
      5        1.1        pk  * Copyright (c) 1998 Iain Hibbert
      6        1.1        pk  * All rights reserved.
      7        1.1        pk  *
      8        1.1        pk  * Redistribution and use in source and binary forms, with or without
      9        1.1        pk  * modification, are permitted provided that the following conditions
     10        1.1        pk  * are met:
     11        1.1        pk  * 1. Redistributions of source code must retain the above copyright
     12        1.1        pk  *    notice, this list of conditions and the following disclaimer.
     13        1.1        pk  * 2. Redistributions in binary form must reproduce the above copyright
     14        1.1        pk  *    notice, this list of conditions and the following disclaimer in the
     15        1.1        pk  *    documentation and/or other materials provided with the distribution.
     16        1.1        pk  * 3. All advertising materials mentioning features or use of this software
     17        1.1        pk  *    must display the following acknowledgement:
     18        1.1        pk  *	This product includes software developed by Iain Hibbert
     19        1.1        pk  * 4. The name of the author may not be used to endorse or promote products
     20        1.1        pk  *    derived from this software without specific prior written permission.
     21        1.1        pk  *
     22        1.1        pk  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     23        1.1        pk  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24        1.1        pk  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25        1.1        pk  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     26        1.1        pk  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     27        1.1        pk  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     28        1.1        pk  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     29        1.1        pk  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     30        1.1        pk  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     31        1.1        pk  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32        1.1        pk  *
     33        1.2        pk  */
     34        1.1        pk 
     35        1.1        pk /*
     36        1.1        pk  * Driver for Magma SBus Serial/Parallel cards using the Cirrus Logic
     37        1.1        pk  * CD1400 & CD1190 chips
     38        1.1        pk  */
     39       1.12     lukem 
     40       1.12     lukem #include <sys/cdefs.h>
     41  1.32.12.1      tron __KERNEL_RCSID(0, "$NetBSD: magma.c,v 1.32.12.1 2006/05/24 15:50:29 tron Exp $");
     42       1.12     lukem 
     43       1.12     lukem #if 0
     44       1.12     lukem #define MAGMA_DEBUG
     45       1.12     lukem #endif
     46        1.1        pk 
     47        1.1        pk #include "magma.h"
     48        1.1        pk #if NMAGMA > 0
     49        1.1        pk 
     50        1.1        pk #include <sys/param.h>
     51        1.1        pk #include <sys/systm.h>
     52        1.1        pk #include <sys/proc.h>
     53        1.1        pk #include <sys/device.h>
     54        1.1        pk #include <sys/file.h>
     55        1.1        pk #include <sys/ioctl.h>
     56        1.1        pk #include <sys/malloc.h>
     57        1.1        pk #include <sys/tty.h>
     58        1.1        pk #include <sys/time.h>
     59        1.1        pk #include <sys/kernel.h>
     60        1.1        pk #include <sys/syslog.h>
     61        1.1        pk #include <sys/conf.h>
     62        1.1        pk #include <sys/errno.h>
     63  1.32.12.1      tron #include <sys/kauth.h>
     64        1.1        pk 
     65        1.1        pk #include <machine/bus.h>
     66        1.8        pk #include <machine/intr.h>
     67        1.4        pk #include <machine/autoconf.h>
     68        1.8        pk 
     69        1.4        pk #include <dev/sbus/sbusvar.h>
     70        1.1        pk 
     71        1.1        pk #include <dev/ic/cd1400reg.h>
     72        1.1        pk #include <dev/ic/cd1190reg.h>
     73        1.1        pk 
     74        1.4        pk #include <dev/sbus/mbppio.h>
     75        1.4        pk #include <dev/sbus/magmareg.h>
     76        1.1        pk 
     77        1.1        pk /* supported cards
     78        1.1        pk  *
     79        1.1        pk  *  The table below lists the cards that this driver is likely to
     80        1.1        pk  *  be able to support.
     81        1.1        pk  *
     82        1.1        pk  *  Cards with parallel ports: except for the LC2+1Sp, they all use
     83        1.1        pk  *  the CD1190 chip which I know nothing about.  I've tried to leave
     84        1.1        pk  *  hooks for it so it shouldn't be too hard to add support later.
     85        1.1        pk  *  (I think somebody is working on this separately)
     86        1.1        pk  *
     87        1.1        pk  *  Thanks to Bruce at Magma for telling me the hardware offsets.
     88        1.1        pk  */
     89        1.1        pk static struct magma_board_info supported_cards[] = {
     90        1.1        pk 	{
     91       1.13        pk 		"MAGMA_Sp", "MAGMA,4_Sp", "Magma 4 Sp", 4, 0,
     92        1.1        pk 		1, 0xa000, 0xc000, 0xe000, { 0x8000, 0, 0, 0 },
     93        1.1        pk 		0, { 0, 0 }
     94        1.1        pk 	},
     95        1.1        pk 	{
     96       1.13        pk 		"MAGMA_Sp", "MAGMA,8_Sp", "Magma 8 Sp", 8, 0,
     97        1.1        pk 		2, 0xa000, 0xc000, 0xe000, { 0x4000, 0x6000, 0, 0 },
     98        1.1        pk 		0, { 0, 0 }
     99        1.1        pk 	},
    100        1.1        pk 	{
    101       1.13        pk 		"MAGMA_Sp", "MAGMA,_8HS_Sp", "Magma Fast 8 Sp", 8, 0,
    102        1.1        pk 		2, 0x2000, 0x4000, 0x6000, { 0x8000, 0xa000, 0, 0 },
    103        1.1        pk 		0, { 0, 0 }
    104        1.1        pk 	},
    105        1.1        pk 	{
    106       1.13        pk 		"MAGMA_Sp", "MAGMA,_8SP_422", "Magma 8 Sp - 422", 8, 0,
    107        1.1        pk 		2, 0x2000, 0x4000, 0x6000, { 0x8000, 0xa000, 0, 0 },
    108        1.1        pk 		0, { 0, 0 }
    109        1.1        pk 	},
    110        1.1        pk 	{
    111       1.13        pk 		"MAGMA_Sp", "MAGMA,12_Sp", "Magma 12 Sp", 12, 0,
    112        1.1        pk 		3, 0xa000, 0xc000, 0xe000, { 0x2000, 0x4000, 0x6000, 0 },
    113        1.1        pk 		0, { 0, 0 }
    114        1.1        pk 	},
    115        1.1        pk 	{
    116       1.13        pk 		"MAGMA_Sp", "MAGMA,16_Sp", "Magma 16 Sp", 16, 0,
    117        1.1        pk 		4, 0xd000, 0xe000, 0xf000, { 0x8000, 0x9000, 0xa000, 0xb000 },
    118        1.1        pk 		0, { 0, 0 }
    119        1.1        pk 	},
    120        1.1        pk 	{
    121       1.13        pk 		"MAGMA_Sp", "MAGMA,16_Sp_2", "Magma 16 Sp", 16, 0,
    122        1.1        pk 		4, 0x2000, 0x4000, 0x6000, { 0x8000, 0xa000, 0xc000, 0xe000 },
    123        1.1        pk 		0, { 0, 0 }
    124        1.1        pk 	},
    125        1.1        pk 	{
    126       1.13        pk 		"MAGMA_Sp", "MAGMA,16HS_Sp", "Magma Fast 16 Sp", 16, 0,
    127        1.1        pk 		4, 0x2000, 0x4000, 0x6000, { 0x8000, 0xa000, 0xc000, 0xe000 },
    128        1.1        pk 		0, { 0, 0 }
    129        1.1        pk 	},
    130        1.1        pk 	{
    131       1.13        pk 		"MAGMA_Sp", "MAGMA,21_Sp", "Magma LC 2+1 Sp", 2, 1,
    132        1.1        pk 		1, 0xa000, 0xc000, 0xe000, { 0x8000, 0, 0, 0 },
    133        1.1        pk 		0, { 0, 0 }
    134        1.1        pk 	},
    135        1.1        pk 	{
    136       1.13        pk 		"MAGMA_Sp", "MAGMA,21HS_Sp", "Magma 2+1 Sp", 2, 1,
    137        1.1        pk 		1, 0xa000, 0xc000, 0xe000, { 0x4000, 0, 0, 0 },
    138        1.1        pk 		1, { 0x6000, 0 }
    139        1.1        pk 	},
    140        1.1        pk 	{
    141       1.13        pk 		"MAGMA_Sp", "MAGMA,41_Sp", "Magma 4+1 Sp", 4, 1,
    142        1.1        pk 		1, 0xa000, 0xc000, 0xe000, { 0x4000, 0, 0, 0 },
    143        1.1        pk 		1, { 0x6000, 0 }
    144        1.1        pk 	},
    145        1.1        pk 	{
    146       1.13        pk 		"MAGMA_Sp", "MAGMA,82_Sp", "Magma 8+2 Sp", 8, 2,
    147        1.1        pk 		2, 0xd000, 0xe000, 0xf000, { 0x8000, 0x9000, 0, 0 },
    148        1.1        pk 		2, { 0xa000, 0xb000 }
    149        1.1        pk 	},
    150        1.1        pk 	{
    151       1.13        pk 		"MAGMA_Sp", "MAGMA,P1_Sp", "Magma P1 Sp", 0, 1,
    152        1.1        pk 		0, 0, 0, 0, { 0, 0, 0, 0 },
    153        1.1        pk 		1, { 0x8000, 0 }
    154        1.1        pk 	},
    155        1.1        pk 	{
    156       1.13        pk 		"MAGMA_Sp", "MAGMA,P2_Sp", "Magma P2 Sp", 0, 2,
    157        1.1        pk 		0, 0, 0, 0, { 0, 0, 0, 0 },
    158        1.1        pk 		2, { 0x4000, 0x8000 }
    159        1.1        pk 	},
    160        1.1        pk 	{
    161       1.13        pk 		"MAGMA 2+1HS Sp", "", "Magma 2+1HS Sp", 2, 0,
    162       1.13        pk 		1, 0xa000, 0xc000, 0xe000, { 0x4000, 0, 0, 0 },
    163       1.13        pk 		1, { 0x8000, 0 }
    164       1.13        pk 	},
    165       1.13        pk 	{
    166       1.13        pk 		NULL, NULL, NULL, 0, 0,
    167        1.1        pk 		0, 0, 0, 0, { 0, 0, 0, 0 },
    168        1.1        pk 		0, { 0, 0 }
    169        1.1        pk 	}
    170        1.1        pk };
    171        1.1        pk 
    172        1.1        pk /************************************************************************
    173        1.1        pk  *
    174        1.1        pk  *  Autoconfig Stuff
    175        1.1        pk  */
    176        1.1        pk 
    177       1.19   thorpej CFATTACH_DECL(magma, sizeof(struct magma_softc),
    178       1.20   thorpej     magma_match, magma_attach, NULL, NULL);
    179        1.1        pk 
    180       1.19   thorpej CFATTACH_DECL(mtty, sizeof(struct mtty_softc),
    181       1.20   thorpej     mtty_match, mtty_attach, NULL, NULL);
    182        1.1        pk 
    183       1.19   thorpej CFATTACH_DECL(mbpp, sizeof(struct mbpp_softc),
    184       1.20   thorpej     mbpp_match, mbpp_attach, NULL, NULL);
    185        1.1        pk 
    186        1.1        pk extern struct cfdriver mtty_cd;
    187        1.1        pk extern struct cfdriver mbpp_cd;
    188        1.1        pk 
    189       1.17   gehenna dev_type_open(mttyopen);
    190       1.17   gehenna dev_type_close(mttyclose);
    191       1.17   gehenna dev_type_read(mttyread);
    192       1.17   gehenna dev_type_write(mttywrite);
    193       1.17   gehenna dev_type_ioctl(mttyioctl);
    194       1.17   gehenna dev_type_stop(mttystop);
    195       1.17   gehenna dev_type_tty(mttytty);
    196       1.17   gehenna dev_type_poll(mttypoll);
    197       1.17   gehenna 
    198       1.17   gehenna const struct cdevsw mtty_cdevsw = {
    199       1.17   gehenna 	mttyopen, mttyclose, mttyread, mttywrite, mttyioctl,
    200       1.21  jdolecek 	mttystop, mttytty, mttypoll, nommap, ttykqfilter, D_TTY
    201       1.17   gehenna };
    202       1.17   gehenna 
    203       1.17   gehenna dev_type_open(mbppopen);
    204       1.17   gehenna dev_type_close(mbppclose);
    205       1.17   gehenna dev_type_read(mbpp_rw);
    206       1.17   gehenna dev_type_ioctl(mbppioctl);
    207       1.17   gehenna 
    208       1.17   gehenna const struct cdevsw mbpp_cdevsw = {
    209       1.17   gehenna 	mbppopen, mbppclose, mbpp_rw, mbpp_rw, mbppioctl,
    210       1.21  jdolecek 	nostop, notty, nopoll, nommap, nokqfilter,
    211       1.17   gehenna };
    212       1.17   gehenna 
    213        1.1        pk /************************************************************************
    214        1.1        pk  *
    215        1.1        pk  *  CD1400 Routines
    216        1.1        pk  *
    217        1.1        pk  *	cd1400_compute_baud		calculate COR/BPR register values
    218        1.1        pk  *	cd1400_write_ccr		write a value to CD1400 ccr
    219        1.1        pk  *	cd1400_read_reg			read from a CD1400 register
    220        1.1        pk  *	cd1400_write_reg		write to a CD1400 register
    221        1.1        pk  *	cd1400_enable_transmitter	enable transmitting on CD1400 channel
    222        1.1        pk  */
    223        1.1        pk 
    224        1.1        pk /*
    225        1.1        pk  * compute the bpr/cor pair for any baud rate
    226        1.1        pk  * returns 0 for success, 1 for failure
    227        1.1        pk  */
    228        1.1        pk int
    229        1.1        pk cd1400_compute_baud(speed, clock, cor, bpr)
    230        1.1        pk 	speed_t speed;
    231        1.1        pk 	int clock;
    232        1.1        pk 	int *cor, *bpr;
    233        1.1        pk {
    234        1.1        pk 	int c, co, br;
    235        1.1        pk 
    236        1.1        pk 	if( speed < 50 || speed > 150000 )
    237        1.1        pk 		return(1);
    238        1.1        pk 
    239        1.1        pk 	for( c = 0, co = 8 ; co <= 2048 ; co <<= 2, c++ ) {
    240        1.1        pk 		br = ((clock * 1000000) + (co * speed) / 2) / (co * speed);
    241        1.1        pk 		if( br < 0x100 ) {
    242        1.1        pk 			*bpr = br;
    243        1.1        pk 			*cor = c;
    244        1.1        pk 			return(0);
    245        1.1        pk 		}
    246        1.1        pk 	}
    247        1.1        pk 
    248        1.1        pk 	return(1);
    249        1.1        pk }
    250        1.1        pk 
    251        1.1        pk /*
    252        1.1        pk  * Write a CD1400 channel command, should have a timeout?
    253        1.1        pk  */
    254       1.32     perry inline void
    255        1.1        pk cd1400_write_ccr(cd, cmd)
    256        1.1        pk 	struct cd1400 *cd;
    257        1.1        pk 	u_char cmd;
    258        1.1        pk {
    259        1.1        pk 	while( cd1400_read_reg(cd, CD1400_CCR) )
    260        1.1        pk 		;
    261        1.1        pk 
    262        1.1        pk 	cd1400_write_reg(cd, CD1400_CCR, cmd);
    263        1.1        pk }
    264        1.1        pk 
    265        1.1        pk /*
    266        1.1        pk  * read a value from a cd1400 register
    267        1.1        pk  */
    268       1.32     perry inline u_char
    269        1.1        pk cd1400_read_reg(cd, reg)
    270        1.1        pk 	struct cd1400 *cd;
    271        1.1        pk 	int reg;
    272        1.1        pk {
    273        1.1        pk 	return(cd->cd_reg[reg]);
    274        1.1        pk }
    275        1.1        pk 
    276        1.1        pk /*
    277        1.1        pk  * write a value to a cd1400 register
    278        1.1        pk  */
    279       1.32     perry inline void
    280        1.1        pk cd1400_write_reg(cd, reg, value)
    281        1.1        pk 	struct cd1400 *cd;
    282        1.1        pk 	int reg;
    283        1.1        pk 	u_char value;
    284        1.1        pk {
    285        1.1        pk 	cd->cd_reg[reg] = value;
    286        1.1        pk }
    287        1.1        pk 
    288        1.1        pk /*
    289        1.1        pk  * enable transmit service requests for cd1400 channel
    290        1.1        pk  */
    291        1.1        pk void
    292        1.1        pk cd1400_enable_transmitter(cd, channel)
    293        1.1        pk 	struct cd1400 *cd;
    294        1.1        pk 	int channel;
    295        1.1        pk {
    296        1.1        pk 	int s, srer;
    297        1.1        pk 
    298        1.1        pk 	s = spltty();
    299        1.1        pk 	cd1400_write_reg(cd, CD1400_CAR, channel);
    300        1.1        pk 	srer = cd1400_read_reg(cd, CD1400_SRER);
    301        1.1        pk 	SET(srer, CD1400_SRER_TXRDY);
    302        1.1        pk 	cd1400_write_reg(cd, CD1400_SRER, srer);
    303        1.1        pk 	splx(s);
    304        1.1        pk }
    305        1.1        pk 
    306        1.1        pk /************************************************************************
    307        1.1        pk  *
    308        1.1        pk  *  CD1190 Routines
    309        1.1        pk  */
    310        1.1        pk 
    311        1.1        pk /* well, there are none yet */
    312        1.1        pk 
    313        1.1        pk /************************************************************************
    314        1.1        pk  *
    315        1.1        pk  *  Magma Routines
    316        1.1        pk  *
    317        1.1        pk  * magma_match		reports if we have a magma board available
    318        1.1        pk  * magma_attach		attaches magma boards to the sbus
    319        1.1        pk  * magma_hard		hardware level interrupt routine
    320        1.1        pk  * magma_soft		software level interrupt routine
    321        1.1        pk  */
    322        1.1        pk 
    323        1.1        pk int
    324        1.1        pk magma_match(parent, cf, aux)
    325        1.1        pk 	struct device *parent;
    326        1.1        pk 	struct cfdata *cf;
    327        1.1        pk 	void *aux;
    328        1.1        pk {
    329        1.1        pk 	struct sbus_attach_args *sa = aux;
    330       1.13        pk 	struct magma_board_info *card;
    331        1.1        pk 
    332       1.13        pk 	/* See if we support this device */
    333       1.13        pk 	for (card = supported_cards; ; card++) {
    334       1.13        pk 		if (card->mb_sbusname == NULL)
    335       1.13        pk 			/* End of table: no match */
    336       1.13        pk 			return (0);
    337       1.13        pk 		if (strcmp(sa->sa_name, card->mb_sbusname) == 0)
    338       1.13        pk 			break;
    339       1.13        pk 	}
    340        1.1        pk 
    341        1.3        pk 	dprintf(("magma: matched `%s'\n", sa->sa_name));
    342        1.3        pk 	dprintf(("magma: magma_prom `%s'\n",
    343       1.28        pk 		prom_getpropstring(sa->sa_node, "magma_prom")));
    344        1.3        pk 	dprintf(("magma: intlevels `%s'\n",
    345       1.28        pk 		prom_getpropstring(sa->sa_node, "intlevels")));
    346        1.3        pk 	dprintf(("magma: chiprev `%s'\n",
    347       1.28        pk 		prom_getpropstring(sa->sa_node, "chiprev")));
    348        1.3        pk 	dprintf(("magma: clock `%s'\n",
    349       1.28        pk 		prom_getpropstring(sa->sa_node, "clock")));
    350        1.1        pk 
    351        1.1        pk 	return (1);
    352        1.1        pk }
    353        1.1        pk 
    354        1.1        pk void
    355        1.1        pk magma_attach(parent, self, aux)
    356        1.1        pk 	struct device *parent;
    357        1.1        pk 	struct device *self;
    358        1.1        pk 	void *aux;
    359        1.1        pk {
    360        1.1        pk 	struct sbus_attach_args *sa = aux;
    361        1.1        pk 	struct magma_softc *sc = (struct magma_softc *)self;
    362       1.13        pk 	struct magma_board_info *card;
    363        1.1        pk 	bus_space_handle_t bh;
    364       1.13        pk 	char *magma_prom, *clockstr;
    365       1.13        pk 	int cd_clock;
    366        1.1        pk 	int node, chip;
    367        1.1        pk 
    368        1.1        pk 	node = sa->sa_node;
    369       1.13        pk 
    370       1.13        pk 	/*
    371       1.13        pk 	 * Find the card model.
    372       1.13        pk 	 * Older models all have sbus node name `MAGMA_Sp' (see
    373       1.13        pk 	 * `supported_cards[]' above), and must be distinguished
    374       1.13        pk 	 * by the `magma_prom' property.
    375       1.13        pk 	 */
    376       1.28        pk 	magma_prom = prom_getpropstring(node, "magma_prom");
    377        1.1        pk 
    378       1.13        pk 	for (card = supported_cards; card->mb_name != NULL; card++) {
    379       1.13        pk 		if (strcmp(sa->sa_name, card->mb_sbusname) != 0)
    380       1.13        pk 			/* Sbus node name doesn't match */
    381       1.13        pk 			continue;
    382       1.13        pk 		if (strcmp(magma_prom, card->mb_name) == 0)
    383       1.13        pk 			/* Model name match */
    384       1.13        pk 			break;
    385       1.13        pk 	}
    386        1.1        pk 
    387        1.1        pk 	if( card->mb_name == NULL ) {
    388       1.13        pk 		printf(": %s (unsupported)\n", magma_prom);
    389        1.1        pk 		return;
    390        1.1        pk 	}
    391        1.1        pk 
    392       1.13        pk 	dprintf((" addr %p", sc));
    393       1.22        pk 	printf(": %s\n", card->mb_realname);
    394        1.1        pk 
    395        1.1        pk 	sc->ms_board = card;
    396        1.1        pk 	sc->ms_ncd1400 = card->mb_ncd1400;
    397        1.1        pk 	sc->ms_ncd1190 = card->mb_ncd1190;
    398        1.1        pk 
    399        1.1        pk 	if (sbus_bus_map(sa->sa_bustag,
    400       1.14        pk 			 sa->sa_slot, sa->sa_offset, sa->sa_size,
    401       1.14        pk 			 BUS_SPACE_MAP_LINEAR, &bh) != 0) {
    402        1.1        pk 		printf("%s @ sbus: cannot map registers\n", self->dv_xname);
    403        1.1        pk 		return;
    404        1.1        pk 	}
    405        1.1        pk 
    406        1.1        pk 	/* the SVCACK* lines are daisychained */
    407       1.16       eeh 	sc->ms_svcackr = (caddr_t)bus_space_vaddr(sa->sa_bustag, bh)
    408       1.16       eeh 		+ card->mb_svcackr;
    409       1.16       eeh 	sc->ms_svcackt = (caddr_t)bus_space_vaddr(sa->sa_bustag, bh)
    410       1.16       eeh 		+ card->mb_svcackt;
    411       1.16       eeh 	sc->ms_svcackm = (caddr_t)bus_space_vaddr(sa->sa_bustag, bh)
    412       1.16       eeh 		+ card->mb_svcackm;
    413        1.1        pk 
    414       1.13        pk 	/*
    415       1.13        pk 	 * Find the clock speed; it's the same for all CD1400 chips
    416       1.13        pk 	 * on the board.
    417       1.13        pk 	 */
    418       1.28        pk 	clockstr = prom_getpropstring(node, "clock");
    419       1.13        pk 	if (*clockstr == '\0')
    420       1.13        pk 		/* Default to 25MHz */
    421       1.13        pk 		cd_clock = 25;
    422       1.13        pk 	else {
    423       1.13        pk 		cd_clock = 0;
    424       1.13        pk 		while (*clockstr != '\0')
    425       1.13        pk 			cd_clock = (cd_clock * 10) + (*clockstr++ - '0');
    426       1.13        pk 	}
    427       1.13        pk 
    428        1.1        pk 	/* init the cd1400 chips */
    429        1.1        pk 	for( chip = 0 ; chip < card->mb_ncd1400 ; chip++ ) {
    430        1.1        pk 		struct cd1400 *cd = &sc->ms_cd1400[chip];
    431        1.1        pk 
    432       1.13        pk 		cd->cd_clock = cd_clock;
    433        1.1        pk 		cd->cd_reg = (caddr_t)bh + card->mb_cd1400[chip];
    434        1.1        pk 
    435       1.28        pk 		/* prom_getpropstring(node, "chiprev"); */
    436        1.1        pk 		/* seemingly the Magma drivers just ignore the propstring */
    437        1.1        pk 		cd->cd_chiprev = cd1400_read_reg(cd, CD1400_GFRCR);
    438        1.1        pk 
    439       1.25   tsutsui 		dprintf(("%s attach CD1400 %d addr %p rev %x clock %dMHz\n",
    440        1.1        pk 			sc->ms_dev.dv_xname, chip,
    441        1.1        pk 			cd->cd_reg, cd->cd_chiprev, cd->cd_clock));
    442        1.1        pk 
    443        1.1        pk 		/* clear GFRCR */
    444        1.1        pk 		cd1400_write_reg(cd, CD1400_GFRCR, 0x00);
    445        1.1        pk 
    446        1.1        pk 		/* reset whole chip */
    447        1.1        pk 		cd1400_write_ccr(cd, CD1400_CCR_CMDRESET | CD1400_CCR_FULLRESET);
    448        1.1        pk 
    449        1.1        pk 		/* wait for revision code to be restored */
    450        1.1        pk 		while( cd1400_read_reg(cd, CD1400_GFRCR) != cd->cd_chiprev )
    451        1.1        pk 		        ;
    452        1.1        pk 
    453        1.1        pk 		/* set the Prescaler Period Register to tick at 1ms */
    454        1.1        pk 		cd1400_write_reg(cd, CD1400_PPR,
    455        1.1        pk 			((cd->cd_clock * 1000000 / CD1400_PPR_PRESCALER + 500) / 1000));
    456        1.1        pk 
    457        1.1        pk 		/* The LC2+1Sp card is the only card that doesn't have
    458        1.1        pk 		 * a CD1190 for the parallel port, but uses channel 0 of
    459        1.1        pk 		 * the CD1400, so we make a note of it for later and set up
    460        1.1        pk 		 * the CD1400 for parallel mode operation.
    461        1.1        pk 		 */
    462        1.1        pk 		if( card->mb_npar && card->mb_ncd1190 == 0 ) {
    463        1.1        pk 			cd1400_write_reg(cd, CD1400_GCR, CD1400_GCR_PARALLEL);
    464        1.1        pk 			cd->cd_parmode = 1;
    465        1.1        pk 		}
    466        1.1        pk 	}
    467        1.1        pk 
    468        1.1        pk 	/* init the cd1190 chips */
    469        1.1        pk 	for( chip = 0 ; chip < card->mb_ncd1190 ; chip++ ) {
    470        1.1        pk 		struct cd1190 *cd = &sc->ms_cd1190[chip];
    471        1.1        pk 
    472        1.1        pk 		cd->cd_reg = (caddr_t)bh + card->mb_cd1190[chip];
    473       1.13        pk 
    474        1.1        pk 		/* XXX don't know anything about these chips yet */
    475       1.13        pk 		printf("%s: CD1190 %d addr %p (unsupported)\n",
    476       1.13        pk 			self->dv_xname, chip, cd->cd_reg);
    477        1.1        pk 	}
    478        1.1        pk 
    479        1.1        pk 	sbus_establish(&sc->ms_sd, &sc->ms_dev);
    480        1.1        pk 
    481        1.1        pk 	/* configure the children */
    482        1.1        pk 	(void)config_found(self, mtty_match, NULL);
    483        1.1        pk 	(void)config_found(self, mbpp_match, NULL);
    484        1.1        pk 
    485        1.1        pk 	/*
    486        1.1        pk 	 * Establish the interrupt handlers.
    487        1.1        pk 	 */
    488        1.5        pk 	if (sa->sa_nintr == 0)
    489        1.5        pk 		return;		/* No interrupts to service!? */
    490        1.5        pk 
    491       1.24        pk 	(void)bus_intr_establish(sa->sa_bustag, sa->sa_pri, IPL_SERIAL,
    492       1.23        pk 				 magma_hard, sc);
    493       1.22        pk 	sc->ms_sicookie = softintr_establish(IPL_SOFTSERIAL, magma_soft, sc);
    494       1.22        pk 	if (sc->ms_sicookie == NULL) {
    495       1.22        pk 		printf("\n%s: cannot establish soft int handler\n",
    496       1.22        pk 			sc->ms_dev.dv_xname);
    497       1.22        pk 		return;
    498       1.22        pk 	}
    499        1.7       cgd 	evcnt_attach_dynamic(&sc->ms_intrcnt, EVCNT_TYPE_INTR, NULL,
    500        1.7       cgd 	    sc->ms_dev.dv_xname, "intr");
    501        1.1        pk }
    502        1.1        pk 
    503        1.1        pk /*
    504        1.1        pk  * hard interrupt routine
    505        1.1        pk  *
    506        1.1        pk  *  returns 1 if it handled it, otherwise 0
    507        1.1        pk  *
    508        1.1        pk  *  runs at interrupt priority
    509        1.1        pk  */
    510        1.1        pk int
    511        1.1        pk magma_hard(arg)
    512        1.1        pk 	void *arg;
    513        1.1        pk {
    514        1.1        pk 	struct magma_softc *sc = arg;
    515        1.1        pk 	struct cd1400 *cd;
    516        1.1        pk 	int chip, status = 0;
    517        1.1        pk 	int serviced = 0;
    518        1.1        pk 	int needsoftint = 0;
    519        1.1        pk 
    520        1.1        pk 	/*
    521        1.1        pk 	 * check status of all the CD1400 chips
    522        1.1        pk 	 */
    523        1.1        pk 	for( chip = 0 ; chip < sc->ms_ncd1400 ; chip++ )
    524        1.1        pk 		status |= cd1400_read_reg(&sc->ms_cd1400[chip], CD1400_SVRR);
    525        1.1        pk 
    526        1.1        pk 	if( ISSET(status, CD1400_SVRR_RXRDY) ) {
    527        1.1        pk 		u_char rivr = *sc->ms_svcackr;	/* enter rx service context */
    528        1.1        pk 		int port = rivr >> 4;
    529        1.1        pk 
    530        1.1        pk 		if( rivr & (1<<3) ) {			/* parallel port */
    531        1.3        pk 			struct mbpp_port *mbpp;
    532        1.3        pk 			int n_chars;
    533        1.1        pk 
    534        1.3        pk 			mbpp = &sc->ms_mbpp->ms_port[port];
    535        1.1        pk 			cd = mbpp->mp_cd1400;
    536       1.29     perry 
    537        1.3        pk 			/* don't think we have to handle exceptions */
    538        1.3        pk 			n_chars = cd1400_read_reg(cd, CD1400_RDCR);
    539        1.3        pk 			while (n_chars--) {
    540        1.3        pk 				if( mbpp->mp_cnt == 0 ) {
    541        1.3        pk 					SET(mbpp->mp_flags, MBPPF_WAKEUP);
    542        1.3        pk 					needsoftint = 1;
    543        1.3        pk 					break;
    544        1.3        pk 				}
    545        1.3        pk 				*mbpp->mp_ptr = cd1400_read_reg(cd,CD1400_RDSR);
    546        1.3        pk 				mbpp->mp_ptr++;
    547        1.3        pk 				mbpp->mp_cnt--;
    548        1.3        pk 			}
    549        1.1        pk 		} else {				/* serial port */
    550        1.1        pk 			struct mtty_port *mtty;
    551        1.1        pk 			u_char *ptr, n_chars, line_stat;
    552        1.1        pk 
    553        1.1        pk 			mtty = &sc->ms_mtty->ms_port[port];
    554        1.1        pk 			cd = mtty->mp_cd1400;
    555        1.1        pk 
    556        1.1        pk 			if( ISSET(rivr, CD1400_RIVR_EXCEPTION) ) {
    557        1.1        pk 				line_stat = cd1400_read_reg(cd, CD1400_RDSR);
    558        1.1        pk 				n_chars = 1;
    559        1.1        pk 			} else { /* no exception, received data OK */
    560        1.1        pk 				line_stat = 0;
    561        1.1        pk 				n_chars = cd1400_read_reg(cd, CD1400_RDCR);
    562        1.1        pk 			}
    563        1.1        pk 
    564        1.1        pk 			ptr = mtty->mp_rput;
    565        1.1        pk 			while( n_chars-- ) {
    566        1.1        pk 				*ptr++ = line_stat;
    567        1.1        pk 				*ptr++ = cd1400_read_reg(cd, CD1400_RDSR);
    568        1.1        pk 				if( ptr == mtty->mp_rend ) ptr = mtty->mp_rbuf;
    569        1.1        pk 				if( ptr == mtty->mp_rget ) {
    570        1.1        pk 					if( ptr == mtty->mp_rbuf )
    571        1.1        pk 						ptr = mtty->mp_rend;
    572        1.1        pk 					ptr -= 2;
    573        1.1        pk 					SET(mtty->mp_flags, MTTYF_RING_OVERFLOW);
    574        1.1        pk 					break;
    575        1.1        pk 				}
    576        1.1        pk 			}
    577        1.1        pk 			mtty->mp_rput = ptr;
    578        1.1        pk 
    579        1.1        pk 			needsoftint = 1;
    580        1.1        pk 		}
    581        1.1        pk 
    582        1.1        pk 		cd1400_write_reg(cd, CD1400_EOSRR, 0);	/* end service context */
    583        1.1        pk 		serviced = 1;
    584        1.1        pk 	} /* if(rx_service...) */
    585        1.1        pk 
    586        1.1        pk 	if( ISSET(status, CD1400_SVRR_MDMCH) ) {
    587        1.1        pk 		u_char mivr = *sc->ms_svcackm;	/* enter mdm service context */
    588        1.1        pk 		int port = mivr >> 4;
    589        1.1        pk 		struct mtty_port *mtty;
    590        1.1        pk 		int carrier;
    591        1.1        pk 		u_char msvr;
    592        1.1        pk 
    593        1.1        pk 		/*
    594        1.1        pk 		 * Handle CD (LC2+1Sp = DSR) changes.
    595        1.1        pk 		 */
    596        1.1        pk 		mtty = &sc->ms_mtty->ms_port[port];
    597        1.1        pk 		cd = mtty->mp_cd1400;
    598        1.1        pk 		msvr = cd1400_read_reg(cd, CD1400_MSVR2);
    599        1.1        pk 		carrier = ISSET(msvr, cd->cd_parmode ? CD1400_MSVR2_DSR : CD1400_MSVR2_CD);
    600        1.1        pk 
    601        1.1        pk 		if( mtty->mp_carrier != carrier ) {
    602        1.1        pk 			SET(mtty->mp_flags, MTTYF_CARRIER_CHANGED);
    603        1.1        pk 			mtty->mp_carrier = carrier;
    604        1.1        pk 			needsoftint = 1;
    605        1.1        pk 		}
    606        1.1        pk 
    607        1.1        pk 		cd1400_write_reg(cd, CD1400_EOSRR, 0);	/* end service context */
    608        1.1        pk 		serviced = 1;
    609        1.1        pk 	} /* if(mdm_service...) */
    610        1.1        pk 
    611        1.1        pk 	if( ISSET(status, CD1400_SVRR_TXRDY) ) {
    612        1.2        pk 		u_char tivr = *sc->ms_svcackt;	/* enter tx service context */
    613        1.1        pk 		int port = tivr >> 4;
    614        1.1        pk 
    615        1.1        pk 		if( tivr & (1<<3) ) {	/* parallel port */
    616        1.1        pk 			struct mbpp_port *mbpp;
    617        1.1        pk 
    618        1.1        pk 			mbpp = &sc->ms_mbpp->ms_port[port];
    619        1.1        pk 			cd = mbpp->mp_cd1400;
    620        1.1        pk 
    621        1.3        pk 			if( mbpp->mp_cnt ) {
    622        1.1        pk 				int count = 0;
    623        1.1        pk 
    624        1.3        pk 				/* fill the fifo */
    625        1.3        pk 				while (mbpp->mp_cnt &&
    626        1.3        pk 					count++ < CD1400_PAR_FIFO_SIZE) {
    627        1.3        pk 					cd1400_write_reg(cd, CD1400_TDR,
    628        1.3        pk 							 *mbpp->mp_ptr);
    629        1.3        pk 					mbpp->mp_ptr++;
    630        1.3        pk 					mbpp->mp_cnt--;
    631        1.1        pk 				}
    632        1.1        pk 			} else {
    633        1.3        pk 				/*
    634        1.3        pk 				 * fifo is empty and we got no more data
    635        1.3        pk 				 * to send, so shut off interrupts and
    636        1.3        pk 				 * signal for a wakeup, which can't be
    637        1.3        pk 				 * done here in case we beat mbpp_send to
    638        1.3        pk 				 * the tsleep call (we are running at >spltty)
    639        1.3        pk 				 */
    640        1.3        pk 				cd1400_write_reg(cd, CD1400_SRER, 0);
    641        1.3        pk 				SET(mbpp->mp_flags, MBPPF_WAKEUP);
    642        1.1        pk 				needsoftint = 1;
    643        1.1        pk 			}
    644        1.1        pk 		} else {		/* serial port */
    645        1.1        pk 			struct mtty_port *mtty;
    646        1.1        pk 			struct tty *tp;
    647        1.1        pk 
    648        1.1        pk 			mtty = &sc->ms_mtty->ms_port[port];
    649        1.1        pk 			cd = mtty->mp_cd1400;
    650        1.1        pk 			tp = mtty->mp_tty;
    651        1.1        pk 
    652        1.1        pk 			if( !ISSET(mtty->mp_flags, MTTYF_STOP) ) {
    653        1.1        pk 				int count = 0;
    654        1.1        pk 
    655        1.1        pk 				/* check if we should start/stop a break */
    656        1.1        pk 				if( ISSET(mtty->mp_flags, MTTYF_SET_BREAK) ) {
    657        1.1        pk 					cd1400_write_reg(cd, CD1400_TDR, 0);
    658        1.1        pk 					cd1400_write_reg(cd, CD1400_TDR, 0x81);
    659        1.1        pk 					/* should we delay too? */
    660        1.1        pk 					CLR(mtty->mp_flags, MTTYF_SET_BREAK);
    661        1.1        pk 					count += 2;
    662        1.1        pk 				}
    663        1.1        pk 
    664        1.1        pk 				if( ISSET(mtty->mp_flags, MTTYF_CLR_BREAK) ) {
    665        1.1        pk 					cd1400_write_reg(cd, CD1400_TDR, 0);
    666        1.1        pk 					cd1400_write_reg(cd, CD1400_TDR, 0x83);
    667        1.1        pk 					CLR(mtty->mp_flags, MTTYF_CLR_BREAK);
    668        1.1        pk 					count += 2;
    669        1.1        pk 				}
    670        1.1        pk 
    671        1.1        pk 				/* I don't quite fill the fifo in case the last one is a
    672        1.1        pk 				 * NULL which I have to double up because its the escape
    673        1.1        pk 				 * code for embedded transmit characters.
    674        1.1        pk 				 */
    675        1.1        pk 				while( mtty->mp_txc > 0 && count < CD1400_TX_FIFO_SIZE - 1 ) {
    676        1.2        pk 					u_char ch;
    677        1.1        pk 
    678        1.1        pk 					ch = *mtty->mp_txp;
    679        1.1        pk 
    680        1.1        pk 					mtty->mp_txc--;
    681        1.1        pk 					mtty->mp_txp++;
    682        1.1        pk 
    683        1.1        pk 					if( ch == 0 ) {
    684        1.1        pk 						cd1400_write_reg(cd, CD1400_TDR, ch);
    685        1.1        pk 						count++;
    686        1.1        pk 					}
    687        1.1        pk 
    688        1.1        pk 					cd1400_write_reg(cd, CD1400_TDR, ch);
    689        1.1        pk 					count++;
    690        1.1        pk 				}
    691        1.1        pk 			}
    692        1.1        pk 
    693        1.1        pk 			/* if we ran out of work or are requested to STOP then
    694        1.1        pk 			 * shut off the txrdy interrupts and signal DONE to flush
    695        1.1        pk 			 * out the chars we have sent.
    696        1.1        pk 			 */
    697        1.1        pk 			if( mtty->mp_txc == 0 || ISSET(mtty->mp_flags, MTTYF_STOP) ) {
    698        1.2        pk 				register int srer;
    699        1.1        pk 
    700        1.1        pk 				srer = cd1400_read_reg(cd, CD1400_SRER);
    701        1.1        pk 				CLR(srer, CD1400_SRER_TXRDY);
    702        1.1        pk 				cd1400_write_reg(cd, CD1400_SRER, srer);
    703        1.1        pk 				CLR(mtty->mp_flags, MTTYF_STOP);
    704        1.1        pk 
    705        1.1        pk 				SET(mtty->mp_flags, MTTYF_DONE);
    706        1.1        pk 				needsoftint = 1;
    707        1.1        pk 			}
    708        1.1        pk 		}
    709        1.1        pk 
    710        1.1        pk 		cd1400_write_reg(cd, CD1400_EOSRR, 0);	/* end service context */
    711        1.1        pk 		serviced = 1;
    712        1.1        pk 	} /* if(tx_service...) */
    713        1.1        pk 
    714        1.1        pk 	/* XXX service CD1190 interrupts too
    715        1.1        pk 	for( chip = 0 ; chip < sc->ms_ncd1190 ; chip++ ) {
    716        1.1        pk 	}
    717        1.1        pk 	*/
    718        1.1        pk 
    719       1.22        pk 	if (needsoftint)
    720       1.22        pk 		/* trigger the soft interrupt */
    721       1.22        pk 		softintr_schedule(sc->ms_sicookie);
    722        1.1        pk 
    723        1.1        pk 	return(serviced);
    724        1.1        pk }
    725        1.1        pk 
    726        1.1        pk /*
    727        1.1        pk  * magma soft interrupt handler
    728        1.1        pk  *
    729        1.1        pk  *  returns 1 if it handled it, 0 otherwise
    730        1.1        pk  *
    731        1.1        pk  *  runs at spltty()
    732        1.1        pk  */
    733       1.22        pk void
    734        1.1        pk magma_soft(arg)
    735        1.1        pk 	void *arg;
    736        1.1        pk {
    737        1.1        pk 	struct magma_softc *sc = arg;
    738        1.1        pk 	struct mtty_softc *mtty = sc->ms_mtty;
    739        1.1        pk 	struct mbpp_softc *mbpp = sc->ms_mbpp;
    740        1.1        pk 	int port;
    741        1.1        pk 	int s, flags;
    742        1.1        pk 
    743        1.2        pk 	if (mtty == NULL)
    744        1.2        pk 		goto chkbpp;
    745        1.2        pk 
    746        1.1        pk 	/*
    747        1.1        pk 	 * check the tty ports to see what needs doing
    748        1.1        pk 	 */
    749        1.1        pk 	for( port = 0 ; port < mtty->ms_nports ; port++ ) {
    750        1.2        pk 		struct mtty_port *mp = &mtty->ms_port[port];
    751        1.2        pk 		struct tty *tp = mp->mp_tty;
    752        1.1        pk 
    753        1.2        pk 		if( !ISSET(tp->t_state, TS_ISOPEN) )
    754        1.2        pk 			continue;
    755        1.1        pk 
    756        1.1        pk 		/*
    757        1.1        pk 		 * handle any received data
    758        1.1        pk 		 */
    759        1.1        pk 		while( mp->mp_rget != mp->mp_rput ) {
    760        1.2        pk 			u_char stat;
    761        1.2        pk 			int data;
    762        1.1        pk 
    763        1.1        pk 			stat = mp->mp_rget[0];
    764        1.1        pk 			data = mp->mp_rget[1];
    765        1.2        pk 			mp->mp_rget = ((mp->mp_rget + 2) == mp->mp_rend)
    766        1.2        pk 				? mp->mp_rbuf : (mp->mp_rget + 2);
    767        1.1        pk 
    768        1.1        pk 			if( stat & (CD1400_RDSR_BREAK | CD1400_RDSR_FE) )
    769        1.1        pk 				data |= TTY_FE;
    770        1.1        pk 			if( stat & CD1400_RDSR_PE )
    771        1.1        pk 				data |= TTY_PE;
    772        1.1        pk 
    773        1.1        pk 			if( stat & CD1400_RDSR_OE )
    774        1.2        pk 				log(LOG_WARNING, "%s%x: fifo overflow\n",
    775        1.2        pk 				    mtty->ms_dev.dv_xname, port);
    776        1.1        pk 
    777        1.9       eeh 			(*tp->t_linesw->l_rint)(data, tp);
    778        1.1        pk 		}
    779        1.1        pk 
    780        1.1        pk 		s = splhigh();	/* block out hard interrupt routine */
    781        1.1        pk 		flags = mp->mp_flags;
    782        1.1        pk 		CLR(mp->mp_flags, MTTYF_DONE | MTTYF_CARRIER_CHANGED | MTTYF_RING_OVERFLOW);
    783        1.1        pk 		splx(s);	/* ok */
    784        1.1        pk 
    785        1.1        pk 		if( ISSET(flags, MTTYF_CARRIER_CHANGED) ) {
    786        1.3        pk 			dprintf(("%s%x: cd %s\n", mtty->ms_dev.dv_xname,
    787        1.3        pk 				port, mp->mp_carrier ? "on" : "off"));
    788        1.9       eeh 			(*tp->t_linesw->l_modem)(tp, mp->mp_carrier);
    789        1.1        pk 		}
    790        1.1        pk 
    791        1.1        pk 		if( ISSET(flags, MTTYF_RING_OVERFLOW) ) {
    792        1.3        pk 			log(LOG_WARNING, "%s%x: ring buffer overflow\n",
    793        1.3        pk 			    mtty->ms_dev.dv_xname, port);
    794        1.1        pk 		}
    795        1.1        pk 
    796        1.1        pk 		if( ISSET(flags, MTTYF_DONE) ) {
    797        1.1        pk 			ndflush(&tp->t_outq, mp->mp_txp - tp->t_outq.c_cf);
    798        1.1        pk 			CLR(tp->t_state, TS_BUSY);
    799        1.9       eeh 			(*tp->t_linesw->l_start)(tp);	/* might be some more */
    800        1.1        pk 		}
    801        1.1        pk 	} /* for(each mtty...) */
    802        1.1        pk 
    803        1.2        pk 
    804        1.2        pk chkbpp:
    805        1.1        pk 	/*
    806        1.2        pk 	 * Check the bpp ports (if any) to see what needs doing
    807        1.1        pk 	 */
    808        1.2        pk 	if (mbpp == NULL)
    809       1.22        pk 		return;
    810        1.2        pk 
    811        1.1        pk 	for( port = 0 ; port < mbpp->ms_nports ; port++ ) {
    812        1.2        pk 		struct mbpp_port *mp = &mbpp->ms_port[port];
    813        1.1        pk 
    814        1.2        pk 		if( !ISSET(mp->mp_flags, MBPPF_OPEN) )
    815        1.2        pk 			continue;
    816        1.1        pk 
    817        1.1        pk 		s = splhigh();
    818        1.1        pk 		flags = mp->mp_flags;
    819        1.3        pk 		CLR(mp->mp_flags, MBPPF_WAKEUP);
    820        1.1        pk 		splx(s);
    821        1.1        pk 
    822        1.3        pk 		if( ISSET(flags, MBPPF_WAKEUP) ) {
    823        1.1        pk 			wakeup(mp);
    824        1.1        pk 		}
    825        1.1        pk 
    826        1.1        pk 	} /* for(each mbpp...) */
    827        1.1        pk }
    828        1.1        pk 
    829        1.1        pk /************************************************************************
    830        1.1        pk  *
    831        1.1        pk  *  MTTY Routines
    832        1.1        pk  *
    833        1.1        pk  *	mtty_match		match one mtty device
    834        1.1        pk  *	mtty_attach		attach mtty devices
    835        1.1        pk  *	mttyopen		open mtty device
    836        1.1        pk  *	mttyclose		close mtty device
    837        1.1        pk  *	mttyread		read from mtty
    838        1.1        pk  *	mttywrite		write to mtty
    839        1.1        pk  *	mttyioctl		do ioctl on mtty
    840        1.1        pk  *	mttytty			return tty pointer for mtty
    841        1.1        pk  *	mttystop		stop mtty device
    842        1.1        pk  *	mtty_start		start mtty device
    843        1.1        pk  *	mtty_param		set mtty parameters
    844        1.1        pk  *	mtty_modem_control	set modem control lines
    845        1.1        pk  */
    846        1.1        pk 
    847        1.1        pk int
    848        1.1        pk mtty_match(parent, cf, args)
    849        1.1        pk 	struct device *parent;
    850        1.1        pk 	struct cfdata *cf;
    851        1.1        pk 	void *args;
    852        1.1        pk {
    853        1.1        pk 	struct magma_softc *sc = (struct magma_softc *)parent;
    854        1.1        pk 
    855        1.1        pk 	return( args == mtty_match && sc->ms_board->mb_nser && sc->ms_mtty == NULL );
    856        1.1        pk }
    857        1.1        pk 
    858        1.1        pk void
    859        1.1        pk mtty_attach(parent, dev, args)
    860        1.1        pk 	struct device *parent;
    861        1.1        pk 	struct device *dev;
    862        1.1        pk 	void *args;
    863        1.1        pk {
    864        1.1        pk 	struct magma_softc *sc = (struct magma_softc *)parent;
    865        1.1        pk 	struct mtty_softc *ms = (struct mtty_softc *)dev;
    866        1.1        pk 	int port, chip, chan;
    867        1.1        pk 
    868        1.1        pk 	sc->ms_mtty = ms;
    869        1.2        pk 	dprintf((" addr %p", ms));
    870        1.1        pk 
    871        1.1        pk 	for( port = 0, chip = 0, chan = 0 ; port < sc->ms_board->mb_nser ; port++ ) {
    872        1.2        pk 		struct mtty_port *mp = &ms->ms_port[port];
    873        1.2        pk 		struct tty *tp;
    874        1.1        pk 
    875        1.1        pk 		mp->mp_cd1400 = &sc->ms_cd1400[chip];
    876       1.13        pk 		if (mp->mp_cd1400->cd_parmode && chan == 0)
    877        1.2        pk 			chan = 1; /* skip channel 0 if parmode */
    878        1.1        pk 		mp->mp_channel = chan;
    879        1.1        pk 
    880        1.1        pk 		tp = ttymalloc();
    881       1.13        pk 		if (tp == NULL) break;
    882        1.1        pk 		tty_attach(tp);
    883        1.1        pk 		tp->t_oproc = mtty_start;
    884        1.1        pk 		tp->t_param = mtty_param;
    885        1.1        pk 
    886        1.1        pk 		mp->mp_tty = tp;
    887        1.1        pk 
    888        1.1        pk 		mp->mp_rbuf = malloc(MTTY_RBUF_SIZE, M_DEVBUF, M_NOWAIT);
    889       1.13        pk 		if (mp->mp_rbuf == NULL) break;
    890        1.1        pk 
    891        1.1        pk 		mp->mp_rend = mp->mp_rbuf + MTTY_RBUF_SIZE;
    892        1.1        pk 
    893        1.1        pk 		chan = (chan + 1) % CD1400_NO_OF_CHANNELS;
    894       1.13        pk 		if (chan == 0)
    895       1.13        pk 			chip++;
    896        1.1        pk 	}
    897        1.1        pk 
    898        1.1        pk 	ms->ms_nports = port;
    899        1.1        pk 	printf(": %d tty%s\n", port, port == 1 ? "" : "s");
    900        1.1        pk }
    901        1.1        pk 
    902        1.1        pk /*
    903        1.1        pk  * open routine. returns zero if successful, else error code
    904        1.1        pk  */
    905        1.1        pk int
    906       1.31  christos mttyopen(dev, flags, mode, l)
    907        1.1        pk 	dev_t dev;
    908        1.1        pk 	int flags;
    909        1.1        pk 	int mode;
    910       1.31  christos 	struct lwp *l;
    911        1.1        pk {
    912        1.1        pk 	int card = MAGMA_CARD(dev);
    913        1.1        pk 	int port = MAGMA_PORT(dev);
    914        1.1        pk 	struct mtty_softc *ms;
    915        1.1        pk 	struct mtty_port *mp;
    916        1.1        pk 	struct tty *tp;
    917        1.1        pk 	struct cd1400 *cd;
    918        1.1        pk 	int error, s;
    919        1.1        pk 
    920        1.1        pk 	if( card >= mtty_cd.cd_ndevs ||
    921        1.1        pk 	    (ms = mtty_cd.cd_devs[card]) == NULL || port >= ms->ms_nports )
    922        1.1        pk 		return(ENXIO);	/* device not configured */
    923        1.1        pk 
    924        1.1        pk 	mp = &ms->ms_port[port];
    925        1.1        pk 	tp = mp->mp_tty;
    926        1.1        pk 	tp->t_dev = dev;
    927        1.1        pk 
    928        1.1        pk 	if (ISSET(tp->t_state, TS_ISOPEN) &&
    929        1.1        pk 	    ISSET(tp->t_state, TS_XCLUDE) &&
    930  1.32.12.1      tron 	    kauth_authorize_generic(l->l_proc->p_cred, KAUTH_GENERIC_ISSUSER, &l->l_proc->p_acflag) != 0)
    931        1.1        pk 		return (EBUSY);
    932        1.1        pk 
    933        1.1        pk 	s = spltty();
    934        1.1        pk 
    935        1.1        pk 	if( !ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
    936        1.1        pk 
    937        1.1        pk 		/* set defaults */
    938        1.1        pk 		ttychars(tp);
    939        1.1        pk 		tp->t_iflag = TTYDEF_IFLAG;
    940        1.1        pk 		tp->t_oflag = TTYDEF_OFLAG;
    941        1.1        pk 		tp->t_cflag = TTYDEF_CFLAG;
    942        1.1        pk 		if( ISSET(mp->mp_openflags, TIOCFLAG_CLOCAL) )
    943        1.1        pk 			SET(tp->t_cflag, CLOCAL);
    944        1.1        pk 		if( ISSET(mp->mp_openflags, TIOCFLAG_CRTSCTS) )
    945        1.1        pk 			SET(tp->t_cflag, CRTSCTS);
    946        1.1        pk 		if( ISSET(mp->mp_openflags, TIOCFLAG_MDMBUF) )
    947        1.1        pk 			SET(tp->t_cflag, MDMBUF);
    948        1.1        pk 		tp->t_lflag = TTYDEF_LFLAG;
    949        1.1        pk 		tp->t_ispeed = tp->t_ospeed = TTYDEF_SPEED;
    950        1.1        pk 
    951        1.1        pk 		/* init ring buffer */
    952        1.1        pk 		mp->mp_rput = mp->mp_rget = mp->mp_rbuf;
    953        1.1        pk 
    954        1.1        pk 		/* reset CD1400 channel */
    955        1.1        pk 		cd = mp->mp_cd1400;
    956        1.1        pk 		cd1400_write_reg(cd, CD1400_CAR, mp->mp_channel);
    957        1.1        pk 		cd1400_write_ccr(cd, CD1400_CCR_CMDRESET);
    958        1.1        pk 
    959        1.1        pk 		/* encode the port number in top half of LIVR */
    960        1.1        pk 		cd1400_write_reg(cd, CD1400_LIVR, port << 4 );
    961        1.1        pk 
    962        1.1        pk 		/* sets parameters and raises DTR */
    963        1.1        pk 		(void)mtty_param(tp, &tp->t_termios);
    964        1.1        pk 
    965        1.1        pk 		/* set tty watermarks */
    966        1.1        pk 		ttsetwater(tp);
    967        1.1        pk 
    968        1.1        pk 		/* enable service requests */
    969        1.1        pk 		cd1400_write_reg(cd, CD1400_SRER,
    970        1.1        pk 				 CD1400_SRER_RXDATA | CD1400_SRER_MDMCH);
    971        1.1        pk 
    972        1.1        pk 		/* tell the tty about the carrier status */
    973        1.1        pk 		if( ISSET(mp->mp_openflags, TIOCFLAG_SOFTCAR) ||
    974        1.1        pk 		    mp->mp_carrier )
    975        1.1        pk 			SET(tp->t_state, TS_CARR_ON);
    976        1.1        pk 		else
    977        1.1        pk 			CLR(tp->t_state, TS_CARR_ON);
    978        1.1        pk 	}
    979        1.1        pk 	splx(s);
    980        1.1        pk 
    981        1.1        pk 	error = ttyopen(tp, MTTY_DIALOUT(dev), ISSET(flags, O_NONBLOCK));
    982        1.1        pk 	if (error != 0)
    983        1.1        pk 		goto bad;
    984        1.1        pk 
    985        1.9       eeh 	error = (*tp->t_linesw->l_open)(dev, tp);
    986        1.1        pk 	if (error != 0)
    987        1.1        pk 		goto bad;
    988        1.1        pk 
    989        1.1        pk bad:
    990        1.1        pk 	if (!ISSET(tp->t_state, TS_ISOPEN) && tp->t_wopen == 0) {
    991        1.1        pk 		/*
    992        1.1        pk 		 * We failed to open the device, and nobody else had it opened.
    993        1.1        pk 		 * Clean up the state as appropriate.
    994        1.1        pk 		 */
    995        1.1        pk 		/* XXX - do that here */
    996        1.1        pk 	}
    997        1.1        pk 
    998        1.1        pk 	return (error);
    999        1.1        pk }
   1000        1.1        pk 
   1001        1.1        pk /*
   1002        1.1        pk  * close routine. returns zero if successful, else error code
   1003        1.1        pk  */
   1004        1.1        pk int
   1005       1.31  christos mttyclose(dev, flag, mode, l)
   1006        1.1        pk 	dev_t dev;
   1007        1.1        pk 	int flag;
   1008        1.1        pk 	int mode;
   1009       1.31  christos 	struct lwp *l;
   1010        1.1        pk {
   1011        1.1        pk 	struct mtty_softc *ms = mtty_cd.cd_devs[MAGMA_CARD(dev)];
   1012        1.1        pk 	struct mtty_port *mp = &ms->ms_port[MAGMA_PORT(dev)];
   1013        1.1        pk 	struct tty *tp = mp->mp_tty;
   1014        1.1        pk 	int s;
   1015        1.1        pk 
   1016        1.9       eeh 	(*tp->t_linesw->l_close)(tp, flag);
   1017        1.1        pk 	ttyclose(tp);
   1018        1.1        pk 
   1019        1.1        pk 	s = spltty();
   1020        1.1        pk 
   1021        1.1        pk 	/* if HUPCL is set, and the tty is no longer open
   1022        1.1        pk 	 * shut down the port
   1023        1.1        pk 	 */
   1024        1.1        pk 	if( ISSET(tp->t_cflag, HUPCL) || !ISSET(tp->t_state, TS_ISOPEN) ) {
   1025        1.1        pk 		/* XXX wait until FIFO is empty before turning off the channel
   1026        1.1        pk 		struct cd1400 *cd = mp->mp_cd1400;
   1027        1.1        pk 		*/
   1028        1.1        pk 
   1029        1.1        pk 		/* drop DTR and RTS */
   1030        1.1        pk 		(void)mtty_modem_control(mp, 0, DMSET);
   1031        1.1        pk 
   1032        1.1        pk 		/* turn off the channel
   1033        1.1        pk 		cd1400_write_reg(cd, CD1400_CAR, mp->mp_channel);
   1034        1.1        pk 		cd1400_write_ccr(cd, CD1400_CCR_CMDRESET);
   1035        1.1        pk 		*/
   1036        1.1        pk 	}
   1037        1.1        pk 
   1038        1.1        pk 	splx(s);
   1039        1.1        pk 
   1040        1.1        pk 	return(0);
   1041        1.1        pk }
   1042        1.1        pk 
   1043        1.1        pk /*
   1044        1.1        pk  * Read routine
   1045        1.1        pk  */
   1046        1.1        pk int
   1047        1.1        pk mttyread(dev, uio, flags)
   1048        1.1        pk 	dev_t dev;
   1049        1.1        pk 	struct uio *uio;
   1050        1.1        pk 	int flags;
   1051        1.1        pk {
   1052        1.1        pk 	struct mtty_softc *ms = mtty_cd.cd_devs[MAGMA_CARD(dev)];
   1053        1.1        pk 	struct mtty_port *mp = &ms->ms_port[MAGMA_PORT(dev)];
   1054        1.1        pk 	struct tty *tp = mp->mp_tty;
   1055        1.1        pk 
   1056        1.9       eeh 	return( (*tp->t_linesw->l_read)(tp, uio, flags) );
   1057        1.1        pk }
   1058        1.1        pk 
   1059        1.1        pk /*
   1060        1.1        pk  * Write routine
   1061        1.1        pk  */
   1062        1.1        pk int
   1063        1.1        pk mttywrite(dev, uio, flags)
   1064        1.1        pk 	dev_t dev;
   1065        1.1        pk 	struct uio *uio;
   1066        1.1        pk 	int flags;
   1067        1.1        pk {
   1068        1.1        pk 	struct mtty_softc *ms = mtty_cd.cd_devs[MAGMA_CARD(dev)];
   1069        1.1        pk 	struct mtty_port *mp = &ms->ms_port[MAGMA_PORT(dev)];
   1070        1.1        pk 	struct tty *tp = mp->mp_tty;
   1071        1.1        pk 
   1072        1.9       eeh 	return( (*tp->t_linesw->l_write)(tp, uio, flags) );
   1073       1.10       scw }
   1074       1.10       scw 
   1075       1.10       scw /*
   1076       1.10       scw  * Poll routine
   1077       1.10       scw  */
   1078       1.10       scw int
   1079       1.31  christos mttypoll(dev, events, l)
   1080       1.10       scw 	dev_t dev;
   1081       1.10       scw 	int events;
   1082       1.31  christos 	struct lwp *l;
   1083       1.10       scw {
   1084       1.10       scw 	struct mtty_softc *ms = mtty_cd.cd_devs[MAGMA_CARD(dev)];
   1085       1.10       scw 	struct mtty_port *mp = &ms->ms_port[MAGMA_PORT(dev)];
   1086       1.10       scw 	struct tty *tp = mp->mp_tty;
   1087       1.29     perry 
   1088       1.31  christos 	return ((*tp->t_linesw->l_poll)(tp, events, l));
   1089        1.1        pk }
   1090        1.1        pk 
   1091        1.1        pk /*
   1092        1.1        pk  * return tty pointer
   1093        1.1        pk  */
   1094        1.1        pk struct tty *
   1095        1.1        pk mttytty(dev)
   1096        1.1        pk 	dev_t dev;
   1097        1.1        pk {
   1098        1.1        pk 	struct mtty_softc *ms = mtty_cd.cd_devs[MAGMA_CARD(dev)];
   1099        1.1        pk 	struct mtty_port *mp = &ms->ms_port[MAGMA_PORT(dev)];
   1100        1.1        pk 
   1101        1.1        pk 	return(mp->mp_tty);
   1102        1.1        pk }
   1103        1.1        pk 
   1104        1.1        pk /*
   1105        1.1        pk  * ioctl routine
   1106        1.1        pk  */
   1107        1.1        pk int
   1108       1.31  christos mttyioctl(dev, cmd, data, flags, l)
   1109        1.1        pk 	dev_t dev;
   1110        1.1        pk 	u_long cmd;
   1111        1.1        pk 	caddr_t data;
   1112        1.1        pk 	int flags;
   1113       1.31  christos 	struct lwp *l;
   1114        1.1        pk {
   1115        1.1        pk 	struct mtty_softc *ms = mtty_cd.cd_devs[MAGMA_CARD(dev)];
   1116        1.1        pk 	struct mtty_port *mp = &ms->ms_port[MAGMA_PORT(dev)];
   1117        1.1        pk 	struct tty *tp = mp->mp_tty;
   1118        1.1        pk 	int error;
   1119        1.1        pk 
   1120       1.31  christos 	error = (*tp->t_linesw->l_ioctl)(tp, cmd, data, flags, l);
   1121       1.15    atatat 	if( error != EPASSTHROUGH ) return(error);
   1122        1.1        pk 
   1123       1.31  christos 	error = ttioctl(tp, cmd, data, flags, l);
   1124       1.15    atatat 	if( error != EPASSTHROUGH ) return(error);
   1125        1.1        pk 
   1126        1.1        pk 	error = 0;
   1127        1.1        pk 
   1128        1.1        pk 	switch(cmd) {
   1129        1.1        pk 	case TIOCSBRK:	/* set break */
   1130        1.1        pk 		SET(mp->mp_flags, MTTYF_SET_BREAK);
   1131        1.1        pk 		cd1400_enable_transmitter(mp->mp_cd1400, mp->mp_channel);
   1132        1.1        pk 		break;
   1133        1.1        pk 
   1134        1.1        pk 	case TIOCCBRK:	/* clear break */
   1135        1.1        pk 		SET(mp->mp_flags, MTTYF_CLR_BREAK);
   1136        1.1        pk 		cd1400_enable_transmitter(mp->mp_cd1400, mp->mp_channel);
   1137        1.1        pk 		break;
   1138        1.1        pk 
   1139        1.1        pk 	case TIOCSDTR:	/* set DTR */
   1140        1.1        pk 		mtty_modem_control(mp, TIOCM_DTR, DMBIS);
   1141        1.1        pk 		break;
   1142        1.1        pk 
   1143        1.1        pk 	case TIOCCDTR:	/* clear DTR */
   1144        1.1        pk 		mtty_modem_control(mp, TIOCM_DTR, DMBIC);
   1145        1.1        pk 		break;
   1146        1.1        pk 
   1147        1.1        pk 	case TIOCMSET:	/* set modem lines */
   1148        1.1        pk 		mtty_modem_control(mp, *((int *)data), DMSET);
   1149        1.1        pk 		break;
   1150        1.1        pk 
   1151        1.1        pk 	case TIOCMBIS:	/* bit set modem lines */
   1152        1.1        pk 		mtty_modem_control(mp, *((int *)data), DMBIS);
   1153        1.1        pk 		break;
   1154        1.1        pk 
   1155        1.1        pk 	case TIOCMBIC:	/* bit clear modem lines */
   1156        1.1        pk 		mtty_modem_control(mp, *((int *)data), DMBIC);
   1157        1.1        pk 		break;
   1158        1.1        pk 
   1159        1.1        pk 	case TIOCMGET:	/* get modem lines */
   1160        1.1        pk 		*((int *)data) = mtty_modem_control(mp, 0, DMGET);
   1161        1.1        pk 		break;
   1162        1.1        pk 
   1163        1.1        pk 	case TIOCGFLAGS:
   1164        1.1        pk 		*((int *)data) = mp->mp_openflags;
   1165        1.1        pk 		break;
   1166        1.1        pk 
   1167        1.1        pk 	case TIOCSFLAGS:
   1168  1.32.12.1      tron 		if (kauth_authorize_generic(l->l_proc->p_cred, KAUTH_GENERIC_ISSUSER, &l->l_proc->p_acflag) )
   1169        1.1        pk 			error = EPERM;
   1170        1.1        pk 		else
   1171        1.1        pk 			mp->mp_openflags = *((int *)data) &
   1172        1.1        pk 				(TIOCFLAG_SOFTCAR | TIOCFLAG_CLOCAL |
   1173        1.1        pk 				TIOCFLAG_CRTSCTS | TIOCFLAG_MDMBUF);
   1174        1.1        pk 		break;
   1175        1.1        pk 
   1176        1.1        pk 	default:
   1177       1.15    atatat 		error = EPASSTHROUGH;
   1178        1.1        pk 	}
   1179        1.1        pk 
   1180        1.1        pk 	return(error);
   1181        1.1        pk }
   1182        1.1        pk 
   1183        1.1        pk /*
   1184        1.1        pk  * Stop output, e.g., for ^S or output flush.
   1185        1.1        pk  */
   1186        1.1        pk void
   1187        1.1        pk mttystop(tp, flags)
   1188        1.1        pk 	struct tty *tp;
   1189        1.1        pk 	int flags;
   1190        1.1        pk {
   1191        1.1        pk 	struct mtty_softc *ms = mtty_cd.cd_devs[MAGMA_CARD(tp->t_dev)];
   1192        1.1        pk 	struct mtty_port *mp = &ms->ms_port[MAGMA_PORT(tp->t_dev)];
   1193        1.1        pk 	int s;
   1194        1.1        pk 
   1195        1.1        pk 	s = spltty();
   1196        1.1        pk 
   1197        1.1        pk 	if( ISSET(tp->t_state, TS_BUSY) ) {
   1198        1.1        pk 		if( !ISSET(tp->t_state, TS_TTSTOP) )
   1199        1.1        pk 			SET(tp->t_state, TS_FLUSH);
   1200        1.1        pk 
   1201        1.1        pk 		/*
   1202        1.1        pk 		 * the transmit interrupt routine will disable transmit when it
   1203        1.1        pk 		 * notices that MTTYF_STOP has been set.
   1204        1.1        pk 		 */
   1205        1.1        pk 		SET(mp->mp_flags, MTTYF_STOP);
   1206        1.1        pk 	}
   1207        1.1        pk 
   1208        1.1        pk 	splx(s);
   1209        1.1        pk }
   1210        1.1        pk 
   1211        1.1        pk /*
   1212        1.1        pk  * Start output, after a stop.
   1213        1.1        pk  */
   1214        1.1        pk void
   1215        1.1        pk mtty_start(tp)
   1216        1.1        pk 	struct tty *tp;
   1217        1.1        pk {
   1218        1.1        pk 	struct mtty_softc *ms = mtty_cd.cd_devs[MAGMA_CARD(tp->t_dev)];
   1219        1.1        pk 	struct mtty_port *mp = &ms->ms_port[MAGMA_PORT(tp->t_dev)];
   1220        1.1        pk 	int s;
   1221        1.1        pk 
   1222        1.1        pk 	s = spltty();
   1223        1.1        pk 
   1224        1.1        pk 	/* we only need to do something if we are not already busy
   1225        1.1        pk 	 * or delaying or stopped
   1226        1.1        pk 	 */
   1227        1.1        pk 	if( !ISSET(tp->t_state, TS_TTSTOP | TS_TIMEOUT | TS_BUSY) ) {
   1228        1.1        pk 
   1229        1.1        pk 		/* if we are sleeping and output has drained below
   1230        1.1        pk 		 * low water mark, awaken
   1231        1.1        pk 		 */
   1232        1.1        pk 		if( tp->t_outq.c_cc <= tp->t_lowat ) {
   1233        1.1        pk 			if( ISSET(tp->t_state, TS_ASLEEP) ) {
   1234        1.1        pk 				CLR(tp->t_state, TS_ASLEEP);
   1235        1.1        pk 				wakeup(&tp->t_outq);
   1236        1.1        pk 			}
   1237        1.1        pk 
   1238        1.1        pk 			selwakeup(&tp->t_wsel);
   1239        1.1        pk 		}
   1240        1.1        pk 
   1241        1.1        pk 		/* if something to send, start transmitting
   1242        1.1        pk 		 */
   1243        1.1        pk 		if( tp->t_outq.c_cc ) {
   1244        1.1        pk 			mp->mp_txc = ndqb(&tp->t_outq, 0);
   1245        1.1        pk 			mp->mp_txp = tp->t_outq.c_cf;
   1246        1.1        pk 			SET(tp->t_state, TS_BUSY);
   1247        1.1        pk 			cd1400_enable_transmitter(mp->mp_cd1400, mp->mp_channel);
   1248        1.1        pk 		}
   1249        1.1        pk 	}
   1250        1.1        pk 
   1251        1.1        pk 	splx(s);
   1252        1.1        pk }
   1253        1.1        pk 
   1254        1.1        pk /*
   1255        1.1        pk  * set/get modem line status
   1256        1.1        pk  *
   1257        1.1        pk  * bits can be: TIOCM_DTR, TIOCM_RTS, TIOCM_CTS, TIOCM_CD, TIOCM_RI, TIOCM_DSR
   1258        1.1        pk  *
   1259        1.1        pk  * note that DTR and RTS lines are exchanged, and that DSR is
   1260        1.1        pk  * not available on the LC2+1Sp card (used as CD)
   1261        1.1        pk  *
   1262        1.1        pk  * only let them fiddle with RTS if CRTSCTS is not enabled
   1263        1.1        pk  */
   1264        1.1        pk int
   1265        1.1        pk mtty_modem_control(mp, bits, howto)
   1266        1.1        pk 	struct mtty_port *mp;
   1267        1.1        pk 	int bits;
   1268        1.1        pk 	int howto;
   1269        1.1        pk {
   1270        1.1        pk 	struct cd1400 *cd = mp->mp_cd1400;
   1271        1.1        pk 	struct tty *tp = mp->mp_tty;
   1272        1.1        pk 	int s, msvr;
   1273        1.1        pk 
   1274        1.1        pk 	s = spltty();
   1275        1.1        pk 
   1276        1.1        pk 	cd1400_write_reg(cd, CD1400_CAR, mp->mp_channel);
   1277        1.1        pk 
   1278        1.1        pk 	switch(howto) {
   1279        1.1        pk 	case DMGET:	/* get bits */
   1280        1.1        pk 		bits = 0;
   1281        1.1        pk 
   1282        1.1        pk 		bits |= TIOCM_LE;
   1283        1.1        pk 
   1284        1.1        pk 		msvr = cd1400_read_reg(cd, CD1400_MSVR1);
   1285        1.1        pk 		if( msvr & CD1400_MSVR1_RTS ) bits |= TIOCM_DTR;
   1286        1.1        pk 
   1287        1.1        pk 		msvr = cd1400_read_reg(cd, CD1400_MSVR2);
   1288        1.1        pk 		if( msvr & CD1400_MSVR2_DTR ) bits |= TIOCM_RTS;
   1289        1.1        pk 		if( msvr & CD1400_MSVR2_CTS ) bits |= TIOCM_CTS;
   1290        1.1        pk 		if( msvr & CD1400_MSVR2_RI ) bits |= TIOCM_RI;
   1291        1.1        pk 		if( msvr & CD1400_MSVR2_DSR ) bits |= (cd->cd_parmode ? TIOCM_CD : TIOCM_DSR);
   1292        1.1        pk 		if( msvr & CD1400_MSVR2_CD ) bits |= (cd->cd_parmode ? 0 : TIOCM_CD);
   1293        1.1        pk 
   1294        1.1        pk 		break;
   1295        1.1        pk 
   1296        1.1        pk 	case DMSET:	/* reset bits */
   1297        1.1        pk 		if( !ISSET(tp->t_cflag, CRTSCTS) )
   1298        1.1        pk 			cd1400_write_reg(cd, CD1400_MSVR2, ((bits & TIOCM_RTS) ? CD1400_MSVR2_DTR : 0));
   1299        1.1        pk 
   1300        1.1        pk 		cd1400_write_reg(cd, CD1400_MSVR1, ((bits & TIOCM_DTR) ? CD1400_MSVR1_RTS : 0));
   1301        1.1        pk 
   1302        1.1        pk 		break;
   1303        1.1        pk 
   1304        1.1        pk 	case DMBIS:	/* set bits */
   1305        1.1        pk 		if( (bits & TIOCM_RTS) && !ISSET(tp->t_cflag, CRTSCTS) )
   1306        1.1        pk 			cd1400_write_reg(cd, CD1400_MSVR2, CD1400_MSVR2_DTR);
   1307        1.1        pk 
   1308        1.1        pk 		if( bits & TIOCM_DTR )
   1309        1.1        pk 			cd1400_write_reg(cd, CD1400_MSVR1, CD1400_MSVR1_RTS);
   1310        1.1        pk 
   1311        1.1        pk 		break;
   1312        1.1        pk 
   1313        1.1        pk 	case DMBIC:	/* clear bits */
   1314        1.1        pk 		if( (bits & TIOCM_RTS) && !ISSET(tp->t_cflag, CRTSCTS) )
   1315        1.1        pk 			cd1400_write_reg(cd, CD1400_MSVR2, 0);
   1316        1.1        pk 
   1317        1.1        pk 		if( bits & TIOCM_DTR )
   1318        1.1        pk 			cd1400_write_reg(cd, CD1400_MSVR1, 0);
   1319        1.1        pk 
   1320        1.1        pk 		break;
   1321        1.1        pk 	}
   1322        1.1        pk 
   1323        1.1        pk 	splx(s);
   1324        1.1        pk 	return(bits);
   1325        1.1        pk }
   1326        1.1        pk 
   1327        1.1        pk /*
   1328        1.1        pk  * Set tty parameters, returns error or 0 on success
   1329        1.1        pk  */
   1330        1.1        pk int
   1331        1.1        pk mtty_param(tp, t)
   1332        1.1        pk 	struct tty *tp;
   1333        1.1        pk 	struct termios *t;
   1334        1.1        pk {
   1335        1.1        pk 	struct mtty_softc *ms = mtty_cd.cd_devs[MAGMA_CARD(tp->t_dev)];
   1336        1.1        pk 	struct mtty_port *mp = &ms->ms_port[MAGMA_PORT(tp->t_dev)];
   1337        1.1        pk 	struct cd1400 *cd = mp->mp_cd1400;
   1338        1.1        pk 	int rbpr, tbpr, rcor, tcor;
   1339        1.1        pk 	u_char mcor1 = 0, mcor2 = 0;
   1340        1.1        pk 	int s, opt;
   1341        1.1        pk 
   1342        1.1        pk 	if( t->c_ospeed && cd1400_compute_baud(t->c_ospeed, cd->cd_clock, &tcor, &tbpr) )
   1343        1.1        pk 		return(EINVAL);
   1344        1.1        pk 
   1345        1.1        pk 	if( t->c_ispeed && cd1400_compute_baud(t->c_ispeed, cd->cd_clock, &rcor, &rbpr) )
   1346        1.1        pk 		return(EINVAL);
   1347        1.1        pk 
   1348        1.1        pk 	s = spltty();
   1349        1.1        pk 
   1350        1.1        pk 	/* hang up the line if ospeed is zero, else raise DTR */
   1351        1.1        pk 	(void)mtty_modem_control(mp, TIOCM_DTR, (t->c_ospeed == 0 ? DMBIC : DMBIS));
   1352        1.1        pk 
   1353        1.1        pk 	/* select channel, done in mtty_modem_control() */
   1354        1.1        pk 	/* cd1400_write_reg(cd, CD1400_CAR, mp->mp_channel); */
   1355        1.1        pk 
   1356        1.1        pk 	/* set transmit speed */
   1357        1.1        pk 	if( t->c_ospeed ) {
   1358        1.1        pk 		cd1400_write_reg(cd, CD1400_TCOR, tcor);
   1359        1.1        pk 		cd1400_write_reg(cd, CD1400_TBPR, tbpr);
   1360        1.1        pk 	}
   1361        1.1        pk 
   1362        1.1        pk 	/* set receive speed */
   1363        1.1        pk 	if( t->c_ispeed ) {
   1364        1.1        pk 		cd1400_write_reg(cd, CD1400_RCOR, rcor);
   1365        1.1        pk 		cd1400_write_reg(cd, CD1400_RBPR, rbpr);
   1366        1.1        pk 	}
   1367        1.1        pk 
   1368        1.1        pk 	/* enable transmitting and receiving on this channel */
   1369        1.1        pk 	opt = CD1400_CCR_CMDCHANCTL | CD1400_CCR_XMTEN | CD1400_CCR_RCVEN;
   1370        1.1        pk 	cd1400_write_ccr(cd, opt);
   1371        1.1        pk 
   1372        1.1        pk 	/* set parity, data and stop bits */
   1373        1.1        pk 	opt = 0;
   1374        1.1        pk 	if( ISSET(t->c_cflag, PARENB) )
   1375        1.1        pk 		opt |= (ISSET(t->c_cflag, PARODD) ? CD1400_COR1_PARODD : CD1400_COR1_PARNORMAL);
   1376        1.1        pk 
   1377        1.1        pk 	if( !ISSET(t->c_iflag, INPCK) )
   1378        1.1        pk 		opt |= CD1400_COR1_NOINPCK; /* no parity checking */
   1379        1.1        pk 
   1380        1.1        pk 	if( ISSET(t->c_cflag, CSTOPB) )
   1381        1.1        pk 		opt |= CD1400_COR1_STOP2;
   1382        1.1        pk 
   1383        1.1        pk 	switch( t->c_cflag & CSIZE ) {
   1384        1.1        pk 	case CS5:
   1385        1.1        pk 		opt |= CD1400_COR1_CS5;
   1386        1.1        pk 		break;
   1387        1.1        pk 
   1388        1.1        pk 	case CS6:
   1389        1.1        pk 		opt |= CD1400_COR1_CS6;
   1390        1.1        pk 		break;
   1391        1.1        pk 
   1392        1.1        pk 	case CS7:
   1393        1.1        pk 		opt |= CD1400_COR1_CS7;
   1394        1.1        pk 		break;
   1395        1.1        pk 
   1396        1.1        pk 	default:
   1397        1.1        pk 		opt |= CD1400_COR1_CS8;
   1398        1.1        pk 		break;
   1399        1.1        pk 	}
   1400        1.1        pk 
   1401        1.1        pk 	cd1400_write_reg(cd, CD1400_COR1, opt);
   1402        1.1        pk 
   1403        1.1        pk 	/*
   1404        1.1        pk 	 * enable Embedded Transmit Commands (for breaks)
   1405        1.1        pk 	 * use the CD1400 automatic CTS flow control if CRTSCTS is set
   1406        1.1        pk 	 */
   1407        1.1        pk 	opt = CD1400_COR2_ETC;
   1408        1.1        pk 	if( ISSET(t->c_cflag, CRTSCTS) ) opt |= CD1400_COR2_CCTS_OFLOW;
   1409        1.1        pk 	cd1400_write_reg(cd, CD1400_COR2, opt);
   1410        1.1        pk 
   1411        1.1        pk 	cd1400_write_reg(cd, CD1400_COR3, MTTY_RX_FIFO_THRESHOLD);
   1412        1.1        pk 
   1413        1.1        pk 	cd1400_write_ccr(cd, CD1400_CCR_CMDCORCHG | CD1400_CCR_COR1 | CD1400_CCR_COR2 | CD1400_CCR_COR3);
   1414        1.1        pk 
   1415        1.1        pk 	cd1400_write_reg(cd, CD1400_COR4, CD1400_COR4_PFO_EXCEPTION);
   1416        1.1        pk 	cd1400_write_reg(cd, CD1400_COR5, 0);
   1417        1.1        pk 
   1418        1.1        pk 	/*
   1419        1.1        pk 	 * if automatic RTS handshaking enabled, set DTR threshold
   1420        1.1        pk 	 * (RTS and DTR lines are switched, CD1400 thinks its DTR)
   1421        1.1        pk 	 */
   1422        1.1        pk 	if( ISSET(t->c_cflag, CRTSCTS) )
   1423        1.1        pk 		mcor1 = MTTY_RX_DTR_THRESHOLD;
   1424        1.1        pk 
   1425        1.1        pk 	/* set up `carrier detect' interrupts */
   1426        1.1        pk 	if( cd->cd_parmode ) {
   1427        1.1        pk 		SET(mcor1, CD1400_MCOR1_DSRzd);
   1428        1.1        pk 		SET(mcor2, CD1400_MCOR2_DSRod);
   1429        1.1        pk 	} else {
   1430        1.1        pk 		SET(mcor1, CD1400_MCOR1_CDzd);
   1431        1.1        pk 		SET(mcor2, CD1400_MCOR2_CDod);
   1432        1.1        pk 	}
   1433        1.1        pk 
   1434        1.1        pk 	cd1400_write_reg(cd, CD1400_MCOR1, mcor1);
   1435        1.1        pk 	cd1400_write_reg(cd, CD1400_MCOR2, mcor2);
   1436        1.1        pk 
   1437        1.1        pk 	/* receive timeout 2ms */
   1438        1.1        pk 	cd1400_write_reg(cd, CD1400_RTPR, 2);
   1439        1.1        pk 
   1440        1.1        pk 	splx(s);
   1441        1.1        pk 	return(0);
   1442        1.1        pk }
   1443        1.1        pk 
   1444        1.1        pk /************************************************************************
   1445        1.1        pk  *
   1446        1.1        pk  *  MBPP Routines
   1447        1.1        pk  *
   1448        1.1        pk  *	mbpp_match	match one mbpp device
   1449        1.1        pk  *	mbpp_attach	attach mbpp devices
   1450        1.1        pk  *	mbppopen	open mbpp device
   1451        1.1        pk  *	mbppclose	close mbpp device
   1452        1.1        pk  *	mbppioctl	do ioctl on mbpp
   1453        1.3        pk  *	mbpp_rw		general rw routine
   1454        1.3        pk  *	mbpp_timeout	rw timeout
   1455        1.3        pk  *	mbpp_start	rw start after delay
   1456        1.3        pk  *	mbpp_send	send data
   1457        1.3        pk  *	mbpp_recv	recv data
   1458        1.1        pk  */
   1459        1.1        pk 
   1460        1.1        pk int
   1461        1.1        pk mbpp_match(parent, cf, args)
   1462        1.1        pk 	struct device *parent;
   1463        1.1        pk 	struct cfdata *cf;
   1464        1.1        pk 	void *args;
   1465        1.1        pk {
   1466        1.1        pk 	struct magma_softc *sc = (struct magma_softc *)parent;
   1467        1.1        pk 
   1468        1.1        pk 	return( args == mbpp_match && sc->ms_board->mb_npar && sc->ms_mbpp == NULL );
   1469        1.1        pk }
   1470        1.1        pk 
   1471        1.1        pk void
   1472        1.1        pk mbpp_attach(parent, dev, args)
   1473        1.1        pk 	struct device *parent;
   1474        1.1        pk 	struct device *dev;
   1475        1.1        pk 	void *args;
   1476        1.1        pk {
   1477        1.1        pk 	struct magma_softc *sc = (struct magma_softc *)parent;
   1478        1.1        pk 	struct mbpp_softc *ms = (struct mbpp_softc *)dev;
   1479        1.1        pk 	struct mbpp_port *mp;
   1480        1.3        pk 	int port;
   1481        1.1        pk 
   1482        1.1        pk 	sc->ms_mbpp = ms;
   1483        1.2        pk 	dprintf((" addr %p", ms));
   1484        1.1        pk 
   1485        1.1        pk 	for( port = 0 ; port < sc->ms_board->mb_npar ; port++ ) {
   1486        1.1        pk 		mp = &ms->ms_port[port];
   1487        1.1        pk 
   1488        1.6   thorpej 		callout_init(&mp->mp_timeout_ch);
   1489        1.6   thorpej 		callout_init(&mp->mp_start_ch);
   1490        1.6   thorpej 
   1491        1.1        pk 		if( sc->ms_ncd1190 )
   1492        1.1        pk 			mp->mp_cd1190 = &sc->ms_cd1190[port];
   1493        1.1        pk 		else
   1494        1.1        pk 			mp->mp_cd1400 = &sc->ms_cd1400[0];
   1495        1.1        pk 	}
   1496        1.1        pk 
   1497        1.1        pk 	ms->ms_nports = port;
   1498        1.1        pk 	printf(": %d port%s\n", port, port == 1 ? "" : "s");
   1499        1.1        pk }
   1500        1.1        pk 
   1501        1.1        pk /*
   1502        1.1        pk  * open routine. returns zero if successful, else error code
   1503        1.1        pk  */
   1504        1.1        pk int
   1505       1.31  christos mbppopen(dev, flags, mode, l)
   1506        1.1        pk 	dev_t dev;
   1507        1.1        pk 	int flags;
   1508        1.1        pk 	int mode;
   1509       1.31  christos 	struct lwp *l;
   1510        1.1        pk {
   1511        1.1        pk 	int card = MAGMA_CARD(dev);
   1512        1.1        pk 	int port = MAGMA_PORT(dev);
   1513        1.1        pk 	struct mbpp_softc *ms;
   1514        1.1        pk 	struct mbpp_port *mp;
   1515        1.3        pk 	int s;
   1516        1.1        pk 
   1517        1.1        pk 	if( card >= mbpp_cd.cd_ndevs ||
   1518        1.1        pk 	    (ms = mbpp_cd.cd_devs[card]) == NULL || port >= ms->ms_nports )
   1519        1.1        pk 		return(ENXIO);
   1520        1.1        pk 
   1521        1.1        pk 	mp = &ms->ms_port[port];
   1522        1.1        pk 
   1523        1.1        pk 	s = spltty();
   1524        1.1        pk 	if( ISSET(mp->mp_flags, MBPPF_OPEN) ) {
   1525        1.1        pk 		splx(s);
   1526        1.1        pk 		return(EBUSY);
   1527        1.1        pk 	}
   1528        1.1        pk 	SET(mp->mp_flags, MBPPF_OPEN);
   1529        1.1        pk 	splx(s);
   1530        1.1        pk 
   1531        1.3        pk 	/* set defaults */
   1532        1.3        pk 	mp->mp_burst = MBPP_BURST;
   1533        1.3        pk 	mp->mp_timeout = mbpp_mstohz(MBPP_TIMEOUT);
   1534        1.3        pk 	mp->mp_delay = mbpp_mstohz(MBPP_DELAY);
   1535        1.3        pk 
   1536        1.3        pk 	/* init chips */
   1537        1.3        pk 	if( mp->mp_cd1400 ) {	/* CD1400 */
   1538        1.2        pk 		struct cd1400 *cd = mp->mp_cd1400;
   1539        1.1        pk 
   1540        1.1        pk 		/* set up CD1400 channel */
   1541        1.1        pk 		s = spltty();
   1542        1.1        pk 		cd1400_write_reg(cd, CD1400_CAR, 0);
   1543        1.1        pk 		cd1400_write_ccr(cd, CD1400_CCR_CMDRESET);
   1544        1.1        pk 		cd1400_write_reg(cd, CD1400_LIVR, (1<<3));
   1545        1.1        pk 		splx(s);
   1546        1.3        pk 	} else {		/* CD1190 */
   1547        1.3        pk 		mp->mp_flags = 0;
   1548        1.3        pk 		return (ENXIO);
   1549        1.1        pk 	}
   1550        1.1        pk 
   1551        1.3        pk 	return (0);
   1552        1.1        pk }
   1553        1.1        pk 
   1554        1.1        pk /*
   1555        1.1        pk  * close routine. returns zero if successful, else error code
   1556        1.1        pk  */
   1557        1.1        pk int
   1558       1.31  christos mbppclose(dev, flag, mode, l)
   1559        1.1        pk 	dev_t dev;
   1560        1.1        pk 	int flag;
   1561        1.1        pk 	int mode;
   1562       1.31  christos 	struct lwp *l;
   1563        1.1        pk {
   1564        1.1        pk 	struct mbpp_softc *ms = mbpp_cd.cd_devs[MAGMA_CARD(dev)];
   1565        1.1        pk 	struct mbpp_port *mp = &ms->ms_port[MAGMA_PORT(dev)];
   1566        1.1        pk 
   1567        1.1        pk 	mp->mp_flags = 0;
   1568        1.1        pk 	return(0);
   1569        1.1        pk }
   1570        1.1        pk 
   1571        1.1        pk /*
   1572        1.1        pk  * ioctl routine
   1573        1.1        pk  */
   1574        1.1        pk int
   1575       1.31  christos mbppioctl(dev, cmd, data, flags, l)
   1576        1.1        pk 	dev_t dev;
   1577        1.1        pk 	u_long cmd;
   1578        1.1        pk 	caddr_t data;
   1579        1.1        pk 	int flags;
   1580       1.31  christos 	struct lwp *l;
   1581        1.1        pk {
   1582        1.3        pk 	struct mbpp_softc *ms = mbpp_cd.cd_devs[MAGMA_CARD(dev)];
   1583        1.3        pk 	struct mbpp_port *mp = &ms->ms_port[MAGMA_PORT(dev)];
   1584        1.3        pk 	struct mbpp_param *bp;
   1585        1.3        pk 	int error = 0;
   1586        1.3        pk 	int s;
   1587        1.3        pk 
   1588        1.3        pk 	switch(cmd) {
   1589        1.3        pk 	case MBPPIOCSPARAM:
   1590        1.3        pk 		bp = (struct mbpp_param *)data;
   1591        1.3        pk 		if( bp->bp_burst < MBPP_BURST_MIN || bp->bp_burst > MBPP_BURST_MAX ||
   1592        1.3        pk 		    bp->bp_delay < MBPP_DELAY_MIN || bp->bp_delay > MBPP_DELAY_MIN ) {
   1593        1.3        pk 			error = EINVAL;
   1594        1.3        pk 		} else {
   1595        1.3        pk 			mp->mp_burst = bp->bp_burst;
   1596        1.3        pk 			mp->mp_timeout = mbpp_mstohz(bp->bp_timeout);
   1597        1.3        pk 			mp->mp_delay = mbpp_mstohz(bp->bp_delay);
   1598        1.3        pk 		}
   1599        1.3        pk 		break;
   1600        1.3        pk 	case MBPPIOCGPARAM:
   1601        1.3        pk 		bp = (struct mbpp_param *)data;
   1602        1.3        pk 		bp->bp_burst = mp->mp_burst;
   1603        1.3        pk 		bp->bp_timeout = mbpp_hztoms(mp->mp_timeout);
   1604        1.3        pk 		bp->bp_delay = mbpp_hztoms(mp->mp_delay);
   1605        1.3        pk 		break;
   1606        1.3        pk 	case MBPPIOCGSTAT:
   1607        1.3        pk 		/* XXX make this more generic */
   1608        1.3        pk 		s = spltty();
   1609        1.3        pk 		cd1400_write_reg(mp->mp_cd1400, CD1400_CAR, 0);
   1610        1.3        pk 		*(int *)data = cd1400_read_reg(mp->mp_cd1400, CD1400_PSVR);
   1611        1.3        pk 		splx(s);
   1612        1.3        pk 		break;
   1613        1.3        pk 	default:
   1614        1.3        pk 		error = ENOTTY;
   1615        1.3        pk 	}
   1616        1.3        pk 
   1617        1.3        pk 	return(error);
   1618        1.1        pk }
   1619        1.1        pk 
   1620        1.3        pk int
   1621       1.17   gehenna mbpp_rw(dev, uio, flag)
   1622        1.3        pk 	dev_t dev;
   1623        1.3        pk 	struct uio *uio;
   1624       1.17   gehenna 	int flag;
   1625        1.3        pk {
   1626        1.3        pk 	int card = MAGMA_CARD(dev);
   1627        1.3        pk 	int port = MAGMA_PORT(dev);
   1628        1.3        pk 	struct mbpp_softc *ms = mbpp_cd.cd_devs[card];
   1629        1.3        pk 	struct mbpp_port *mp = &ms->ms_port[port];
   1630        1.3        pk 	caddr_t buffer, ptr;
   1631        1.3        pk 	int buflen, cnt, len;
   1632        1.3        pk 	int s, error = 0;
   1633        1.3        pk 	int gotdata = 0;
   1634        1.3        pk 
   1635        1.3        pk 	if( uio->uio_resid == 0 )
   1636        1.3        pk 		return(0);
   1637        1.3        pk 
   1638        1.3        pk 	buflen = min(uio->uio_resid, mp->mp_burst);
   1639        1.3        pk 	buffer = malloc(buflen, M_DEVBUF, M_WAITOK);
   1640        1.3        pk 	if( buffer == NULL )
   1641        1.3        pk 		return(ENOMEM);
   1642        1.3        pk 
   1643        1.3        pk 	SET(mp->mp_flags, MBPPF_UIO);
   1644        1.3        pk 
   1645        1.3        pk 	/*
   1646        1.3        pk 	 * start timeout, if needed
   1647        1.3        pk 	 */
   1648        1.3        pk 	if( mp->mp_timeout > 0 ) {
   1649        1.3        pk 		SET(mp->mp_flags, MBPPF_TIMEOUT);
   1650        1.6   thorpej 		callout_reset(&mp->mp_timeout_ch, mp->mp_timeout,
   1651        1.6   thorpej 		    mbpp_timeout, mp);
   1652        1.3        pk 	}
   1653        1.3        pk 
   1654        1.3        pk 	len = cnt = 0;
   1655        1.3        pk 	while( uio->uio_resid > 0 ) {
   1656        1.3        pk 		len = min(buflen, uio->uio_resid);
   1657        1.3        pk 		ptr = buffer;
   1658        1.3        pk 
   1659        1.3        pk 		if( uio->uio_rw == UIO_WRITE ) {
   1660        1.3        pk 			error = uiomove(ptr, len, uio);
   1661        1.3        pk 			if( error ) break;
   1662        1.3        pk 		}
   1663        1.3        pk again:		/* goto bad */
   1664        1.3        pk 		/* timed out?  */
   1665        1.3        pk 		if( !ISSET(mp->mp_flags, MBPPF_UIO) )
   1666        1.3        pk 			break;
   1667        1.3        pk 
   1668        1.3        pk 		/*
   1669        1.3        pk 		 * perform the operation
   1670        1.3        pk 		 */
   1671        1.3        pk 		if( uio->uio_rw == UIO_WRITE ) {
   1672        1.3        pk 			cnt = mbpp_send(mp, ptr, len);
   1673        1.3        pk 		} else {
   1674        1.3        pk 			cnt = mbpp_recv(mp, ptr, len);
   1675        1.3        pk 		}
   1676        1.3        pk 
   1677        1.3        pk 		if( uio->uio_rw == UIO_READ ) {
   1678        1.3        pk 			if( cnt ) {
   1679        1.3        pk 				error = uiomove(ptr, cnt, uio);
   1680        1.3        pk 				if( error ) break;
   1681        1.3        pk 				gotdata++;
   1682        1.3        pk 			}
   1683        1.3        pk 			else if( gotdata )	/* consider us done */
   1684        1.3        pk 				break;
   1685        1.3        pk 		}
   1686        1.3        pk 
   1687        1.3        pk 		/* timed out?  */
   1688        1.3        pk 		if( !ISSET(mp->mp_flags, MBPPF_UIO) )
   1689        1.3        pk 			break;
   1690        1.3        pk 
   1691        1.3        pk 		/*
   1692        1.3        pk 		 * poll delay?
   1693        1.3        pk 		 */
   1694        1.3        pk 		if( mp->mp_delay > 0 ) {
   1695        1.3        pk 			s = splsoftclock();
   1696        1.3        pk 			SET(mp->mp_flags, MBPPF_DELAY);
   1697        1.6   thorpej 			callout_reset(&mp->mp_start_ch, mp->mp_delay,
   1698        1.6   thorpej 			    mbpp_start, mp);
   1699        1.3        pk 			error = tsleep(mp, PCATCH | PZERO, "mbppdelay", 0);
   1700        1.3        pk 			splx(s);
   1701        1.3        pk 			if( error ) break;
   1702        1.3        pk 		}
   1703        1.3        pk 
   1704        1.3        pk 		/*
   1705        1.3        pk 		 * don't call uiomove again until we used all the data we grabbed
   1706        1.3        pk 		 */
   1707        1.3        pk 		if( uio->uio_rw == UIO_WRITE && cnt != len ) {
   1708        1.3        pk 			ptr += cnt;
   1709        1.3        pk 			len -= cnt;
   1710        1.3        pk 			cnt = 0;
   1711        1.3        pk 			goto again;
   1712        1.3        pk 		}
   1713        1.3        pk 	}
   1714        1.3        pk 
   1715        1.3        pk 	/*
   1716        1.3        pk 	 * clear timeouts
   1717        1.3        pk 	 */
   1718        1.3        pk 	s = splsoftclock();
   1719        1.3        pk 	if( ISSET(mp->mp_flags, MBPPF_TIMEOUT) ) {
   1720        1.6   thorpej 		callout_stop(&mp->mp_timeout_ch);
   1721        1.3        pk 		CLR(mp->mp_flags, MBPPF_TIMEOUT);
   1722        1.3        pk 	}
   1723        1.3        pk 	if( ISSET(mp->mp_flags, MBPPF_DELAY) ) {
   1724        1.6   thorpej 		callout_stop(&mp->mp_start_ch);
   1725        1.3        pk 		CLR(mp->mp_flags, MBPPF_DELAY);
   1726        1.3        pk 	}
   1727        1.3        pk 	splx(s);
   1728        1.3        pk 
   1729        1.3        pk 	/*
   1730        1.3        pk 	 * adjust for those chars that we uiomoved but never actually wrote
   1731        1.3        pk 	 */
   1732        1.3        pk 	if( uio->uio_rw == UIO_WRITE && cnt != len ) {
   1733        1.3        pk 		uio->uio_resid += (len - cnt);
   1734        1.3        pk 	}
   1735        1.3        pk 
   1736        1.3        pk 	free(buffer, M_DEVBUF);
   1737        1.3        pk 	return(error);
   1738        1.3        pk }
   1739        1.3        pk 
   1740        1.3        pk void
   1741        1.3        pk mbpp_timeout(arg)
   1742        1.3        pk 	void *arg;
   1743        1.3        pk {
   1744        1.3        pk 	struct mbpp_port *mp = arg;
   1745        1.3        pk 
   1746        1.3        pk 	CLR(mp->mp_flags, MBPPF_UIO | MBPPF_TIMEOUT);
   1747        1.3        pk 	wakeup(mp);
   1748        1.3        pk }
   1749        1.3        pk 
   1750        1.3        pk void
   1751        1.3        pk mbpp_start(arg)
   1752        1.3        pk 	void *arg;
   1753        1.3        pk {
   1754        1.3        pk 	struct mbpp_port *mp = arg;
   1755        1.3        pk 
   1756        1.3        pk 	CLR(mp->mp_flags, MBPPF_DELAY);
   1757        1.3        pk 	wakeup(mp);
   1758        1.3        pk }
   1759        1.3        pk 
   1760        1.3        pk int
   1761        1.3        pk mbpp_send(mp, ptr, len)
   1762        1.3        pk 	struct mbpp_port *mp;
   1763        1.3        pk 	caddr_t ptr;
   1764        1.3        pk 	int len;
   1765        1.3        pk {
   1766        1.3        pk 	int s;
   1767        1.3        pk 	struct cd1400 *cd = mp->mp_cd1400;
   1768        1.3        pk 
   1769        1.3        pk 	/* set up io information */
   1770        1.3        pk 	mp->mp_ptr = ptr;
   1771        1.3        pk 	mp->mp_cnt = len;
   1772        1.3        pk 
   1773        1.3        pk 	/* start transmitting */
   1774        1.3        pk 	s = spltty();
   1775        1.3        pk 	if( cd ) {
   1776        1.3        pk 		cd1400_write_reg(cd, CD1400_CAR, 0);
   1777        1.3        pk 
   1778        1.3        pk 		/* output strobe width ~1microsecond */
   1779        1.3        pk 		cd1400_write_reg(cd, CD1400_TBPR, 10);
   1780        1.3        pk 
   1781        1.3        pk 		/* enable channel */
   1782        1.3        pk 		cd1400_write_ccr(cd, CD1400_CCR_CMDCHANCTL | CD1400_CCR_XMTEN);
   1783        1.3        pk 		cd1400_write_reg(cd, CD1400_SRER, CD1400_SRER_TXRDY);
   1784        1.3        pk 	}
   1785        1.3        pk 
   1786        1.3        pk 	/* ZZzzz... */
   1787        1.3        pk 	tsleep(mp, PCATCH | PZERO, "mbpp_send", 0);
   1788        1.3        pk 
   1789        1.3        pk 	/* stop transmitting */
   1790        1.3        pk 	if( cd ) {
   1791        1.3        pk 		cd1400_write_reg(cd, CD1400_CAR, 0);
   1792        1.3        pk 
   1793        1.3        pk 		/* disable transmitter */
   1794        1.3        pk 		cd1400_write_reg(cd, CD1400_SRER, 0);
   1795        1.3        pk 		cd1400_write_ccr(cd, CD1400_CCR_CMDCHANCTL | CD1400_CCR_XMTDIS);
   1796        1.3        pk 
   1797        1.3        pk 		/* flush fifo */
   1798        1.3        pk 		cd1400_write_ccr(cd, CD1400_CCR_CMDRESET | CD1400_CCR_FTF);
   1799        1.3        pk 	}
   1800        1.3        pk 	splx(s);
   1801        1.3        pk 
   1802        1.3        pk 	/* return number of chars sent */
   1803        1.3        pk 	return(len - mp->mp_cnt);
   1804        1.3        pk }
   1805        1.3        pk 
   1806        1.3        pk int
   1807        1.3        pk mbpp_recv(mp, ptr, len)
   1808        1.3        pk 	struct mbpp_port *mp;
   1809        1.3        pk 	caddr_t ptr;
   1810        1.3        pk 	int len;
   1811        1.3        pk {
   1812        1.3        pk 	int s;
   1813        1.3        pk 	struct cd1400 *cd = mp->mp_cd1400;
   1814        1.3        pk 
   1815        1.3        pk 	/* set up io information */
   1816        1.3        pk 	mp->mp_ptr = ptr;
   1817        1.3        pk 	mp->mp_cnt = len;
   1818        1.3        pk 
   1819        1.3        pk 	/* start receiving */
   1820        1.3        pk 	s = spltty();
   1821        1.3        pk 	if( cd ) {
   1822        1.3        pk 	int rcor, rbpr;
   1823        1.3        pk 
   1824        1.3        pk 		cd1400_write_reg(cd, CD1400_CAR, 0);
   1825        1.3        pk 
   1826        1.3        pk 		/* input strobe at 100kbaud (10microseconds) */
   1827        1.3        pk 		cd1400_compute_baud(100000, cd->cd_clock, &rcor, &rbpr);
   1828        1.3        pk 		cd1400_write_reg(cd, CD1400_RCOR, rcor);
   1829        1.3        pk 		cd1400_write_reg(cd, CD1400_RBPR, rbpr);
   1830        1.3        pk 
   1831        1.3        pk 		/* rx threshold */
   1832        1.3        pk 		cd1400_write_reg(cd, CD1400_COR3, MBPP_RX_FIFO_THRESHOLD);
   1833        1.3        pk 		cd1400_write_ccr(cd, CD1400_CCR_CMDCORCHG | CD1400_CCR_COR3);
   1834        1.3        pk 
   1835        1.3        pk 		/* enable channel */
   1836        1.3        pk 		cd1400_write_ccr(cd, CD1400_CCR_CMDCHANCTL | CD1400_CCR_RCVEN);
   1837        1.3        pk 		cd1400_write_reg(cd, CD1400_SRER, CD1400_SRER_RXDATA);
   1838        1.3        pk 	}
   1839        1.3        pk 
   1840        1.3        pk 	/* ZZzzz... */
   1841        1.3        pk 	tsleep(mp, PCATCH | PZERO, "mbpp_recv", 0);
   1842        1.3        pk 
   1843        1.3        pk 	/* stop receiving */
   1844        1.3        pk 	if( cd ) {
   1845        1.3        pk 		cd1400_write_reg(cd, CD1400_CAR, 0);
   1846        1.3        pk 
   1847        1.3        pk 		/* disable receiving */
   1848        1.3        pk 		cd1400_write_reg(cd, CD1400_SRER, 0);
   1849        1.3        pk 		cd1400_write_ccr(cd, CD1400_CCR_CMDCHANCTL | CD1400_CCR_RCVDIS);
   1850        1.3        pk 	}
   1851        1.3        pk 	splx(s);
   1852        1.3        pk 
   1853        1.3        pk 	/* return number of chars received */
   1854        1.3        pk 	return(len - mp->mp_cnt);
   1855        1.3        pk }
   1856        1.3        pk 
   1857        1.3        pk int
   1858        1.3        pk mbpp_hztoms(h)
   1859        1.3        pk 	int h;
   1860        1.3        pk {
   1861        1.3        pk 	int m = h;
   1862        1.3        pk 
   1863        1.3        pk 	if( m > 0 )
   1864        1.3        pk 		m = m * 1000 / hz;
   1865        1.3        pk 	return(m);
   1866        1.3        pk }
   1867        1.3        pk 
   1868        1.3        pk int
   1869        1.3        pk mbpp_mstohz(m)
   1870        1.3        pk 	int m;
   1871        1.3        pk {
   1872        1.3        pk 	int h = m;
   1873        1.3        pk 
   1874        1.3        pk 	if( h > 0 ) {
   1875        1.3        pk 		h = h * hz / 1000;
   1876        1.3        pk 		if( h == 0 )
   1877        1.3        pk 			h = 1000 / hz;
   1878        1.3        pk 	}
   1879        1.3        pk 	return(h);
   1880        1.1        pk }
   1881        1.1        pk 
   1882        1.1        pk #endif /* NMAGMA */
   1883