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