Home | History | Annotate | Line # | Download | only in sbus
stp4020.c revision 1.10.4.1
      1  1.10.4.1      mrg /*	$NetBSD: stp4020.c,v 1.10.4.1 2000/07/19 02:53:08 mrg Exp $ */
      2       1.1       pk 
      3       1.1       pk /*-
      4       1.1       pk  * Copyright (c) 1998 The NetBSD Foundation, Inc.
      5       1.1       pk  * All rights reserved.
      6       1.1       pk  *
      7       1.1       pk  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1       pk  * by Paul Kranenburg.
      9       1.1       pk  *
     10       1.1       pk  * Redistribution and use in source and binary forms, with or without
     11       1.1       pk  * modification, are permitted provided that the following conditions
     12       1.1       pk  * are met:
     13       1.1       pk  * 1. Redistributions of source code must retain the above copyright
     14       1.1       pk  *    notice, this list of conditions and the following disclaimer.
     15       1.1       pk  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1       pk  *    notice, this list of conditions and the following disclaimer in the
     17       1.1       pk  *    documentation and/or other materials provided with the distribution.
     18       1.1       pk  * 3. All advertising materials mentioning features or use of this software
     19       1.1       pk  *    must display the following acknowledgement:
     20       1.1       pk  *        This product includes software developed by the NetBSD
     21       1.1       pk  *        Foundation, Inc. and its contributors.
     22       1.1       pk  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23       1.1       pk  *    contributors may be used to endorse or promote products derived
     24       1.1       pk  *    from this software without specific prior written permission.
     25       1.1       pk  *
     26       1.1       pk  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27       1.1       pk  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28       1.1       pk  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29       1.1       pk  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30       1.1       pk  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31       1.1       pk  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32       1.1       pk  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33       1.1       pk  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34       1.1       pk  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35       1.1       pk  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36       1.1       pk  * POSSIBILITY OF SUCH DAMAGE.
     37       1.1       pk  */
     38       1.1       pk 
     39       1.1       pk /*
     40       1.1       pk  * STP4020: SBus/PCMCIA bridge supporting two Type-3 PCMCIA cards.
     41       1.1       pk  */
     42       1.1       pk 
     43       1.1       pk #include <sys/types.h>
     44       1.1       pk #include <sys/param.h>
     45       1.1       pk #include <sys/systm.h>
     46       1.1       pk #include <sys/errno.h>
     47       1.1       pk #include <sys/malloc.h>
     48       1.1       pk #include <sys/proc.h>
     49       1.1       pk #include <sys/kernel.h>
     50       1.1       pk #include <sys/kthread.h>
     51       1.1       pk #include <sys/device.h>
     52       1.1       pk 
     53       1.1       pk #include <dev/pcmcia/pcmciareg.h>
     54       1.1       pk #include <dev/pcmcia/pcmciavar.h>
     55       1.1       pk #include <dev/pcmcia/pcmciachip.h>
     56       1.1       pk 
     57       1.1       pk #include <machine/bus.h>
     58  1.10.4.1      mrg #include <machine/intr.h>
     59       1.1       pk 
     60       1.1       pk #include <dev/sbus/sbusvar.h>
     61       1.1       pk #include <dev/sbus/stp4020reg.h>
     62       1.1       pk 
     63       1.1       pk #define STP4020_DEBUG 1	/* XXX-temp */
     64       1.1       pk 
     65       1.1       pk #if defined(STP4020_DEBUG)
     66       1.1       pk int stp4020_debug = 0;
     67       1.1       pk #define DPRINTF(x)	do { if (stp4020_debug) printf x; } while(0)
     68       1.1       pk #else
     69       1.1       pk #define DPRINTF(x)
     70       1.1       pk #endif
     71       1.1       pk 
     72       1.1       pk /*
     73       1.1       pk  * Event queue; events detected in an interrupt context go here
     74       1.1       pk  * awaiting attention from our event handling thread.
     75       1.1       pk  */
     76       1.1       pk struct stp4020_event {
     77       1.1       pk 	SIMPLEQ_ENTRY(stp4020_event) se_q;
     78       1.1       pk 	int	se_type;
     79       1.1       pk 	int	se_sock;
     80       1.1       pk };
     81       1.1       pk /* Defined event types */
     82       1.1       pk #define STP4020_EVENT_INSERTION	0
     83       1.1       pk #define STP4020_EVENT_REMOVAL	1
     84       1.1       pk 
     85       1.1       pk /*
     86       1.1       pk  * Per socket data.
     87       1.1       pk  */
     88       1.1       pk struct stp4020_socket {
     89       1.1       pk 	struct stp4020_softc	*sc;	/* Back link */
     90       1.1       pk 	int		flags;
     91       1.1       pk #define STP4020_SOCKET_BUSY	0x0001
     92       1.1       pk #define STP4020_SOCKET_SHUTDOWN	0x0002
     93       1.1       pk 	int		sock;		/* Socket number (0 or 1) */
     94       1.1       pk 	bus_space_tag_t	tag;		/* socket control space */
     95       1.1       pk 	bus_space_handle_t	regs;	/* 			*/
     96       1.1       pk 	struct device	*pcmcia;	/* Associated PCMCIA device */
     97       1.1       pk 	int		(*intrhandler)	/* Card driver interrupt handler */
     98       1.1       pk 			    __P((void *));
     99       1.1       pk 	void		*intrarg;	/* Card interrupt handler argument */
    100       1.1       pk 	int		ipl;		/* Interrupt level suggested by card */
    101       1.1       pk 	int		winalloc;	/* Windows allocated (bitmask) */
    102       1.1       pk 	struct {
    103       1.1       pk 		bus_space_handle_t	winaddr;/* this window's address */
    104       1.1       pk 	} windows[STP4020_NWIN];
    105       1.1       pk 
    106       1.1       pk };
    107       1.1       pk 
    108       1.1       pk struct stp4020_softc {
    109       1.1       pk 	struct device	sc_dev;		/* Base device */
    110       1.1       pk 	struct sbusdev	sc_sd;		/* SBus device */
    111       1.1       pk 	bus_space_tag_t	sc_bustag;
    112       1.1       pk 	bus_dma_tag_t	sc_dmatag;
    113       1.1       pk 	pcmcia_chipset_tag_t	sc_pct;	/* Chipset methods */
    114       1.1       pk 
    115       1.1       pk 	struct proc	*event_thread;		/* event handling thread */
    116       1.1       pk 	SIMPLEQ_HEAD(, stp4020_event)	events;	/* Pending events for thread */
    117       1.1       pk 
    118       1.1       pk 	struct stp4020_socket sc_socks[STP4020_NSOCK];
    119       1.1       pk };
    120       1.1       pk 
    121       1.1       pk 
    122       1.1       pk static int	stp4020print	__P((void *, const char *));
    123       1.1       pk static int	stp4020match	__P((struct device *, struct cfdata *, void *));
    124       1.1       pk static void	stp4020attach	__P((struct device *, struct device *, void *));
    125       1.1       pk static int	stp4020_iointr	__P((void *));
    126       1.1       pk static int	stp4020_statintr __P((void *));
    127       1.1       pk 
    128       1.1       pk struct cfattach nell_ca = {
    129       1.1       pk 	sizeof(struct stp4020_softc), stp4020match, stp4020attach
    130       1.1       pk };
    131       1.1       pk 
    132       1.6       pk #ifdef STP4020_DEBUG
    133       1.6       pk static void	stp4020_dump_regs __P((struct stp4020_socket *));
    134       1.6       pk #endif
    135       1.1       pk 
    136       1.1       pk static int	stp4020_rd_sockctl __P((struct stp4020_socket *, int));
    137       1.1       pk static void	stp4020_wr_sockctl __P((struct stp4020_socket *, int, int));
    138       1.1       pk static int	stp4020_rd_winctl __P((struct stp4020_socket *, int, int));
    139       1.1       pk static void	stp4020_wr_winctl __P((struct stp4020_socket *, int, int, int));
    140       1.1       pk 
    141       1.1       pk void	stp4020_delay __P((unsigned int));
    142       1.1       pk void	stp4020_attach_socket __P((struct stp4020_socket *));
    143       1.1       pk void	stp4020_create_event_thread __P((void *));
    144       1.1       pk void	stp4020_event_thread __P((void *));
    145       1.1       pk void	stp4020_queue_event __P((struct stp4020_softc *, int, int));
    146       1.1       pk 
    147       1.1       pk int	stp4020_chip_mem_alloc __P((pcmcia_chipset_handle_t, bus_size_t,
    148       1.1       pk 				    struct pcmcia_mem_handle *));
    149       1.1       pk void	stp4020_chip_mem_free __P((pcmcia_chipset_handle_t,
    150       1.1       pk 				   struct pcmcia_mem_handle *));
    151       1.1       pk int	stp4020_chip_mem_map __P((pcmcia_chipset_handle_t, int, bus_addr_t,
    152       1.1       pk 				  bus_size_t, struct pcmcia_mem_handle *,
    153       1.1       pk 				  bus_addr_t *, int *));
    154       1.1       pk void	stp4020_chip_mem_unmap __P((pcmcia_chipset_handle_t, int));
    155       1.1       pk 
    156       1.1       pk int	stp4020_chip_io_alloc __P((pcmcia_chipset_handle_t,
    157       1.1       pk 				   bus_addr_t, bus_size_t, bus_size_t,
    158       1.1       pk 				   struct pcmcia_io_handle *));
    159       1.1       pk void	stp4020_chip_io_free __P((pcmcia_chipset_handle_t,
    160       1.1       pk 				  struct pcmcia_io_handle *));
    161       1.1       pk int	stp4020_chip_io_map __P((pcmcia_chipset_handle_t, int, bus_addr_t,
    162       1.1       pk 				 bus_size_t, struct pcmcia_io_handle *, int *));
    163       1.1       pk void	stp4020_chip_io_unmap __P((pcmcia_chipset_handle_t, int));
    164       1.1       pk 
    165       1.1       pk void	stp4020_chip_socket_enable __P((pcmcia_chipset_handle_t));
    166       1.1       pk void	stp4020_chip_socket_disable __P((pcmcia_chipset_handle_t));
    167       1.1       pk void	*stp4020_chip_intr_establish __P((pcmcia_chipset_handle_t,
    168       1.1       pk 					  struct pcmcia_function *, int,
    169       1.1       pk 					  int (*) __P((void *)), void *));
    170       1.1       pk void	stp4020_chip_intr_disestablish __P((pcmcia_chipset_handle_t, void *));
    171       1.1       pk 
    172       1.1       pk 
    173       1.1       pk /* Our PCMCIA chipset methods */
    174       1.1       pk static struct pcmcia_chip_functions stp4020_functions = {
    175       1.1       pk 	stp4020_chip_mem_alloc,
    176       1.1       pk 	stp4020_chip_mem_free,
    177       1.1       pk 	stp4020_chip_mem_map,
    178       1.1       pk 	stp4020_chip_mem_unmap,
    179       1.1       pk 
    180       1.1       pk 	stp4020_chip_io_alloc,
    181       1.1       pk 	stp4020_chip_io_free,
    182       1.1       pk 	stp4020_chip_io_map,
    183       1.1       pk 	stp4020_chip_io_unmap,
    184       1.1       pk 
    185       1.1       pk 	stp4020_chip_intr_establish,
    186       1.1       pk 	stp4020_chip_intr_disestablish,
    187       1.1       pk 
    188       1.1       pk 	stp4020_chip_socket_enable,
    189       1.1       pk 	stp4020_chip_socket_disable
    190       1.1       pk };
    191       1.1       pk 
    192       1.1       pk 
    193       1.1       pk static __inline__ int
    194       1.1       pk stp4020_rd_sockctl(h, idx)
    195       1.1       pk 	struct stp4020_socket *h;
    196       1.1       pk 	int idx;
    197       1.1       pk {
    198       1.1       pk 	int o = ((STP4020_SOCKREGS_SIZE * (h->sock)) + idx);
    199       1.1       pk 	return (bus_space_read_2(h->tag, h->regs, o));
    200       1.1       pk }
    201       1.1       pk 
    202       1.1       pk static __inline__ void
    203       1.1       pk stp4020_wr_sockctl(h, idx, v)
    204       1.1       pk 	struct stp4020_socket *h;
    205       1.1       pk 	int idx;
    206       1.1       pk 	int v;
    207       1.1       pk {
    208       1.1       pk 	int o = (STP4020_SOCKREGS_SIZE * (h->sock)) + idx;
    209       1.1       pk 	bus_space_write_2(h->tag, h->regs, o, v);
    210       1.1       pk }
    211       1.1       pk 
    212       1.1       pk static __inline__ int
    213       1.1       pk stp4020_rd_winctl(h, win, idx)
    214       1.1       pk 	struct stp4020_socket *h;
    215       1.1       pk 	int win;
    216       1.1       pk 	int idx;
    217       1.1       pk {
    218       1.1       pk 	int o = (STP4020_SOCKREGS_SIZE * (h->sock)) +
    219       1.1       pk 		(STP4020_WINREGS_SIZE * win) + idx;
    220       1.1       pk 	return (bus_space_read_2(h->tag, h->regs, o));
    221       1.1       pk }
    222       1.1       pk 
    223       1.1       pk static __inline__ void
    224       1.1       pk stp4020_wr_winctl(h, win, idx, v)
    225       1.1       pk 	struct stp4020_socket *h;
    226       1.1       pk 	int win;
    227       1.1       pk 	int idx;
    228       1.1       pk 	int v;
    229       1.1       pk {
    230       1.1       pk 	int o = (STP4020_SOCKREGS_SIZE * (h->sock)) +
    231       1.1       pk 		(STP4020_WINREGS_SIZE * win) + idx;
    232       1.1       pk 
    233       1.1       pk 	bus_space_write_2(h->tag, h->regs, o, v);
    234       1.1       pk }
    235       1.1       pk 
    236       1.1       pk 
    237       1.1       pk int
    238       1.1       pk stp4020print(aux, busname)
    239       1.1       pk 	void *aux;
    240       1.1       pk 	const char *busname;
    241       1.1       pk {
    242       1.4       pk 	struct pcmciabus_attach_args *paa = aux;
    243       1.3       pk 	struct stp4020_socket *h = paa->pch;
    244       1.3       pk 
    245       1.3       pk 	printf(" socket %d", h->sock);
    246       1.1       pk 	return (UNCONF);
    247       1.1       pk }
    248       1.1       pk 
    249       1.1       pk int
    250       1.1       pk stp4020match(parent, cf, aux)
    251       1.1       pk 	struct device *parent;
    252       1.1       pk 	struct cfdata *cf;
    253       1.1       pk 	void *aux;
    254       1.1       pk {
    255       1.1       pk 	struct sbus_attach_args *sa = aux;
    256       1.1       pk 
    257       1.2       pk 	return (strcmp("SUNW,pcmcia", sa->sa_name) == 0);
    258       1.1       pk }
    259       1.1       pk 
    260       1.1       pk /*
    261       1.1       pk  * Attach all the sub-devices we can find
    262       1.1       pk  */
    263       1.1       pk void
    264       1.1       pk stp4020attach(parent, self, aux)
    265       1.1       pk 	struct device *parent, *self;
    266       1.1       pk 	void *aux;
    267       1.1       pk {
    268       1.1       pk 	struct sbus_attach_args *sa = aux;
    269       1.1       pk 	struct stp4020_softc *sc = (void *)self;
    270       1.1       pk 	int node, rev;
    271       1.1       pk 	int i;
    272       1.1       pk 	bus_space_handle_t bh;
    273       1.1       pk 
    274       1.1       pk 	node = sa->sa_node;
    275       1.1       pk 
    276       1.1       pk 	/* Transfer bus tags */
    277       1.1       pk 	sc->sc_bustag = sa->sa_bustag;
    278       1.1       pk 	sc->sc_dmatag = sa->sa_dmatag;
    279       1.1       pk 
    280       1.1       pk 	/* Set up per-socket static initialization */
    281       1.1       pk 	sc->sc_socks[0].sc = sc->sc_socks[1].sc = sc;
    282       1.1       pk 	sc->sc_socks[0].tag = sc->sc_socks[1].tag = sa->sa_bustag;
    283       1.1       pk 
    284       1.9       pk 	if (sa->sa_nreg < 8) {
    285       1.1       pk 		printf("%s: only %d register sets\n",
    286       1.1       pk 			self->dv_xname, sa->sa_nreg);
    287       1.1       pk 		return;
    288       1.1       pk 	}
    289       1.1       pk 
    290       1.1       pk 	if (sa->sa_nintr != 2) {
    291       1.1       pk 		printf("%s: expect 2 interrupt Sbus levels; got %d\n",
    292       1.1       pk 			self->dv_xname, sa->sa_nintr);
    293       1.1       pk 		return;
    294       1.1       pk 	}
    295       1.1       pk 
    296       1.9       pk #define STP4020_BANK_PROM	0
    297       1.1       pk #define STP4020_BANK_CTRL	4
    298       1.1       pk 	for (i = 0; i < 8; i++) {
    299      1.10       pk 
    300       1.1       pk 		/*
    301       1.1       pk 		 * STP4020 Register address map:
    302       1.1       pk 		 *	bank  0:   Forth PROM
    303       1.1       pk 		 *	banks 1-3: socket 0, windows 0-2
    304       1.1       pk 		 *	bank  4:   control registers
    305       1.1       pk 		 *	banks 5-7: socket 1, windows 0-2
    306       1.1       pk 		 */
    307      1.10       pk 
    308       1.9       pk 		if (i == STP4020_BANK_PROM)
    309       1.9       pk 			/* Skip the PROM */
    310       1.9       pk 			continue;
    311       1.9       pk 
    312       1.1       pk 		if (sbus_bus_map(sa->sa_bustag,
    313       1.1       pk 				 sa->sa_reg[i].sbr_slot,
    314       1.1       pk 				 sa->sa_reg[i].sbr_offset,
    315       1.1       pk 				 sa->sa_reg[i].sbr_size,
    316       1.1       pk 				 BUS_SPACE_MAP_LINEAR, 0,
    317      1.10       pk 				 &bh) != 0) {
    318       1.1       pk 			printf("%s: attach: cannot map registers\n",
    319       1.1       pk 				self->dv_xname);
    320       1.1       pk 			return;
    321       1.1       pk 		}
    322      1.10       pk 
    323      1.10       pk 		if (i == STP4020_BANK_CTRL) {
    324      1.10       pk 			/*
    325      1.10       pk 			 * Copy tag and handle to both socket structures
    326      1.10       pk 			 * for easy access in control/status IO functions.
    327      1.10       pk 			 */
    328      1.10       pk 			sc->sc_socks[0].regs = sc->sc_socks[1].regs = bh;
    329      1.10       pk 		} else if (i < STP4020_BANK_CTRL) {
    330      1.10       pk 			/* banks 1-3 */
    331      1.10       pk 			sc->sc_socks[0].windows[i-1].winaddr = bh;
    332      1.10       pk 		} else {
    333      1.10       pk 			/* banks 5-7 */
    334      1.10       pk 			sc->sc_socks[1].windows[i-5].winaddr = bh;
    335      1.10       pk 		}
    336       1.1       pk 	}
    337       1.1       pk 
    338       1.1       pk 	sbus_establish(&sc->sc_sd, &sc->sc_dev);
    339       1.1       pk 
    340       1.1       pk 	/*
    341       1.1       pk 	 * We get to use two SBus interrupt levels.
    342       1.1       pk 	 * The higher level we use for status change interrupts;
    343       1.1       pk 	 * the lower level for PC card I/O.
    344       1.1       pk 	 */
    345       1.7       pk 	if (sa->sa_nintr != 0) {
    346       1.7       pk 		bus_intr_establish(sa->sa_bustag, sa->sa_intr[1].sbi_pri,
    347  1.10.4.1      mrg 				   IPL_NONE, 0, stp4020_statintr, sc);
    348       1.1       pk 
    349       1.7       pk 		bus_intr_establish(sa->sa_bustag, sa->sa_intr[0].sbi_pri,
    350  1.10.4.1      mrg 				   IPL_NONE, 0, stp4020_iointr, sc);
    351       1.7       pk 	}
    352       1.1       pk 
    353       1.1       pk 	rev = stp4020_rd_sockctl(&sc->sc_socks[0], STP4020_ISR1_IDX) &
    354       1.1       pk 		STP4020_ISR1_REV_M;
    355       1.1       pk 	printf(": rev %x\n", rev);
    356       1.1       pk 
    357       1.1       pk 	sc->sc_pct = (pcmcia_chipset_tag_t)&stp4020_functions;
    358       1.1       pk 
    359       1.1       pk 	/*
    360       1.1       pk 	 * Arrange that a kernel thread be created to handle
    361       1.1       pk 	 * insert/removal events.
    362       1.1       pk 	 */
    363       1.1       pk 	SIMPLEQ_INIT(&sc->events);
    364       1.5  thorpej 	kthread_create(stp4020_create_event_thread, sc);
    365       1.1       pk 
    366       1.1       pk 	for (i = 0; i < STP4020_NSOCK; i++) {
    367       1.1       pk 		struct stp4020_socket *h = &sc->sc_socks[i];
    368       1.1       pk 		h->sock = i;
    369       1.1       pk 		h->sc = sc;
    370       1.6       pk #ifdef STP4020_DEBUG
    371       1.6       pk 		stp4020_dump_regs(h);
    372       1.6       pk #endif
    373       1.1       pk 		stp4020_attach_socket(h);
    374       1.1       pk 	}
    375       1.1       pk }
    376       1.1       pk 
    377       1.1       pk void
    378       1.1       pk stp4020_attach_socket(h)
    379       1.1       pk 	struct stp4020_socket *h;
    380       1.1       pk {
    381       1.1       pk 	struct pcmciabus_attach_args paa;
    382       1.1       pk 	int v;
    383       1.1       pk 
    384       1.1       pk 	/* Initialize the rest of the handle */
    385       1.1       pk 	h->winalloc = 0;
    386       1.1       pk 
    387       1.1       pk 	/* Configure one pcmcia device per socket */
    388       1.9       pk 	paa.paa_busname = "pcmcia";
    389       1.1       pk 	paa.pct = (pcmcia_chipset_tag_t)h->sc->sc_pct;
    390       1.1       pk 	paa.pch = (pcmcia_chipset_handle_t)h;
    391       1.1       pk 	paa.iobase = 0;
    392       1.1       pk 	paa.iosize = 0;
    393       1.1       pk 
    394       1.1       pk 	h->pcmcia = config_found(&h->sc->sc_dev, &paa, stp4020print);
    395       1.1       pk 
    396       1.1       pk 	if (h->pcmcia == NULL)
    397       1.1       pk 		return;
    398       1.1       pk 
    399       1.1       pk 	/*
    400       1.1       pk 	 * There's actually a pcmcia bus attached; initialize the slot.
    401       1.1       pk 	 */
    402       1.1       pk 
    403       1.1       pk 	/*
    404       1.1       pk 	 * Enable socket status change interrupts.
    405       1.1       pk 	 * We use SB_INT[1] for status change interrupts.
    406       1.1       pk 	 */
    407       1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    408       1.1       pk 	v |= STP4020_ICR0_ALL_STATUS_IE | STP4020_ICR0_SCILVL_SB1;
    409       1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    410       1.1       pk 
    411       1.1       pk 	/* Get live status bits from ISR0 */
    412       1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    413       1.1       pk 	if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0)
    414       1.1       pk 		return;
    415       1.1       pk 
    416       1.1       pk 	pcmcia_card_attach(h->pcmcia);
    417       1.1       pk 	h->flags |= STP4020_SOCKET_BUSY;
    418       1.1       pk }
    419       1.1       pk 
    420       1.1       pk 
    421       1.1       pk /*
    422       1.1       pk  * Deferred thread creation callback.
    423       1.1       pk  */
    424       1.1       pk void
    425       1.1       pk stp4020_create_event_thread(arg)
    426       1.1       pk 	void *arg;
    427       1.1       pk {
    428       1.1       pk 	struct stp4020_softc *sc = arg;
    429       1.1       pk 	const char *name = sc->sc_dev.dv_xname;
    430       1.1       pk 
    431       1.5  thorpej 	if (kthread_create1(stp4020_event_thread, sc, &sc->event_thread,
    432       1.1       pk 			   "%s", name)) {
    433       1.1       pk 		panic("%s: unable to create event thread", name);
    434       1.1       pk 	}
    435       1.1       pk }
    436       1.1       pk 
    437       1.1       pk /*
    438       1.1       pk  * The actual event handling thread.
    439       1.1       pk  */
    440       1.1       pk void
    441       1.1       pk stp4020_event_thread(arg)
    442       1.1       pk 	void *arg;
    443       1.1       pk {
    444       1.1       pk 	struct stp4020_softc *sc = arg;
    445       1.1       pk 	struct stp4020_event *e;
    446       1.1       pk 	int s;
    447       1.1       pk 
    448       1.1       pk 	while (1) {
    449       1.1       pk 		struct stp4020_socket *h;
    450       1.1       pk 		int n;
    451       1.1       pk 
    452       1.1       pk 		s = splhigh();
    453       1.1       pk 		if ((e = SIMPLEQ_FIRST(&sc->events)) == NULL) {
    454       1.1       pk 			splx(s);
    455       1.1       pk 			(void)tsleep(&sc->events, PWAIT, "pcicev", 0);
    456       1.1       pk 			continue;
    457       1.1       pk 		}
    458       1.1       pk 		SIMPLEQ_REMOVE_HEAD(&sc->events, e, se_q);
    459       1.1       pk 		splx(s);
    460       1.1       pk 
    461       1.1       pk 		n = e->se_sock;
    462       1.1       pk 		if (n < 0 || n >= STP4020_NSOCK)
    463       1.1       pk 			panic("stp4020_event_thread: wayward socket number %d",
    464       1.1       pk 			      n);
    465       1.1       pk 
    466       1.1       pk 		h = &sc->sc_socks[n];
    467       1.1       pk 		switch (e->se_type) {
    468       1.1       pk 		case STP4020_EVENT_INSERTION:
    469       1.1       pk 			pcmcia_card_attach(h->pcmcia);
    470       1.1       pk 			break;
    471       1.1       pk 		case STP4020_EVENT_REMOVAL:
    472       1.1       pk 			pcmcia_card_detach(h->pcmcia, DETACH_FORCE);
    473       1.1       pk 			break;
    474       1.1       pk 		default:
    475       1.1       pk 			panic("stp4020_event_thread: unknown event type %d",
    476       1.1       pk 			      e->se_type);
    477       1.1       pk 		}
    478       1.1       pk 		free(e, M_TEMP);
    479       1.1       pk 	}
    480       1.1       pk }
    481       1.1       pk 
    482       1.1       pk void
    483       1.1       pk stp4020_queue_event(sc, sock, event)
    484       1.1       pk 	struct stp4020_softc *sc;
    485       1.1       pk 	int sock, event;
    486       1.1       pk {
    487       1.1       pk 	struct stp4020_event *e;
    488       1.1       pk 	int s;
    489       1.1       pk 
    490       1.1       pk 	e = malloc(sizeof(*e), M_TEMP, M_NOWAIT);
    491       1.1       pk 	if (e == NULL)
    492       1.1       pk 		panic("stp4020_queue_event: can't allocate event");
    493       1.1       pk 
    494       1.1       pk 	e->se_type = event;
    495       1.1       pk 	e->se_sock = sock;
    496       1.1       pk 	s = splhigh();
    497       1.1       pk 	SIMPLEQ_INSERT_TAIL(&sc->events, e, se_q);
    498       1.1       pk 	splx(s);
    499       1.1       pk 	wakeup(&sc->events);
    500       1.1       pk }
    501       1.1       pk 
    502       1.1       pk int
    503       1.1       pk stp4020_statintr(arg)
    504       1.1       pk 	void *arg;
    505       1.1       pk {
    506       1.1       pk 	struct stp4020_softc *sc = arg;
    507       1.1       pk 	int i, r = 0;
    508       1.1       pk 
    509       1.1       pk 	/*
    510       1.1       pk 	 * Check each socket for pending requests.
    511       1.1       pk 	 */
    512       1.1       pk 	for (i = 0 ; i < STP4020_NSOCK; i++) {
    513       1.1       pk 		struct stp4020_socket *h;
    514       1.1       pk 		int v;
    515       1.1       pk 
    516       1.1       pk 		h = &sc->sc_socks[i];
    517       1.1       pk 
    518       1.1       pk 		/* Read socket's ISR0 for the interrupt status bits */
    519       1.1       pk 		v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    520       1.1       pk 
    521       1.1       pk #ifdef STP4020_DEBUG
    522       1.1       pk 		if (stp4020_debug != 0) {
    523       1.1       pk 			char bits[64];
    524       1.1       pk 			bitmask_snprintf(v, STP4020_ISR0_IOBITS,
    525       1.1       pk 					 bits, sizeof(bits));
    526       1.1       pk 			printf("stp4020_statintr: ISR0=%s\n", bits);
    527       1.1       pk 		}
    528       1.1       pk #endif
    529       1.1       pk 
    530       1.1       pk 		/* Ack all interrupts at once */
    531       1.1       pk 		stp4020_wr_sockctl(h, STP4020_ISR0_IDX,
    532       1.1       pk 				   STP4020_ISR0_ALL_STATUS_IRQ);
    533       1.1       pk 
    534       1.1       pk 		if ((v & STP4020_ISR0_CDCHG) != 0) {
    535       1.1       pk 			/*
    536       1.1       pk 			 * Card status change detect
    537       1.1       pk 			 */
    538       1.1       pk 			if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) != 0){
    539       1.1       pk 				if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
    540       1.1       pk 					stp4020_queue_event(sc, i,
    541       1.1       pk 						STP4020_EVENT_INSERTION);
    542       1.1       pk 					h->flags |= STP4020_SOCKET_BUSY;
    543       1.1       pk 				}
    544       1.1       pk 			}
    545       1.1       pk 			if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0){
    546       1.1       pk 				if ((h->flags & STP4020_SOCKET_BUSY) != 0) {
    547       1.1       pk 					stp4020_queue_event(sc, i,
    548       1.1       pk 						STP4020_EVENT_REMOVAL);
    549       1.1       pk 					h->flags &= ~STP4020_SOCKET_BUSY;
    550       1.1       pk 				}
    551       1.1       pk 			}
    552       1.1       pk 		}
    553       1.1       pk 
    554       1.1       pk 		/* XXX - a bunch of unhandled conditions */
    555       1.1       pk 		if ((v & STP4020_ISR0_BVD1CHG) != 0) {
    556       1.1       pk 			printf("stp4020[%d]: Battery change 1\n", h->sock);
    557       1.1       pk 		}
    558       1.1       pk 
    559       1.1       pk 		if ((v & STP4020_ISR0_BVD2CHG) != 0) {
    560       1.1       pk 			printf("stp4020[%d]: Battery change 2\n", h->sock);
    561       1.1       pk 		}
    562       1.1       pk 
    563       1.1       pk 		if ((v & STP4020_ISR0_RDYCHG) != 0) {
    564       1.1       pk 			printf("stp4020[%d]: Ready/Busy change\n", h->sock);
    565       1.1       pk 		}
    566       1.1       pk 
    567       1.1       pk 		if ((v & STP4020_ISR0_WPCHG) != 0) {
    568       1.1       pk 			printf("stp4020[%d]: Write protect change\n", h->sock);
    569       1.1       pk 		}
    570       1.1       pk 
    571       1.1       pk 		if ((v & STP4020_ISR0_PCTO) != 0) {
    572       1.1       pk 			printf("stp4020[%d]: Card access timeout\n", h->sock);
    573       1.1       pk 		}
    574       1.1       pk 	}
    575       1.1       pk 
    576       1.1       pk 	return (r);
    577       1.1       pk }
    578       1.1       pk 
    579       1.1       pk int
    580       1.1       pk stp4020_iointr(arg)
    581       1.1       pk 	void *arg;
    582       1.1       pk {
    583       1.1       pk 	struct stp4020_softc *sc = arg;
    584       1.1       pk 	int i, r = 0;
    585       1.1       pk 
    586       1.1       pk 	/*
    587       1.1       pk 	 * Check each socket for pending requests.
    588       1.1       pk 	 */
    589       1.1       pk 	for (i = 0 ; i < STP4020_NSOCK; i++) {
    590       1.1       pk 		struct stp4020_socket *h;
    591       1.1       pk 		int v;
    592       1.1       pk 
    593       1.1       pk 		h = &sc->sc_socks[i];
    594       1.1       pk 		v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    595       1.1       pk 
    596       1.1       pk 		if ((v & STP4020_ISR0_IOINT) != 0) {
    597       1.1       pk 			/* It's a card interrupt */
    598       1.1       pk 			if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
    599       1.1       pk 				printf("stp4020[%d]: spurious interrupt?\n",
    600       1.1       pk 					h->sock);
    601       1.1       pk 				continue;
    602       1.1       pk 			}
    603       1.1       pk 			/* Call card handler, if any */
    604       1.1       pk 			if (h->intrhandler != NULL)
    605       1.1       pk 				r |= (*h->intrhandler)(h->intrarg);
    606       1.1       pk 		}
    607       1.1       pk 
    608       1.1       pk 	}
    609       1.1       pk 
    610       1.1       pk 	return (r);
    611       1.1       pk }
    612       1.1       pk 
    613       1.1       pk int
    614       1.1       pk stp4020_chip_mem_alloc(pch, size, pcmhp)
    615       1.1       pk 	pcmcia_chipset_handle_t pch;
    616       1.1       pk 	bus_size_t size;
    617       1.1       pk 	struct pcmcia_mem_handle *pcmhp;
    618       1.1       pk {
    619       1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    620       1.1       pk 	int i, win;
    621       1.1       pk 
    622       1.1       pk 	/*
    623       1.1       pk 	 * Allocate a window.
    624       1.1       pk 	 */
    625       1.1       pk 	if (size > STP4020_WINDOW_SIZE)
    626       1.1       pk 		return (1);
    627       1.1       pk 
    628       1.1       pk 	for (win = -1, i = 0; i < STP4020_NWIN; i++) {
    629       1.1       pk 		if ((h->winalloc & (1 << i)) == 0) {
    630       1.1       pk 			win = i;
    631       1.1       pk 			h->winalloc |= (1 << i);
    632       1.1       pk 			break;
    633       1.1       pk 		}
    634       1.1       pk 	}
    635       1.1       pk 
    636       1.1       pk 	if (win == -1)
    637       1.1       pk 		return (1);
    638       1.1       pk 
    639       1.1       pk 	pcmhp->memt = 0;
    640       1.1       pk 	pcmhp->memh = h->windows[win].winaddr;
    641       1.1       pk 	pcmhp->addr = 0;	/* What is it used for? */
    642       1.1       pk 	pcmhp->size = size;
    643       1.1       pk 	pcmhp->mhandle = win;	/* Use our window number as a handle */
    644       1.1       pk 	pcmhp->realsize = STP4020_WINDOW_SIZE;
    645       1.1       pk 
    646       1.1       pk 	return (0);
    647       1.1       pk }
    648       1.1       pk 
    649       1.1       pk void
    650       1.1       pk stp4020_chip_mem_free(pch, pcmhp)
    651       1.1       pk 	pcmcia_chipset_handle_t pch;
    652       1.1       pk 	struct pcmcia_mem_handle *pcmhp;
    653       1.1       pk {
    654       1.1       pk 
    655       1.1       pk 	return;
    656       1.1       pk }
    657       1.1       pk 
    658       1.1       pk int
    659       1.1       pk stp4020_chip_mem_map(pch, kind, card_addr, size, pcmhp, offsetp, windowp)
    660       1.1       pk 	pcmcia_chipset_handle_t pch;
    661       1.1       pk 	int kind;
    662       1.1       pk 	bus_addr_t card_addr;
    663       1.1       pk 	bus_size_t size;
    664       1.1       pk 	struct pcmcia_mem_handle *pcmhp;
    665       1.1       pk 	bus_addr_t *offsetp;
    666       1.1       pk 	int *windowp;
    667       1.1       pk {
    668       1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    669       1.1       pk 	bus_addr_t offset;
    670       1.1       pk 	int win, v;
    671       1.8     joda 
    672       1.8     joda 	int mem8 = (kind & PCMCIA_WIDTH_MEM_MASK) == PCMCIA_WIDTH_MEM8;
    673       1.8     joda 	kind &= ~PCMCIA_WIDTH_MEM_MASK;
    674       1.8     joda 
    675       1.8     joda 	if(mem8) {
    676       1.8     joda 	    /* XXX Fix 8-bit memory accesses (can this be done at all?) */
    677       1.8     joda #ifdef DIAGNOSTIC
    678       1.8     joda 	    printf("stp4020_chip_mem_map: can't handle 8-bit memory\n");
    679       1.8     joda #endif
    680       1.8     joda 	    return (-1);
    681       1.8     joda 	}
    682       1.1       pk 
    683       1.1       pk 	win = pcmhp->mhandle;
    684       1.1       pk 	*windowp = win;
    685       1.1       pk 
    686       1.1       pk 	/*
    687       1.1       pk 	 * Compute the address offset to the pcmcia address space
    688       1.1       pk 	 * for the window.
    689       1.1       pk 	 */
    690       1.1       pk 	offset = card_addr & -STP4020_WINDOW_SIZE;
    691       1.1       pk 	card_addr -= offset;
    692       1.1       pk 	*offsetp = offset;
    693       1.1       pk 
    694       1.1       pk 	/*
    695       1.1       pk 	 * Fill in the Address Space Select and Base Address
    696       1.1       pk 	 * fields of this windows control register 0.
    697       1.1       pk 	 */
    698       1.1       pk 	v = stp4020_rd_winctl(h, win, STP4020_WCR0_IDX);
    699       1.1       pk 	v &= (STP4020_WCR0_ASPSEL_M | STP4020_WCR0_BASE_M);
    700       1.1       pk 	v |= (kind == PCMCIA_MEM_ATTR)
    701       1.1       pk 		? STP4020_WCR0_ASPSEL_AM
    702       1.1       pk 		: STP4020_WCR0_ASPSEL_CM;
    703       1.1       pk 	v |= (STP4020_ADDR2PAGE(card_addr) & STP4020_WCR0_BASE_M);
    704       1.1       pk 	stp4020_wr_winctl(h, win, STP4020_WCR0_IDX, v);
    705       1.1       pk 
    706       1.1       pk 	return (0);
    707       1.1       pk }
    708       1.1       pk 
    709       1.1       pk void
    710       1.1       pk stp4020_chip_mem_unmap(pch, win)
    711       1.1       pk 	pcmcia_chipset_handle_t pch;
    712       1.1       pk 	int win;
    713       1.1       pk {
    714       1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    715       1.1       pk 
    716       1.1       pk #ifdef DIAGNOSTIC
    717       1.1       pk 	if (win < 0 || win > 2)
    718       1.1       pk 		panic("stp4020_chip_mem_unmap: window (%d) out of range", win);
    719       1.1       pk #endif
    720       1.1       pk 	h->winalloc &= ~(1 << win);
    721       1.1       pk 	/*
    722       1.1       pk 	 * If possible, invalidate hardware mapping here; but
    723       1.1       pk 	 * I don't think the stp4020 has provided for that.
    724       1.1       pk 	 */
    725       1.1       pk }
    726       1.1       pk 
    727       1.1       pk int
    728       1.1       pk stp4020_chip_io_alloc(pch, start, size, align, pcihp)
    729       1.1       pk 	pcmcia_chipset_handle_t pch;
    730       1.1       pk 	bus_addr_t start;
    731       1.1       pk 	bus_size_t size;
    732       1.1       pk 	bus_size_t align;
    733       1.1       pk 	struct pcmcia_io_handle *pcihp;
    734       1.1       pk {
    735       1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    736       1.1       pk 
    737       1.1       pk 	if (start) {
    738       1.1       pk 		/* How on earth can `start' be interpreted??
    739       1.1       pk 		   WHERE DOES THE CARD DRIVER GET IT FROM?
    740       1.1       pk 		 */
    741       1.1       pk 	}
    742       1.1       pk 
    743       1.1       pk 	pcihp->iot = h->tag;
    744       1.1       pk 	pcihp->ioh = 0;
    745       1.1       pk 	pcihp->addr = 0;
    746       1.1       pk 	pcihp->size = size;
    747       1.1       pk 	pcihp->flags = 0;
    748       1.1       pk 
    749       1.1       pk 	return (0);
    750       1.1       pk }
    751       1.1       pk 
    752       1.1       pk void
    753       1.1       pk stp4020_chip_io_free(pch, pcihp)
    754       1.1       pk 	pcmcia_chipset_handle_t pch;
    755       1.1       pk 	struct pcmcia_io_handle *pcihp;
    756       1.1       pk {
    757       1.1       pk 
    758       1.1       pk 	return;
    759       1.1       pk }
    760       1.1       pk 
    761       1.1       pk int
    762       1.1       pk stp4020_chip_io_map(pch, width, offset, size, pcihp, windowp)
    763       1.1       pk 	pcmcia_chipset_handle_t pch;
    764       1.1       pk 	int width;
    765       1.1       pk 	bus_addr_t offset;
    766       1.1       pk 	bus_size_t size;
    767       1.1       pk 	struct pcmcia_io_handle *pcihp;
    768       1.1       pk 	int *windowp;
    769       1.1       pk {
    770       1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    771       1.1       pk 	int i, win, v;
    772       1.1       pk 
    773       1.1       pk 	/*
    774       1.1       pk 	 * Allocate a window.
    775       1.1       pk 	 */
    776       1.1       pk 	if (size > STP4020_WINDOW_SIZE)
    777       1.1       pk 		return (1);
    778       1.1       pk 
    779       1.1       pk 	for (win = -1, i = 0; i < STP4020_NWIN; i++) {
    780       1.1       pk 		if ((h->winalloc & (1 << i)) == 0) {
    781       1.1       pk 			win = i;
    782       1.1       pk 			h->winalloc |= (1 << i);
    783       1.1       pk 			break;
    784       1.1       pk 		}
    785       1.1       pk 	}
    786       1.1       pk 
    787       1.1       pk 	if (win == -1)
    788       1.1       pk 		return (1);
    789       1.1       pk 
    790       1.1       pk 	*windowp = win;
    791       1.1       pk 
    792       1.1       pk 	/*
    793       1.1       pk 	 * Fill in the Address Space Select and Base Address
    794       1.1       pk 	 * fields of this windows control register 0.
    795       1.1       pk 	 */
    796       1.1       pk 	v = stp4020_rd_winctl(h, win, STP4020_WCR0_IDX);
    797       1.1       pk 	v &= (STP4020_WCR0_ASPSEL_M | STP4020_WCR0_BASE_M);
    798       1.1       pk 	v |= STP4020_WCR0_ASPSEL_IO;
    799       1.1       pk 	v |= (STP4020_ADDR2PAGE(pcihp->addr+offset) & STP4020_WCR0_BASE_M);
    800       1.1       pk 	stp4020_wr_winctl(h, win, STP4020_WCR0_IDX, v);
    801       1.1       pk 
    802       1.1       pk 	return (0);
    803       1.1       pk }
    804       1.1       pk 
    805       1.1       pk void
    806       1.1       pk stp4020_chip_io_unmap(pch, win)
    807       1.1       pk 	pcmcia_chipset_handle_t pch;
    808       1.1       pk 	int win;
    809       1.1       pk {
    810       1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    811       1.1       pk 
    812       1.1       pk #ifdef DIAGNOSTIC
    813       1.1       pk 	if (win < 0 || win > 2)
    814       1.1       pk 		panic("stp4020_chip_io_unmap: window (%d) out of range", win);
    815       1.1       pk #endif
    816       1.1       pk 
    817       1.1       pk 	h->winalloc &= ~(1 << win);
    818       1.1       pk }
    819       1.1       pk 
    820       1.1       pk void
    821       1.1       pk stp4020_chip_socket_enable(pch)
    822       1.1       pk 	pcmcia_chipset_handle_t pch;
    823       1.1       pk {
    824       1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    825       1.1       pk 	int i, v, cardtype;
    826       1.1       pk 
    827       1.1       pk 	/* this bit is mostly stolen from pcic_attach_card */
    828       1.1       pk 
    829       1.1       pk 	/* Power down the socket to reset it, clear the card reset pin */
    830       1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR1_IDX);
    831       1.1       pk 	v &= ~STP4020_ICR1_MSTPWR;
    832       1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    833       1.1       pk 
    834       1.1       pk 	/*
    835       1.1       pk 	 * wait 300ms until power fails (Tpf).  Then, wait 100ms since
    836       1.1       pk 	 * we are changing Vcc (Toff).
    837       1.1       pk 	 */
    838       1.1       pk 	stp4020_delay((300 + 100) * 1000);
    839       1.1       pk 
    840       1.1       pk 	/* Power up the socket */
    841       1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR1_IDX);
    842       1.1       pk 	v |= STP4020_ICR1_MSTPWR;
    843       1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    844       1.1       pk 
    845       1.1       pk 	/*
    846       1.1       pk 	 * wait 100ms until power raise (Tpr) and 20ms to become
    847       1.1       pk 	 * stable (Tsu(Vcc)).
    848       1.1       pk 	 */
    849       1.1       pk 	stp4020_delay((100 + 20) * 1000);
    850       1.1       pk 
    851       1.1       pk 	v |= STP4020_ICR1_PCIFOE;
    852       1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    853       1.1       pk 
    854       1.1       pk 	/*
    855       1.1       pk 	 * hold RESET at least 10us.
    856       1.1       pk 	 */
    857       1.1       pk 	delay(10);
    858       1.1       pk 
    859       1.1       pk 	/* Clear reset flag */
    860       1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    861       1.1       pk 	v &= ~STP4020_ICR0_RESET;
    862       1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    863       1.1       pk 
    864       1.1       pk 	/* wait 20ms as per pc card standard (r2.01) section 4.3.6 */
    865       1.1       pk 	stp4020_delay(20000);
    866       1.1       pk 
    867       1.1       pk 	/* Wait for the chip to finish initializing (5 seconds max) */
    868       1.1       pk 	for (i = 10000; i > 0; i--) {
    869       1.1       pk 		v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    870       1.1       pk 		if ((v & STP4020_ISR0_RDYST) != 0)
    871       1.1       pk 			break;
    872       1.1       pk 		delay(500);
    873       1.1       pk 	}
    874       1.1       pk 	if (i <= 0) {
    875       1.1       pk 		char bits[64];
    876       1.1       pk 		bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
    877       1.1       pk 				 STP4020_ISR0_IOBITS, bits, sizeof(bits));
    878       1.1       pk 		printf("stp4020_chip_socket_enable: not ready: status %s\n",
    879       1.1       pk 			bits);
    880       1.1       pk 		return;
    881       1.1       pk 	}
    882       1.1       pk 
    883       1.1       pk 	/* Set the card type */
    884       1.1       pk 	cardtype = pcmcia_card_gettype(h->pcmcia);
    885       1.1       pk 
    886       1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    887       1.1       pk 	v &= ~STP4020_ICR0_IFTYPE;
    888       1.1       pk 	v |= (cardtype == PCMCIA_IFTYPE_IO)
    889       1.1       pk 			? STP4020_ICR0_IFTYPE_IO
    890       1.1       pk 			: STP4020_ICR0_IFTYPE_MEM;
    891       1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    892       1.1       pk 
    893       1.1       pk 	DPRINTF(("%s: stp4020_chip_socket_enable %02x cardtype %s\n",
    894       1.1       pk 		h->sc->sc_dev.dv_xname, h->sock,
    895       1.1       pk 		((cardtype == PCMCIA_IFTYPE_IO) ? "io" : "mem")));
    896       1.1       pk 
    897       1.1       pk 	/*
    898       1.1       pk 	 * Enable socket I/O interrupts.
    899       1.1       pk 	 * We use level SB_INT[0] for I/O interrupts.
    900       1.1       pk 	 */
    901       1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    902       1.1       pk 	v &= ~STP4020_ICR0_IOILVL;
    903       1.1       pk 	v |= STP4020_ICR0_IOIE | STP4020_ICR0_IOILVL_SB0;
    904       1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    905       1.1       pk 
    906       1.1       pk #if 0
    907       1.1       pk 	/* Reinstall all the memory and io mappings */
    908       1.1       pk 	for (win = 0; win < STP4020_NWIN; win++)
    909       1.1       pk 		if (h->winalloc & (1 << win))
    910       1.1       pk 			___chip_mem_map(h, win);
    911       1.1       pk 
    912       1.1       pk #endif
    913       1.1       pk }
    914       1.1       pk 
    915       1.1       pk void
    916       1.1       pk stp4020_chip_socket_disable(pch)
    917       1.1       pk 	pcmcia_chipset_handle_t pch;
    918       1.1       pk {
    919       1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    920       1.1       pk 	int v;
    921       1.1       pk 
    922       1.1       pk 	DPRINTF(("stp4020_chip_socket_disable\n"));
    923       1.1       pk 
    924       1.1       pk 	/*
    925       1.1       pk 	 * Disable socket I/O interrupts.
    926       1.1       pk 	 */
    927       1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    928       1.1       pk 	v &= ~(STP4020_ICR0_IOIE | STP4020_ICR0_IOILVL);
    929       1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    930       1.1       pk 
    931       1.1       pk 	/* Power down the socket */
    932       1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR1_IDX);
    933       1.1       pk 	v &= ~STP4020_ICR1_MSTPWR;
    934       1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    935       1.1       pk 
    936       1.1       pk 	/*
    937       1.1       pk 	 * wait 300ms until power fails (Tpf).
    938       1.1       pk 	 */
    939       1.1       pk 	stp4020_delay(300 * 1000);
    940       1.1       pk }
    941       1.1       pk 
    942       1.1       pk void *
    943       1.1       pk stp4020_chip_intr_establish(pch, pf, ipl, handler, arg)
    944       1.1       pk 	pcmcia_chipset_handle_t pch;
    945       1.1       pk 	struct pcmcia_function *pf;
    946       1.1       pk 	int ipl;
    947       1.1       pk 	int (*handler) __P((void *));
    948       1.1       pk 	void *arg;
    949       1.1       pk {
    950       1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    951       1.1       pk 
    952       1.1       pk 	h->intrhandler = handler;
    953       1.1       pk 	h->intrarg = arg;
    954       1.1       pk 	h->ipl = ipl;
    955       1.1       pk 	return (NULL);
    956       1.1       pk }
    957       1.1       pk 
    958       1.1       pk void
    959       1.1       pk stp4020_chip_intr_disestablish(pch, ih)
    960       1.1       pk 	pcmcia_chipset_handle_t pch;
    961       1.1       pk 	void *ih;
    962       1.1       pk {
    963       1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    964       1.1       pk 
    965       1.1       pk 	h->intrhandler = NULL;
    966       1.1       pk 	h->intrarg = NULL;
    967       1.1       pk }
    968       1.1       pk 
    969       1.1       pk /*
    970       1.1       pk  * Delay and possibly yield CPU.
    971       1.1       pk  * XXX - assumes a context
    972       1.1       pk  */
    973       1.1       pk void
    974       1.1       pk stp4020_delay(ms)
    975       1.1       pk 	unsigned int ms;
    976       1.1       pk {
    977       1.1       pk 	unsigned int ticks;
    978       1.1       pk extern	int cold;
    979       1.1       pk 
    980       1.1       pk 	/* Convert to ticks */
    981       1.1       pk 	ticks = (ms * hz ) / 1000000;
    982       1.1       pk 
    983       1.1       pk 	if (cold || ticks == 0) {
    984       1.1       pk 		delay(ms);
    985       1.1       pk 		return;
    986       1.1       pk 	}
    987       1.1       pk 
    988       1.1       pk #ifdef DIAGNOSTIC
    989       1.1       pk 	if (ticks > 60*hz)
    990       1.1       pk 		panic("stp4020: preposterous delay: %u", ticks);
    991       1.1       pk #endif
    992       1.1       pk 	tsleep(&ticks, 0, "stp4020_delay", ticks);
    993       1.1       pk }
    994       1.6       pk 
    995       1.6       pk #ifdef STP4020_DEBUG
    996       1.6       pk void
    997       1.6       pk stp4020_dump_regs(h)
    998       1.6       pk 	struct stp4020_socket *h;
    999       1.6       pk {
   1000       1.6       pk 	char bits[64];
   1001       1.6       pk 	/*
   1002       1.6       pk 	 * Dump control and status registers.
   1003       1.6       pk 	 */
   1004       1.6       pk 	printf("socket[%d] registers:\n", h->sock);
   1005       1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR0_IDX),
   1006       1.6       pk 			 STP4020_ICR0_BITS, bits, sizeof(bits));
   1007       1.6       pk 	printf("\tICR0=%s\n", bits);
   1008       1.6       pk 
   1009       1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR1_IDX),
   1010       1.6       pk 			 STP4020_ICR1_BITS, bits, sizeof(bits));
   1011       1.6       pk 	printf("\tICR1=%s\n", bits);
   1012       1.6       pk 
   1013       1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
   1014       1.6       pk 			 STP4020_ISR0_IOBITS, bits, sizeof(bits));
   1015       1.6       pk 	printf("\tISR0=%s\n", bits);
   1016       1.6       pk 
   1017       1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR1_IDX),
   1018       1.6       pk 			 STP4020_ISR1_BITS, bits, sizeof(bits));
   1019       1.6       pk 	printf("\tISR1=%s\n", bits);
   1020       1.6       pk }
   1021       1.6       pk #endif /* STP4020_DEBUG */
   1022