Home | History | Annotate | Line # | Download | only in sbus
stp4020.c revision 1.8
      1  1.8     joda /*	$NetBSD: stp4020.c,v 1.8 2000/01/13 10:03:25 joda 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.1       pk #include <machine/autoconf.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.1       pk 	if (sa->sa_nreg < 7) {
    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.1       pk #define STP4020_BANK_CTRL	4
    297  1.1       pk 	for (i = 0; i < 8; i++) {
    298  1.1       pk 		int s, w;
    299  1.1       pk 		/*
    300  1.1       pk 		 * STP4020 Register address map:
    301  1.1       pk 		 *	bank  0:   Forth PROM
    302  1.1       pk 		 *	banks 1-3: socket 0, windows 0-2
    303  1.1       pk 		 *	bank  4:   control registers
    304  1.1       pk 		 *	banks 5-7: socket 1, windows 0-2
    305  1.1       pk 		 */
    306  1.1       pk 		if (i == STP4020_BANK_CTRL) {
    307  1.1       pk 			if (sbus_bus_map(sa->sa_bustag,
    308  1.1       pk 					 sa->sa_reg[i].sbr_slot,
    309  1.1       pk 					 sa->sa_reg[i].sbr_offset,
    310  1.1       pk 					 sa->sa_reg[i].sbr_size,
    311  1.1       pk 					 BUS_SPACE_MAP_LINEAR, 0,
    312  1.1       pk 					 &bh) != 0) {
    313  1.1       pk 				printf("%s: attach: cannot map registers\n",
    314  1.1       pk 					self->dv_xname);
    315  1.1       pk 				return;
    316  1.1       pk 			}
    317  1.1       pk 			/*
    318  1.1       pk 			 * Copy tag and handle to both socket structures
    319  1.1       pk 			 * for easy access in control/status IO functions.
    320  1.1       pk 			 */
    321  1.1       pk 			sc->sc_socks[0].regs = sc->sc_socks[1].regs = bh;
    322  1.1       pk 		}
    323  1.1       pk 
    324  1.1       pk 		if (i < STP4020_BANK_CTRL)
    325  1.1       pk 			s = 0, w = i;		/* banks 0-2 */
    326  1.1       pk 		else
    327  1.1       pk 			s = 1, w = i - 4;	/* banks 4-6 */
    328  1.1       pk 
    329  1.1       pk 		if (sbus_bus_map(sa->sa_bustag,
    330  1.1       pk 				 sa->sa_reg[i].sbr_slot,
    331  1.1       pk 				 sa->sa_reg[i].sbr_offset,
    332  1.1       pk 				 sa->sa_reg[i].sbr_size,
    333  1.1       pk 				 BUS_SPACE_MAP_LINEAR, 0,
    334  1.1       pk 				 &sc->sc_socks[s].windows[w].winaddr) != 0) {
    335  1.1       pk 			printf("%s: attach: cannot map registers\n",
    336  1.1       pk 				self->dv_xname);
    337  1.1       pk 			return;
    338  1.1       pk 		}
    339  1.1       pk 	}
    340  1.1       pk 
    341  1.1       pk 	sbus_establish(&sc->sc_sd, &sc->sc_dev);
    342  1.1       pk 
    343  1.1       pk #if 0 /*XXX-think about tracking boot devices*/
    344  1.1       pk 	/* Propagate bootpath */
    345  1.1       pk 	if (sa->sa_bp != NULL)
    346  1.1       pk 		bp = sa->sa_bp + 1;
    347  1.1       pk 	else
    348  1.1       pk 		bp = NULL;
    349  1.1       pk #endif
    350  1.1       pk 
    351  1.1       pk 	/*
    352  1.1       pk 	 * We get to use two SBus interrupt levels.
    353  1.1       pk 	 * The higher level we use for status change interrupts;
    354  1.1       pk 	 * the lower level for PC card I/O.
    355  1.1       pk 	 */
    356  1.7       pk 	if (sa->sa_nintr != 0) {
    357  1.7       pk 		bus_intr_establish(sa->sa_bustag, sa->sa_intr[1].sbi_pri,
    358  1.7       pk 				   0, stp4020_statintr, sc);
    359  1.1       pk 
    360  1.7       pk 		bus_intr_establish(sa->sa_bustag, sa->sa_intr[0].sbi_pri,
    361  1.7       pk 				   0, stp4020_iointr, sc);
    362  1.7       pk 	}
    363  1.1       pk 
    364  1.1       pk 	rev = stp4020_rd_sockctl(&sc->sc_socks[0], STP4020_ISR1_IDX) &
    365  1.1       pk 		STP4020_ISR1_REV_M;
    366  1.1       pk 	printf(": rev %x\n", rev);
    367  1.1       pk 
    368  1.1       pk 	sc->sc_pct = (pcmcia_chipset_tag_t)&stp4020_functions;
    369  1.1       pk 
    370  1.1       pk 	/*
    371  1.1       pk 	 * Arrange that a kernel thread be created to handle
    372  1.1       pk 	 * insert/removal events.
    373  1.1       pk 	 */
    374  1.1       pk 	SIMPLEQ_INIT(&sc->events);
    375  1.5  thorpej 	kthread_create(stp4020_create_event_thread, sc);
    376  1.1       pk 
    377  1.1       pk 	for (i = 0; i < STP4020_NSOCK; i++) {
    378  1.1       pk 		struct stp4020_socket *h = &sc->sc_socks[i];
    379  1.1       pk 		h->sock = i;
    380  1.1       pk 		h->sc = sc;
    381  1.6       pk #ifdef STP4020_DEBUG
    382  1.6       pk 		stp4020_dump_regs(h);
    383  1.6       pk #endif
    384  1.1       pk 		stp4020_attach_socket(h);
    385  1.1       pk 	}
    386  1.1       pk }
    387  1.1       pk 
    388  1.1       pk void
    389  1.1       pk stp4020_attach_socket(h)
    390  1.1       pk 	struct stp4020_socket *h;
    391  1.1       pk {
    392  1.1       pk 	struct pcmciabus_attach_args paa;
    393  1.1       pk 	int v;
    394  1.1       pk 
    395  1.1       pk 	/* Initialize the rest of the handle */
    396  1.1       pk 	h->winalloc = 0;
    397  1.1       pk 
    398  1.1       pk 	/* Configure one pcmcia device per socket */
    399  1.1       pk 	paa.pct = (pcmcia_chipset_tag_t)h->sc->sc_pct;
    400  1.1       pk 	paa.pch = (pcmcia_chipset_handle_t)h;
    401  1.1       pk 	paa.iobase = 0;
    402  1.1       pk 	paa.iosize = 0;
    403  1.1       pk 
    404  1.1       pk 	h->pcmcia = config_found(&h->sc->sc_dev, &paa, stp4020print);
    405  1.1       pk 
    406  1.1       pk 	if (h->pcmcia == NULL)
    407  1.1       pk 		return;
    408  1.1       pk 
    409  1.1       pk 	/*
    410  1.1       pk 	 * There's actually a pcmcia bus attached; initialize the slot.
    411  1.1       pk 	 */
    412  1.1       pk 
    413  1.1       pk 	/*
    414  1.1       pk 	 * Enable socket status change interrupts.
    415  1.1       pk 	 * We use SB_INT[1] for status change interrupts.
    416  1.1       pk 	 */
    417  1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    418  1.1       pk 	v |= STP4020_ICR0_ALL_STATUS_IE | STP4020_ICR0_SCILVL_SB1;
    419  1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    420  1.1       pk 
    421  1.1       pk 	/* Get live status bits from ISR0 */
    422  1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    423  1.1       pk 	if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0)
    424  1.1       pk 		return;
    425  1.1       pk 
    426  1.1       pk 	pcmcia_card_attach(h->pcmcia);
    427  1.1       pk 	h->flags |= STP4020_SOCKET_BUSY;
    428  1.1       pk }
    429  1.1       pk 
    430  1.1       pk 
    431  1.1       pk /*
    432  1.1       pk  * Deferred thread creation callback.
    433  1.1       pk  */
    434  1.1       pk void
    435  1.1       pk stp4020_create_event_thread(arg)
    436  1.1       pk 	void *arg;
    437  1.1       pk {
    438  1.1       pk 	struct stp4020_softc *sc = arg;
    439  1.1       pk 	const char *name = sc->sc_dev.dv_xname;
    440  1.1       pk 
    441  1.5  thorpej 	if (kthread_create1(stp4020_event_thread, sc, &sc->event_thread,
    442  1.1       pk 			   "%s", name)) {
    443  1.1       pk 		panic("%s: unable to create event thread", name);
    444  1.1       pk 	}
    445  1.1       pk }
    446  1.1       pk 
    447  1.1       pk /*
    448  1.1       pk  * The actual event handling thread.
    449  1.1       pk  */
    450  1.1       pk void
    451  1.1       pk stp4020_event_thread(arg)
    452  1.1       pk 	void *arg;
    453  1.1       pk {
    454  1.1       pk 	struct stp4020_softc *sc = arg;
    455  1.1       pk 	struct stp4020_event *e;
    456  1.1       pk 	int s;
    457  1.1       pk 
    458  1.1       pk 	while (1) {
    459  1.1       pk 		struct stp4020_socket *h;
    460  1.1       pk 		int n;
    461  1.1       pk 
    462  1.1       pk 		s = splhigh();
    463  1.1       pk 		if ((e = SIMPLEQ_FIRST(&sc->events)) == NULL) {
    464  1.1       pk 			splx(s);
    465  1.1       pk 			(void)tsleep(&sc->events, PWAIT, "pcicev", 0);
    466  1.1       pk 			continue;
    467  1.1       pk 		}
    468  1.1       pk 		SIMPLEQ_REMOVE_HEAD(&sc->events, e, se_q);
    469  1.1       pk 		splx(s);
    470  1.1       pk 
    471  1.1       pk 		n = e->se_sock;
    472  1.1       pk 		if (n < 0 || n >= STP4020_NSOCK)
    473  1.1       pk 			panic("stp4020_event_thread: wayward socket number %d",
    474  1.1       pk 			      n);
    475  1.1       pk 
    476  1.1       pk 		h = &sc->sc_socks[n];
    477  1.1       pk 		switch (e->se_type) {
    478  1.1       pk 		case STP4020_EVENT_INSERTION:
    479  1.1       pk 			pcmcia_card_attach(h->pcmcia);
    480  1.1       pk 			break;
    481  1.1       pk 		case STP4020_EVENT_REMOVAL:
    482  1.1       pk 			pcmcia_card_detach(h->pcmcia, DETACH_FORCE);
    483  1.1       pk 			break;
    484  1.1       pk 		default:
    485  1.1       pk 			panic("stp4020_event_thread: unknown event type %d",
    486  1.1       pk 			      e->se_type);
    487  1.1       pk 		}
    488  1.1       pk 		free(e, M_TEMP);
    489  1.1       pk 	}
    490  1.1       pk }
    491  1.1       pk 
    492  1.1       pk void
    493  1.1       pk stp4020_queue_event(sc, sock, event)
    494  1.1       pk 	struct stp4020_softc *sc;
    495  1.1       pk 	int sock, event;
    496  1.1       pk {
    497  1.1       pk 	struct stp4020_event *e;
    498  1.1       pk 	int s;
    499  1.1       pk 
    500  1.1       pk 	e = malloc(sizeof(*e), M_TEMP, M_NOWAIT);
    501  1.1       pk 	if (e == NULL)
    502  1.1       pk 		panic("stp4020_queue_event: can't allocate event");
    503  1.1       pk 
    504  1.1       pk 	e->se_type = event;
    505  1.1       pk 	e->se_sock = sock;
    506  1.1       pk 	s = splhigh();
    507  1.1       pk 	SIMPLEQ_INSERT_TAIL(&sc->events, e, se_q);
    508  1.1       pk 	splx(s);
    509  1.1       pk 	wakeup(&sc->events);
    510  1.1       pk }
    511  1.1       pk 
    512  1.1       pk int
    513  1.1       pk stp4020_statintr(arg)
    514  1.1       pk 	void *arg;
    515  1.1       pk {
    516  1.1       pk 	struct stp4020_softc *sc = arg;
    517  1.1       pk 	int i, r = 0;
    518  1.1       pk 
    519  1.1       pk 	/*
    520  1.1       pk 	 * Check each socket for pending requests.
    521  1.1       pk 	 */
    522  1.1       pk 	for (i = 0 ; i < STP4020_NSOCK; i++) {
    523  1.1       pk 		struct stp4020_socket *h;
    524  1.1       pk 		int v;
    525  1.1       pk 
    526  1.1       pk 		h = &sc->sc_socks[i];
    527  1.1       pk 
    528  1.1       pk 		/* Read socket's ISR0 for the interrupt status bits */
    529  1.1       pk 		v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    530  1.1       pk 
    531  1.1       pk #ifdef STP4020_DEBUG
    532  1.1       pk 		if (stp4020_debug != 0) {
    533  1.1       pk 			char bits[64];
    534  1.1       pk 			bitmask_snprintf(v, STP4020_ISR0_IOBITS,
    535  1.1       pk 					 bits, sizeof(bits));
    536  1.1       pk 			printf("stp4020_statintr: ISR0=%s\n", bits);
    537  1.1       pk 		}
    538  1.1       pk #endif
    539  1.1       pk 
    540  1.1       pk 		/* Ack all interrupts at once */
    541  1.1       pk 		stp4020_wr_sockctl(h, STP4020_ISR0_IDX,
    542  1.1       pk 				   STP4020_ISR0_ALL_STATUS_IRQ);
    543  1.1       pk 
    544  1.1       pk 		if ((v & STP4020_ISR0_CDCHG) != 0) {
    545  1.1       pk 			/*
    546  1.1       pk 			 * Card status change detect
    547  1.1       pk 			 */
    548  1.1       pk 			if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) != 0){
    549  1.1       pk 				if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
    550  1.1       pk 					stp4020_queue_event(sc, i,
    551  1.1       pk 						STP4020_EVENT_INSERTION);
    552  1.1       pk 					h->flags |= STP4020_SOCKET_BUSY;
    553  1.1       pk 				}
    554  1.1       pk 			}
    555  1.1       pk 			if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0){
    556  1.1       pk 				if ((h->flags & STP4020_SOCKET_BUSY) != 0) {
    557  1.1       pk 					stp4020_queue_event(sc, i,
    558  1.1       pk 						STP4020_EVENT_REMOVAL);
    559  1.1       pk 					h->flags &= ~STP4020_SOCKET_BUSY;
    560  1.1       pk 				}
    561  1.1       pk 			}
    562  1.1       pk 		}
    563  1.1       pk 
    564  1.1       pk 		/* XXX - a bunch of unhandled conditions */
    565  1.1       pk 		if ((v & STP4020_ISR0_BVD1CHG) != 0) {
    566  1.1       pk 			printf("stp4020[%d]: Battery change 1\n", h->sock);
    567  1.1       pk 		}
    568  1.1       pk 
    569  1.1       pk 		if ((v & STP4020_ISR0_BVD2CHG) != 0) {
    570  1.1       pk 			printf("stp4020[%d]: Battery change 2\n", h->sock);
    571  1.1       pk 		}
    572  1.1       pk 
    573  1.1       pk 		if ((v & STP4020_ISR0_RDYCHG) != 0) {
    574  1.1       pk 			printf("stp4020[%d]: Ready/Busy change\n", h->sock);
    575  1.1       pk 		}
    576  1.1       pk 
    577  1.1       pk 		if ((v & STP4020_ISR0_WPCHG) != 0) {
    578  1.1       pk 			printf("stp4020[%d]: Write protect change\n", h->sock);
    579  1.1       pk 		}
    580  1.1       pk 
    581  1.1       pk 		if ((v & STP4020_ISR0_PCTO) != 0) {
    582  1.1       pk 			printf("stp4020[%d]: Card access timeout\n", h->sock);
    583  1.1       pk 		}
    584  1.1       pk 	}
    585  1.1       pk 
    586  1.1       pk 	return (r);
    587  1.1       pk }
    588  1.1       pk 
    589  1.1       pk int
    590  1.1       pk stp4020_iointr(arg)
    591  1.1       pk 	void *arg;
    592  1.1       pk {
    593  1.1       pk 	struct stp4020_softc *sc = arg;
    594  1.1       pk 	int i, r = 0;
    595  1.1       pk 
    596  1.1       pk 	/*
    597  1.1       pk 	 * Check each socket for pending requests.
    598  1.1       pk 	 */
    599  1.1       pk 	for (i = 0 ; i < STP4020_NSOCK; i++) {
    600  1.1       pk 		struct stp4020_socket *h;
    601  1.1       pk 		int v;
    602  1.1       pk 
    603  1.1       pk 		h = &sc->sc_socks[i];
    604  1.1       pk 		v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    605  1.1       pk 
    606  1.1       pk 		if ((v & STP4020_ISR0_IOINT) != 0) {
    607  1.1       pk 			/* It's a card interrupt */
    608  1.1       pk 			if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
    609  1.1       pk 				printf("stp4020[%d]: spurious interrupt?\n",
    610  1.1       pk 					h->sock);
    611  1.1       pk 				continue;
    612  1.1       pk 			}
    613  1.1       pk 			/* Call card handler, if any */
    614  1.1       pk 			if (h->intrhandler != NULL)
    615  1.1       pk 				r |= (*h->intrhandler)(h->intrarg);
    616  1.1       pk 		}
    617  1.1       pk 
    618  1.1       pk 	}
    619  1.1       pk 
    620  1.1       pk 	return (r);
    621  1.1       pk }
    622  1.1       pk 
    623  1.1       pk int
    624  1.1       pk stp4020_chip_mem_alloc(pch, size, pcmhp)
    625  1.1       pk 	pcmcia_chipset_handle_t pch;
    626  1.1       pk 	bus_size_t size;
    627  1.1       pk 	struct pcmcia_mem_handle *pcmhp;
    628  1.1       pk {
    629  1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    630  1.1       pk 	int i, win;
    631  1.1       pk 
    632  1.1       pk 	/*
    633  1.1       pk 	 * Allocate a window.
    634  1.1       pk 	 */
    635  1.1       pk 	if (size > STP4020_WINDOW_SIZE)
    636  1.1       pk 		return (1);
    637  1.1       pk 
    638  1.1       pk 	for (win = -1, i = 0; i < STP4020_NWIN; i++) {
    639  1.1       pk 		if ((h->winalloc & (1 << i)) == 0) {
    640  1.1       pk 			win = i;
    641  1.1       pk 			h->winalloc |= (1 << i);
    642  1.1       pk 			break;
    643  1.1       pk 		}
    644  1.1       pk 	}
    645  1.1       pk 
    646  1.1       pk 	if (win == -1)
    647  1.1       pk 		return (1);
    648  1.1       pk 
    649  1.1       pk 	pcmhp->memt = 0;
    650  1.1       pk 	pcmhp->memh = h->windows[win].winaddr;
    651  1.1       pk 	pcmhp->addr = 0;	/* What is it used for? */
    652  1.1       pk 	pcmhp->size = size;
    653  1.1       pk 	pcmhp->mhandle = win;	/* Use our window number as a handle */
    654  1.1       pk 	pcmhp->realsize = STP4020_WINDOW_SIZE;
    655  1.1       pk 
    656  1.1       pk 	return (0);
    657  1.1       pk }
    658  1.1       pk 
    659  1.1       pk void
    660  1.1       pk stp4020_chip_mem_free(pch, pcmhp)
    661  1.1       pk 	pcmcia_chipset_handle_t pch;
    662  1.1       pk 	struct pcmcia_mem_handle *pcmhp;
    663  1.1       pk {
    664  1.1       pk 
    665  1.1       pk 	return;
    666  1.1       pk }
    667  1.1       pk 
    668  1.1       pk int
    669  1.1       pk stp4020_chip_mem_map(pch, kind, card_addr, size, pcmhp, offsetp, windowp)
    670  1.1       pk 	pcmcia_chipset_handle_t pch;
    671  1.1       pk 	int kind;
    672  1.1       pk 	bus_addr_t card_addr;
    673  1.1       pk 	bus_size_t size;
    674  1.1       pk 	struct pcmcia_mem_handle *pcmhp;
    675  1.1       pk 	bus_addr_t *offsetp;
    676  1.1       pk 	int *windowp;
    677  1.1       pk {
    678  1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    679  1.1       pk 	bus_addr_t offset;
    680  1.1       pk 	int win, v;
    681  1.8     joda 
    682  1.8     joda 	int mem8 = (kind & PCMCIA_WIDTH_MEM_MASK) == PCMCIA_WIDTH_MEM8;
    683  1.8     joda 	kind &= ~PCMCIA_WIDTH_MEM_MASK;
    684  1.8     joda 
    685  1.8     joda 	if(mem8) {
    686  1.8     joda 	    /* XXX Fix 8-bit memory accesses (can this be done at all?) */
    687  1.8     joda #ifdef DIAGNOSTIC
    688  1.8     joda 	    printf("stp4020_chip_mem_map: can't handle 8-bit memory\n");
    689  1.8     joda #endif
    690  1.8     joda 	    return (-1);
    691  1.8     joda 	}
    692  1.1       pk 
    693  1.1       pk 	win = pcmhp->mhandle;
    694  1.1       pk 	*windowp = win;
    695  1.1       pk 
    696  1.1       pk 	/*
    697  1.1       pk 	 * Compute the address offset to the pcmcia address space
    698  1.1       pk 	 * for the window.
    699  1.1       pk 	 */
    700  1.1       pk 	offset = card_addr & -STP4020_WINDOW_SIZE;
    701  1.1       pk 	card_addr -= offset;
    702  1.1       pk 	*offsetp = offset;
    703  1.1       pk 
    704  1.1       pk 	/*
    705  1.1       pk 	 * Fill in the Address Space Select and Base Address
    706  1.1       pk 	 * fields of this windows control register 0.
    707  1.1       pk 	 */
    708  1.1       pk 	v = stp4020_rd_winctl(h, win, STP4020_WCR0_IDX);
    709  1.1       pk 	v &= (STP4020_WCR0_ASPSEL_M | STP4020_WCR0_BASE_M);
    710  1.1       pk 	v |= (kind == PCMCIA_MEM_ATTR)
    711  1.1       pk 		? STP4020_WCR0_ASPSEL_AM
    712  1.1       pk 		: STP4020_WCR0_ASPSEL_CM;
    713  1.1       pk 	v |= (STP4020_ADDR2PAGE(card_addr) & STP4020_WCR0_BASE_M);
    714  1.1       pk 	stp4020_wr_winctl(h, win, STP4020_WCR0_IDX, v);
    715  1.1       pk 
    716  1.1       pk 	return (0);
    717  1.1       pk }
    718  1.1       pk 
    719  1.1       pk void
    720  1.1       pk stp4020_chip_mem_unmap(pch, win)
    721  1.1       pk 	pcmcia_chipset_handle_t pch;
    722  1.1       pk 	int win;
    723  1.1       pk {
    724  1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    725  1.1       pk 
    726  1.1       pk #ifdef DIAGNOSTIC
    727  1.1       pk 	if (win < 0 || win > 2)
    728  1.1       pk 		panic("stp4020_chip_mem_unmap: window (%d) out of range", win);
    729  1.1       pk #endif
    730  1.1       pk 	h->winalloc &= ~(1 << win);
    731  1.1       pk 	/*
    732  1.1       pk 	 * If possible, invalidate hardware mapping here; but
    733  1.1       pk 	 * I don't think the stp4020 has provided for that.
    734  1.1       pk 	 */
    735  1.1       pk }
    736  1.1       pk 
    737  1.1       pk int
    738  1.1       pk stp4020_chip_io_alloc(pch, start, size, align, pcihp)
    739  1.1       pk 	pcmcia_chipset_handle_t pch;
    740  1.1       pk 	bus_addr_t start;
    741  1.1       pk 	bus_size_t size;
    742  1.1       pk 	bus_size_t align;
    743  1.1       pk 	struct pcmcia_io_handle *pcihp;
    744  1.1       pk {
    745  1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    746  1.1       pk 
    747  1.1       pk 	if (start) {
    748  1.1       pk 		/* How on earth can `start' be interpreted??
    749  1.1       pk 		   WHERE DOES THE CARD DRIVER GET IT FROM?
    750  1.1       pk 		 */
    751  1.1       pk 	}
    752  1.1       pk 
    753  1.1       pk 	pcihp->iot = h->tag;
    754  1.1       pk 	pcihp->ioh = 0;
    755  1.1       pk 	pcihp->addr = 0;
    756  1.1       pk 	pcihp->size = size;
    757  1.1       pk 	pcihp->flags = 0;
    758  1.1       pk 
    759  1.1       pk 	return (0);
    760  1.1       pk }
    761  1.1       pk 
    762  1.1       pk void
    763  1.1       pk stp4020_chip_io_free(pch, pcihp)
    764  1.1       pk 	pcmcia_chipset_handle_t pch;
    765  1.1       pk 	struct pcmcia_io_handle *pcihp;
    766  1.1       pk {
    767  1.1       pk 
    768  1.1       pk 	return;
    769  1.1       pk }
    770  1.1       pk 
    771  1.1       pk int
    772  1.1       pk stp4020_chip_io_map(pch, width, offset, size, pcihp, windowp)
    773  1.1       pk 	pcmcia_chipset_handle_t pch;
    774  1.1       pk 	int width;
    775  1.1       pk 	bus_addr_t offset;
    776  1.1       pk 	bus_size_t size;
    777  1.1       pk 	struct pcmcia_io_handle *pcihp;
    778  1.1       pk 	int *windowp;
    779  1.1       pk {
    780  1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    781  1.1       pk 	int i, win, v;
    782  1.1       pk 
    783  1.1       pk 	/*
    784  1.1       pk 	 * Allocate a window.
    785  1.1       pk 	 */
    786  1.1       pk 	if (size > STP4020_WINDOW_SIZE)
    787  1.1       pk 		return (1);
    788  1.1       pk 
    789  1.1       pk 	for (win = -1, i = 0; i < STP4020_NWIN; i++) {
    790  1.1       pk 		if ((h->winalloc & (1 << i)) == 0) {
    791  1.1       pk 			win = i;
    792  1.1       pk 			h->winalloc |= (1 << i);
    793  1.1       pk 			break;
    794  1.1       pk 		}
    795  1.1       pk 	}
    796  1.1       pk 
    797  1.1       pk 	if (win == -1)
    798  1.1       pk 		return (1);
    799  1.1       pk 
    800  1.1       pk 	*windowp = win;
    801  1.1       pk 
    802  1.1       pk 	/*
    803  1.1       pk 	 * Fill in the Address Space Select and Base Address
    804  1.1       pk 	 * fields of this windows control register 0.
    805  1.1       pk 	 */
    806  1.1       pk 	v = stp4020_rd_winctl(h, win, STP4020_WCR0_IDX);
    807  1.1       pk 	v &= (STP4020_WCR0_ASPSEL_M | STP4020_WCR0_BASE_M);
    808  1.1       pk 	v |= STP4020_WCR0_ASPSEL_IO;
    809  1.1       pk 	v |= (STP4020_ADDR2PAGE(pcihp->addr+offset) & STP4020_WCR0_BASE_M);
    810  1.1       pk 	stp4020_wr_winctl(h, win, STP4020_WCR0_IDX, v);
    811  1.1       pk 
    812  1.1       pk 	return (0);
    813  1.1       pk }
    814  1.1       pk 
    815  1.1       pk void
    816  1.1       pk stp4020_chip_io_unmap(pch, win)
    817  1.1       pk 	pcmcia_chipset_handle_t pch;
    818  1.1       pk 	int win;
    819  1.1       pk {
    820  1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    821  1.1       pk 
    822  1.1       pk #ifdef DIAGNOSTIC
    823  1.1       pk 	if (win < 0 || win > 2)
    824  1.1       pk 		panic("stp4020_chip_io_unmap: window (%d) out of range", win);
    825  1.1       pk #endif
    826  1.1       pk 
    827  1.1       pk 	h->winalloc &= ~(1 << win);
    828  1.1       pk }
    829  1.1       pk 
    830  1.1       pk void
    831  1.1       pk stp4020_chip_socket_enable(pch)
    832  1.1       pk 	pcmcia_chipset_handle_t pch;
    833  1.1       pk {
    834  1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    835  1.1       pk 	int i, v, cardtype;
    836  1.1       pk 
    837  1.1       pk 	/* this bit is mostly stolen from pcic_attach_card */
    838  1.1       pk 
    839  1.1       pk 	/* Power down the socket to reset it, clear the card reset pin */
    840  1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR1_IDX);
    841  1.1       pk 	v &= ~STP4020_ICR1_MSTPWR;
    842  1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    843  1.1       pk 
    844  1.1       pk 	/*
    845  1.1       pk 	 * wait 300ms until power fails (Tpf).  Then, wait 100ms since
    846  1.1       pk 	 * we are changing Vcc (Toff).
    847  1.1       pk 	 */
    848  1.1       pk 	stp4020_delay((300 + 100) * 1000);
    849  1.1       pk 
    850  1.1       pk 	/* Power up the socket */
    851  1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR1_IDX);
    852  1.1       pk 	v |= STP4020_ICR1_MSTPWR;
    853  1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    854  1.1       pk 
    855  1.1       pk 	/*
    856  1.1       pk 	 * wait 100ms until power raise (Tpr) and 20ms to become
    857  1.1       pk 	 * stable (Tsu(Vcc)).
    858  1.1       pk 	 */
    859  1.1       pk 	stp4020_delay((100 + 20) * 1000);
    860  1.1       pk 
    861  1.1       pk 	v |= STP4020_ICR1_PCIFOE;
    862  1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    863  1.1       pk 
    864  1.1       pk 	/*
    865  1.1       pk 	 * hold RESET at least 10us.
    866  1.1       pk 	 */
    867  1.1       pk 	delay(10);
    868  1.1       pk 
    869  1.1       pk 	/* Clear reset flag */
    870  1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    871  1.1       pk 	v &= ~STP4020_ICR0_RESET;
    872  1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    873  1.1       pk 
    874  1.1       pk 	/* wait 20ms as per pc card standard (r2.01) section 4.3.6 */
    875  1.1       pk 	stp4020_delay(20000);
    876  1.1       pk 
    877  1.1       pk 	/* Wait for the chip to finish initializing (5 seconds max) */
    878  1.1       pk 	for (i = 10000; i > 0; i--) {
    879  1.1       pk 		v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    880  1.1       pk 		if ((v & STP4020_ISR0_RDYST) != 0)
    881  1.1       pk 			break;
    882  1.1       pk 		delay(500);
    883  1.1       pk 	}
    884  1.1       pk 	if (i <= 0) {
    885  1.1       pk 		char bits[64];
    886  1.1       pk 		bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
    887  1.1       pk 				 STP4020_ISR0_IOBITS, bits, sizeof(bits));
    888  1.1       pk 		printf("stp4020_chip_socket_enable: not ready: status %s\n",
    889  1.1       pk 			bits);
    890  1.1       pk 		return;
    891  1.1       pk 	}
    892  1.1       pk 
    893  1.1       pk 	/* Set the card type */
    894  1.1       pk 	cardtype = pcmcia_card_gettype(h->pcmcia);
    895  1.1       pk 
    896  1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    897  1.1       pk 	v &= ~STP4020_ICR0_IFTYPE;
    898  1.1       pk 	v |= (cardtype == PCMCIA_IFTYPE_IO)
    899  1.1       pk 			? STP4020_ICR0_IFTYPE_IO
    900  1.1       pk 			: STP4020_ICR0_IFTYPE_MEM;
    901  1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    902  1.1       pk 
    903  1.1       pk 	DPRINTF(("%s: stp4020_chip_socket_enable %02x cardtype %s\n",
    904  1.1       pk 		h->sc->sc_dev.dv_xname, h->sock,
    905  1.1       pk 		((cardtype == PCMCIA_IFTYPE_IO) ? "io" : "mem")));
    906  1.1       pk 
    907  1.1       pk 	/*
    908  1.1       pk 	 * Enable socket I/O interrupts.
    909  1.1       pk 	 * We use level SB_INT[0] for I/O interrupts.
    910  1.1       pk 	 */
    911  1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    912  1.1       pk 	v &= ~STP4020_ICR0_IOILVL;
    913  1.1       pk 	v |= STP4020_ICR0_IOIE | STP4020_ICR0_IOILVL_SB0;
    914  1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    915  1.1       pk 
    916  1.1       pk #if 0
    917  1.1       pk 	/* Reinstall all the memory and io mappings */
    918  1.1       pk 	for (win = 0; win < STP4020_NWIN; win++)
    919  1.1       pk 		if (h->winalloc & (1 << win))
    920  1.1       pk 			___chip_mem_map(h, win);
    921  1.1       pk 
    922  1.1       pk #endif
    923  1.1       pk }
    924  1.1       pk 
    925  1.1       pk void
    926  1.1       pk stp4020_chip_socket_disable(pch)
    927  1.1       pk 	pcmcia_chipset_handle_t pch;
    928  1.1       pk {
    929  1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    930  1.1       pk 	int v;
    931  1.1       pk 
    932  1.1       pk 	DPRINTF(("stp4020_chip_socket_disable\n"));
    933  1.1       pk 
    934  1.1       pk 	/*
    935  1.1       pk 	 * Disable socket I/O interrupts.
    936  1.1       pk 	 */
    937  1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    938  1.1       pk 	v &= ~(STP4020_ICR0_IOIE | STP4020_ICR0_IOILVL);
    939  1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    940  1.1       pk 
    941  1.1       pk 	/* Power down the socket */
    942  1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR1_IDX);
    943  1.1       pk 	v &= ~STP4020_ICR1_MSTPWR;
    944  1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    945  1.1       pk 
    946  1.1       pk 	/*
    947  1.1       pk 	 * wait 300ms until power fails (Tpf).
    948  1.1       pk 	 */
    949  1.1       pk 	stp4020_delay(300 * 1000);
    950  1.1       pk }
    951  1.1       pk 
    952  1.1       pk void *
    953  1.1       pk stp4020_chip_intr_establish(pch, pf, ipl, handler, arg)
    954  1.1       pk 	pcmcia_chipset_handle_t pch;
    955  1.1       pk 	struct pcmcia_function *pf;
    956  1.1       pk 	int ipl;
    957  1.1       pk 	int (*handler) __P((void *));
    958  1.1       pk 	void *arg;
    959  1.1       pk {
    960  1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    961  1.1       pk 
    962  1.1       pk 	h->intrhandler = handler;
    963  1.1       pk 	h->intrarg = arg;
    964  1.1       pk 	h->ipl = ipl;
    965  1.1       pk 	return (NULL);
    966  1.1       pk }
    967  1.1       pk 
    968  1.1       pk void
    969  1.1       pk stp4020_chip_intr_disestablish(pch, ih)
    970  1.1       pk 	pcmcia_chipset_handle_t pch;
    971  1.1       pk 	void *ih;
    972  1.1       pk {
    973  1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    974  1.1       pk 
    975  1.1       pk 	h->intrhandler = NULL;
    976  1.1       pk 	h->intrarg = NULL;
    977  1.1       pk }
    978  1.1       pk 
    979  1.1       pk /*
    980  1.1       pk  * Delay and possibly yield CPU.
    981  1.1       pk  * XXX - assumes a context
    982  1.1       pk  */
    983  1.1       pk void
    984  1.1       pk stp4020_delay(ms)
    985  1.1       pk 	unsigned int ms;
    986  1.1       pk {
    987  1.1       pk 	unsigned int ticks;
    988  1.1       pk extern	int cold;
    989  1.1       pk 
    990  1.1       pk 	/* Convert to ticks */
    991  1.1       pk 	ticks = (ms * hz ) / 1000000;
    992  1.1       pk 
    993  1.1       pk 	if (cold || ticks == 0) {
    994  1.1       pk 		delay(ms);
    995  1.1       pk 		return;
    996  1.1       pk 	}
    997  1.1       pk 
    998  1.1       pk #ifdef DIAGNOSTIC
    999  1.1       pk 	if (ticks > 60*hz)
   1000  1.1       pk 		panic("stp4020: preposterous delay: %u", ticks);
   1001  1.1       pk #endif
   1002  1.1       pk 	tsleep(&ticks, 0, "stp4020_delay", ticks);
   1003  1.1       pk }
   1004  1.6       pk 
   1005  1.6       pk #ifdef STP4020_DEBUG
   1006  1.6       pk void
   1007  1.6       pk stp4020_dump_regs(h)
   1008  1.6       pk 	struct stp4020_socket *h;
   1009  1.6       pk {
   1010  1.6       pk 	char bits[64];
   1011  1.6       pk 	/*
   1012  1.6       pk 	 * Dump control and status registers.
   1013  1.6       pk 	 */
   1014  1.6       pk 	printf("socket[%d] registers:\n", h->sock);
   1015  1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR0_IDX),
   1016  1.6       pk 			 STP4020_ICR0_BITS, bits, sizeof(bits));
   1017  1.6       pk 	printf("\tICR0=%s\n", bits);
   1018  1.6       pk 
   1019  1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR1_IDX),
   1020  1.6       pk 			 STP4020_ICR1_BITS, bits, sizeof(bits));
   1021  1.6       pk 	printf("\tICR1=%s\n", bits);
   1022  1.6       pk 
   1023  1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
   1024  1.6       pk 			 STP4020_ISR0_IOBITS, bits, sizeof(bits));
   1025  1.6       pk 	printf("\tISR0=%s\n", bits);
   1026  1.6       pk 
   1027  1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR1_IDX),
   1028  1.6       pk 			 STP4020_ISR1_BITS, bits, sizeof(bits));
   1029  1.6       pk 	printf("\tISR1=%s\n", bits);
   1030  1.6       pk }
   1031  1.6       pk #endif /* STP4020_DEBUG */
   1032