Home | History | Annotate | Line # | Download | only in sbus
stp4020.c revision 1.5.2.1
      1  1.5.2.1   bouyer /*	$NetBSD: stp4020.c,v 1.5.2.1 2000/11/20 11:43:07 bouyer 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.5.2.1   bouyer #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.5.2.1   bouyer #ifdef STP4020_DEBUG
    133  1.5.2.1   bouyer static void	stp4020_dump_regs __P((struct stp4020_socket *));
    134  1.5.2.1   bouyer #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.5.2.1   bouyer 	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.5.2.1   bouyer #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.5.2.1   bouyer 
    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.1       pk 
    308  1.5.2.1   bouyer 		if (i == STP4020_BANK_PROM)
    309  1.5.2.1   bouyer 			/* Skip the PROM */
    310  1.5.2.1   bouyer 			continue;
    311      1.1       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.5.2.1   bouyer 				 &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.5.2.1   bouyer 
    323  1.5.2.1   bouyer 		if (i == STP4020_BANK_CTRL) {
    324  1.5.2.1   bouyer 			/*
    325  1.5.2.1   bouyer 			 * Copy tag and handle to both socket structures
    326  1.5.2.1   bouyer 			 * for easy access in control/status IO functions.
    327  1.5.2.1   bouyer 			 */
    328  1.5.2.1   bouyer 			sc->sc_socks[0].regs = sc->sc_socks[1].regs = bh;
    329  1.5.2.1   bouyer 		} else if (i < STP4020_BANK_CTRL) {
    330  1.5.2.1   bouyer 			/* banks 1-3 */
    331  1.5.2.1   bouyer 			sc->sc_socks[0].windows[i-1].winaddr = bh;
    332  1.5.2.1   bouyer 		} else {
    333  1.5.2.1   bouyer 			/* banks 5-7 */
    334  1.5.2.1   bouyer 			sc->sc_socks[1].windows[i-5].winaddr = bh;
    335  1.5.2.1   bouyer 		}
    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.5.2.1   bouyer 	if (sa->sa_nintr != 0) {
    346  1.5.2.1   bouyer 		bus_intr_establish(sa->sa_bustag, sa->sa_intr[1].sbi_pri,
    347  1.5.2.1   bouyer 				   IPL_NONE, 0, stp4020_statintr, sc);
    348      1.1       pk 
    349  1.5.2.1   bouyer 		bus_intr_establish(sa->sa_bustag, sa->sa_intr[0].sbi_pri,
    350  1.5.2.1   bouyer 				   IPL_NONE, 0, stp4020_iointr, sc);
    351      1.1       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.5.2.1   bouyer #ifdef STP4020_DEBUG
    371  1.5.2.1   bouyer 		stp4020_dump_regs(h);
    372  1.5.2.1   bouyer #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.5.2.1   bouyer 	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.1       pk 
    672  1.5.2.1   bouyer 	int mem8 = (kind & PCMCIA_WIDTH_MEM_MASK) == PCMCIA_WIDTH_MEM8;
    673  1.5.2.1   bouyer 	kind &= ~PCMCIA_WIDTH_MEM_MASK;
    674  1.5.2.1   bouyer 
    675  1.5.2.1   bouyer 	if(mem8) {
    676  1.5.2.1   bouyer 	    /* XXX Fix 8-bit memory accesses (can this be done at all?) */
    677  1.5.2.1   bouyer #ifdef DIAGNOSTIC
    678  1.5.2.1   bouyer 	    printf("stp4020_chip_mem_map: can't handle 8-bit memory\n");
    679  1.5.2.1   bouyer #endif
    680  1.5.2.1   bouyer 	    return (-1);
    681  1.5.2.1   bouyer 	}
    682  1.5.2.1   bouyer 
    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.5.2.1   bouyer 
    995  1.5.2.1   bouyer #ifdef STP4020_DEBUG
    996  1.5.2.1   bouyer void
    997  1.5.2.1   bouyer stp4020_dump_regs(h)
    998  1.5.2.1   bouyer 	struct stp4020_socket *h;
    999  1.5.2.1   bouyer {
   1000  1.5.2.1   bouyer 	char bits[64];
   1001  1.5.2.1   bouyer 	/*
   1002  1.5.2.1   bouyer 	 * Dump control and status registers.
   1003  1.5.2.1   bouyer 	 */
   1004  1.5.2.1   bouyer 	printf("socket[%d] registers:\n", h->sock);
   1005  1.5.2.1   bouyer 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR0_IDX),
   1006  1.5.2.1   bouyer 			 STP4020_ICR0_BITS, bits, sizeof(bits));
   1007  1.5.2.1   bouyer 	printf("\tICR0=%s\n", bits);
   1008  1.5.2.1   bouyer 
   1009  1.5.2.1   bouyer 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR1_IDX),
   1010  1.5.2.1   bouyer 			 STP4020_ICR1_BITS, bits, sizeof(bits));
   1011  1.5.2.1   bouyer 	printf("\tICR1=%s\n", bits);
   1012  1.5.2.1   bouyer 
   1013  1.5.2.1   bouyer 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
   1014  1.5.2.1   bouyer 			 STP4020_ISR0_IOBITS, bits, sizeof(bits));
   1015  1.5.2.1   bouyer 	printf("\tISR0=%s\n", bits);
   1016  1.5.2.1   bouyer 
   1017  1.5.2.1   bouyer 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR1_IDX),
   1018  1.5.2.1   bouyer 			 STP4020_ISR1_BITS, bits, sizeof(bits));
   1019  1.5.2.1   bouyer 	printf("\tISR1=%s\n", bits);
   1020  1.5.2.1   bouyer }
   1021  1.5.2.1   bouyer #endif /* STP4020_DEBUG */
   1022