Home | History | Annotate | Line # | Download | only in sbus
stp4020.c revision 1.29
      1  1.29       pk /*	$NetBSD: stp4020.c,v 1.29 2002/12/10 13:44:48 pk 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.12    lukem 
     43  1.12    lukem #include <sys/cdefs.h>
     44  1.29       pk __KERNEL_RCSID(0, "$NetBSD: stp4020.c,v 1.29 2002/12/10 13:44:48 pk Exp $");
     45   1.1       pk 
     46   1.1       pk #include <sys/param.h>
     47   1.1       pk #include <sys/systm.h>
     48   1.1       pk #include <sys/errno.h>
     49   1.1       pk #include <sys/malloc.h>
     50  1.15   martin #include <sys/extent.h>
     51   1.1       pk #include <sys/proc.h>
     52   1.1       pk #include <sys/kernel.h>
     53   1.1       pk #include <sys/kthread.h>
     54   1.1       pk #include <sys/device.h>
     55   1.1       pk 
     56   1.1       pk #include <dev/pcmcia/pcmciareg.h>
     57   1.1       pk #include <dev/pcmcia/pcmciavar.h>
     58   1.1       pk #include <dev/pcmcia/pcmciachip.h>
     59   1.1       pk 
     60   1.1       pk #include <machine/bus.h>
     61  1.11       pk #include <machine/intr.h>
     62   1.1       pk 
     63   1.1       pk #include <dev/sbus/sbusvar.h>
     64   1.1       pk #include <dev/sbus/stp4020reg.h>
     65   1.1       pk 
     66   1.1       pk #define STP4020_DEBUG 1	/* XXX-temp */
     67   1.1       pk 
     68  1.15   martin /*
     69  1.15   martin  * We use the three available windows per socket in a simple, fixed
     70  1.15   martin  * arrangement. Each window maps (at full 1 MB size) one of the pcmcia
     71  1.15   martin  * spaces into sbus space.
     72  1.15   martin  */
     73  1.15   martin #define STP_WIN_ATTR	0	/* index of the attribute memory space window */
     74  1.15   martin #define	STP_WIN_MEM	1	/* index of the common memory space window */
     75  1.15   martin #define	STP_WIN_IO	2	/* index of the io space window */
     76  1.15   martin 
     77  1.15   martin 
     78   1.1       pk #if defined(STP4020_DEBUG)
     79   1.1       pk int stp4020_debug = 0;
     80   1.1       pk #define DPRINTF(x)	do { if (stp4020_debug) printf x; } while(0)
     81   1.1       pk #else
     82   1.1       pk #define DPRINTF(x)
     83   1.1       pk #endif
     84   1.1       pk 
     85   1.1       pk /*
     86   1.1       pk  * Event queue; events detected in an interrupt context go here
     87   1.1       pk  * awaiting attention from our event handling thread.
     88   1.1       pk  */
     89   1.1       pk struct stp4020_event {
     90   1.1       pk 	SIMPLEQ_ENTRY(stp4020_event) se_q;
     91   1.1       pk 	int	se_type;
     92   1.1       pk 	int	se_sock;
     93   1.1       pk };
     94   1.1       pk /* Defined event types */
     95   1.1       pk #define STP4020_EVENT_INSERTION	0
     96   1.1       pk #define STP4020_EVENT_REMOVAL	1
     97   1.1       pk 
     98   1.1       pk /*
     99   1.1       pk  * Per socket data.
    100   1.1       pk  */
    101   1.1       pk struct stp4020_socket {
    102   1.1       pk 	struct stp4020_softc	*sc;	/* Back link */
    103   1.1       pk 	int		flags;
    104   1.1       pk #define STP4020_SOCKET_BUSY	0x0001
    105   1.1       pk #define STP4020_SOCKET_SHUTDOWN	0x0002
    106   1.1       pk 	int		sock;		/* Socket number (0 or 1) */
    107  1.28   martin 	int		sbus_intno;	/* Do we use first (0) or second (1)
    108  1.28   martin 					   interrupt? */
    109   1.1       pk 	bus_space_tag_t	tag;		/* socket control space */
    110   1.1       pk 	bus_space_handle_t	regs;	/* 			*/
    111   1.1       pk 	struct device	*pcmcia;	/* Associated PCMCIA device */
    112   1.1       pk 	int		(*intrhandler)	/* Card driver interrupt handler */
    113   1.1       pk 			    __P((void *));
    114   1.1       pk 	void		*intrarg;	/* Card interrupt handler argument */
    115   1.1       pk 	int		ipl;		/* Interrupt level suggested by card */
    116   1.1       pk 	struct {
    117   1.1       pk 		bus_space_handle_t	winaddr;/* this window's address */
    118   1.1       pk 	} windows[STP4020_NWIN];
    119   1.1       pk 
    120   1.1       pk };
    121   1.1       pk 
    122   1.1       pk struct stp4020_softc {
    123   1.1       pk 	struct device	sc_dev;		/* Base device */
    124   1.1       pk 	struct sbusdev	sc_sd;		/* SBus device */
    125   1.1       pk 	bus_space_tag_t	sc_bustag;
    126   1.1       pk 	bus_dma_tag_t	sc_dmatag;
    127   1.1       pk 	pcmcia_chipset_tag_t	sc_pct;	/* Chipset methods */
    128   1.1       pk 
    129   1.1       pk 	struct proc	*event_thread;		/* event handling thread */
    130   1.1       pk 	SIMPLEQ_HEAD(, stp4020_event)	events;	/* Pending events for thread */
    131   1.1       pk 
    132   1.1       pk 	struct stp4020_socket sc_socks[STP4020_NSOCK];
    133   1.1       pk };
    134   1.1       pk 
    135   1.1       pk 
    136   1.1       pk static int	stp4020print	__P((void *, const char *));
    137   1.1       pk static int	stp4020match	__P((struct device *, struct cfdata *, void *));
    138   1.1       pk static void	stp4020attach	__P((struct device *, struct device *, void *));
    139  1.28   martin static int	stp4020_intr	__P((void *));
    140  1.16   martin static void	stp4020_map_window(struct stp4020_socket *h, int win, int speed);
    141  1.16   martin static void	stp4020_calc_speed(int bus_speed, int ns, int *length, int *delay);
    142   1.1       pk 
    143  1.26  thorpej CFATTACH_DECL(nell, sizeof(struct stp4020_softc),
    144  1.27  thorpej     stp4020match, stp4020attach, NULL, NULL);
    145   1.1       pk 
    146   1.6       pk #ifdef STP4020_DEBUG
    147   1.6       pk static void	stp4020_dump_regs __P((struct stp4020_socket *));
    148   1.6       pk #endif
    149   1.1       pk 
    150   1.1       pk static int	stp4020_rd_sockctl __P((struct stp4020_socket *, int));
    151   1.1       pk static void	stp4020_wr_sockctl __P((struct stp4020_socket *, int, int));
    152   1.1       pk static int	stp4020_rd_winctl __P((struct stp4020_socket *, int, int));
    153   1.1       pk static void	stp4020_wr_winctl __P((struct stp4020_socket *, int, int, int));
    154   1.1       pk 
    155   1.1       pk void	stp4020_delay __P((unsigned int));
    156  1.16   martin void	stp4020_attach_socket __P((struct stp4020_socket *, int));
    157   1.1       pk void	stp4020_create_event_thread __P((void *));
    158   1.1       pk void	stp4020_event_thread __P((void *));
    159   1.1       pk void	stp4020_queue_event __P((struct stp4020_softc *, int, int));
    160   1.1       pk 
    161   1.1       pk int	stp4020_chip_mem_alloc __P((pcmcia_chipset_handle_t, bus_size_t,
    162   1.1       pk 				    struct pcmcia_mem_handle *));
    163   1.1       pk void	stp4020_chip_mem_free __P((pcmcia_chipset_handle_t,
    164   1.1       pk 				   struct pcmcia_mem_handle *));
    165   1.1       pk int	stp4020_chip_mem_map __P((pcmcia_chipset_handle_t, int, bus_addr_t,
    166   1.1       pk 				  bus_size_t, struct pcmcia_mem_handle *,
    167  1.14    soren 				  bus_size_t *, int *));
    168   1.1       pk void	stp4020_chip_mem_unmap __P((pcmcia_chipset_handle_t, int));
    169   1.1       pk 
    170   1.1       pk int	stp4020_chip_io_alloc __P((pcmcia_chipset_handle_t,
    171   1.1       pk 				   bus_addr_t, bus_size_t, bus_size_t,
    172   1.1       pk 				   struct pcmcia_io_handle *));
    173   1.1       pk void	stp4020_chip_io_free __P((pcmcia_chipset_handle_t,
    174   1.1       pk 				  struct pcmcia_io_handle *));
    175   1.1       pk int	stp4020_chip_io_map __P((pcmcia_chipset_handle_t, int, bus_addr_t,
    176   1.1       pk 				 bus_size_t, struct pcmcia_io_handle *, int *));
    177   1.1       pk void	stp4020_chip_io_unmap __P((pcmcia_chipset_handle_t, int));
    178   1.1       pk 
    179   1.1       pk void	stp4020_chip_socket_enable __P((pcmcia_chipset_handle_t));
    180   1.1       pk void	stp4020_chip_socket_disable __P((pcmcia_chipset_handle_t));
    181   1.1       pk void	*stp4020_chip_intr_establish __P((pcmcia_chipset_handle_t,
    182   1.1       pk 					  struct pcmcia_function *, int,
    183   1.1       pk 					  int (*) __P((void *)), void *));
    184   1.1       pk void	stp4020_chip_intr_disestablish __P((pcmcia_chipset_handle_t, void *));
    185   1.1       pk 
    186   1.1       pk /* Our PCMCIA chipset methods */
    187   1.1       pk static struct pcmcia_chip_functions stp4020_functions = {
    188   1.1       pk 	stp4020_chip_mem_alloc,
    189   1.1       pk 	stp4020_chip_mem_free,
    190   1.1       pk 	stp4020_chip_mem_map,
    191   1.1       pk 	stp4020_chip_mem_unmap,
    192   1.1       pk 
    193   1.1       pk 	stp4020_chip_io_alloc,
    194   1.1       pk 	stp4020_chip_io_free,
    195   1.1       pk 	stp4020_chip_io_map,
    196   1.1       pk 	stp4020_chip_io_unmap,
    197   1.1       pk 
    198   1.1       pk 	stp4020_chip_intr_establish,
    199   1.1       pk 	stp4020_chip_intr_disestablish,
    200   1.1       pk 
    201   1.1       pk 	stp4020_chip_socket_enable,
    202   1.1       pk 	stp4020_chip_socket_disable
    203   1.1       pk };
    204   1.1       pk 
    205   1.1       pk 
    206   1.1       pk static __inline__ int
    207   1.1       pk stp4020_rd_sockctl(h, idx)
    208   1.1       pk 	struct stp4020_socket *h;
    209   1.1       pk 	int idx;
    210   1.1       pk {
    211   1.1       pk 	int o = ((STP4020_SOCKREGS_SIZE * (h->sock)) + idx);
    212   1.1       pk 	return (bus_space_read_2(h->tag, h->regs, o));
    213   1.1       pk }
    214   1.1       pk 
    215   1.1       pk static __inline__ void
    216   1.1       pk stp4020_wr_sockctl(h, idx, v)
    217   1.1       pk 	struct stp4020_socket *h;
    218   1.1       pk 	int idx;
    219   1.1       pk 	int v;
    220   1.1       pk {
    221   1.1       pk 	int o = (STP4020_SOCKREGS_SIZE * (h->sock)) + idx;
    222   1.1       pk 	bus_space_write_2(h->tag, h->regs, o, v);
    223   1.1       pk }
    224   1.1       pk 
    225   1.1       pk static __inline__ int
    226   1.1       pk stp4020_rd_winctl(h, win, idx)
    227   1.1       pk 	struct stp4020_socket *h;
    228   1.1       pk 	int win;
    229   1.1       pk 	int idx;
    230   1.1       pk {
    231   1.1       pk 	int o = (STP4020_SOCKREGS_SIZE * (h->sock)) +
    232   1.1       pk 		(STP4020_WINREGS_SIZE * win) + idx;
    233   1.1       pk 	return (bus_space_read_2(h->tag, h->regs, o));
    234   1.1       pk }
    235   1.1       pk 
    236   1.1       pk static __inline__ void
    237   1.1       pk stp4020_wr_winctl(h, win, idx, v)
    238   1.1       pk 	struct stp4020_socket *h;
    239   1.1       pk 	int win;
    240   1.1       pk 	int idx;
    241   1.1       pk 	int v;
    242   1.1       pk {
    243   1.1       pk 	int o = (STP4020_SOCKREGS_SIZE * (h->sock)) +
    244   1.1       pk 		(STP4020_WINREGS_SIZE * win) + idx;
    245   1.1       pk 
    246   1.1       pk 	bus_space_write_2(h->tag, h->regs, o, v);
    247   1.1       pk }
    248   1.1       pk 
    249   1.1       pk 
    250   1.1       pk int
    251   1.1       pk stp4020print(aux, busname)
    252   1.1       pk 	void *aux;
    253   1.1       pk 	const char *busname;
    254   1.1       pk {
    255   1.4       pk 	struct pcmciabus_attach_args *paa = aux;
    256   1.3       pk 	struct stp4020_socket *h = paa->pch;
    257   1.3       pk 
    258   1.3       pk 	printf(" socket %d", h->sock);
    259   1.1       pk 	return (UNCONF);
    260   1.1       pk }
    261   1.1       pk 
    262   1.1       pk int
    263   1.1       pk stp4020match(parent, cf, aux)
    264   1.1       pk 	struct device *parent;
    265   1.1       pk 	struct cfdata *cf;
    266   1.1       pk 	void *aux;
    267   1.1       pk {
    268   1.1       pk 	struct sbus_attach_args *sa = aux;
    269   1.1       pk 
    270   1.2       pk 	return (strcmp("SUNW,pcmcia", sa->sa_name) == 0);
    271   1.1       pk }
    272   1.1       pk 
    273   1.1       pk /*
    274   1.1       pk  * Attach all the sub-devices we can find
    275   1.1       pk  */
    276   1.1       pk void
    277   1.1       pk stp4020attach(parent, self, aux)
    278   1.1       pk 	struct device *parent, *self;
    279   1.1       pk 	void *aux;
    280   1.1       pk {
    281   1.1       pk 	struct sbus_attach_args *sa = aux;
    282   1.1       pk 	struct stp4020_softc *sc = (void *)self;
    283   1.1       pk 	int node, rev;
    284  1.28   martin 	int i, sbus_intno;
    285   1.1       pk 	bus_space_handle_t bh;
    286   1.1       pk 
    287   1.1       pk 	node = sa->sa_node;
    288   1.1       pk 
    289  1.28   martin 	/* lsb of our config flags decides which interrupt we use */
    290  1.28   martin 	sbus_intno = sc->sc_dev.dv_cfdata->cf_flags & 1;
    291  1.28   martin 
    292   1.1       pk 	/* Transfer bus tags */
    293   1.1       pk 	sc->sc_bustag = sa->sa_bustag;
    294   1.1       pk 	sc->sc_dmatag = sa->sa_dmatag;
    295   1.1       pk 
    296   1.1       pk 	/* Set up per-socket static initialization */
    297   1.1       pk 	sc->sc_socks[0].sc = sc->sc_socks[1].sc = sc;
    298   1.1       pk 	sc->sc_socks[0].tag = sc->sc_socks[1].tag = sa->sa_bustag;
    299  1.28   martin 	sc->sc_socks[0].sbus_intno =
    300  1.28   martin 		sc->sc_socks[1].sbus_intno = sbus_intno;
    301   1.1       pk 
    302   1.9       pk 	if (sa->sa_nreg < 8) {
    303   1.1       pk 		printf("%s: only %d register sets\n",
    304   1.1       pk 			self->dv_xname, sa->sa_nreg);
    305   1.1       pk 		return;
    306   1.1       pk 	}
    307   1.1       pk 
    308   1.1       pk 	if (sa->sa_nintr != 2) {
    309   1.1       pk 		printf("%s: expect 2 interrupt Sbus levels; got %d\n",
    310   1.1       pk 			self->dv_xname, sa->sa_nintr);
    311   1.1       pk 		return;
    312   1.1       pk 	}
    313   1.1       pk 
    314   1.9       pk #define STP4020_BANK_PROM	0
    315   1.1       pk #define STP4020_BANK_CTRL	4
    316   1.1       pk 	for (i = 0; i < 8; i++) {
    317  1.10       pk 
    318   1.1       pk 		/*
    319   1.1       pk 		 * STP4020 Register address map:
    320   1.1       pk 		 *	bank  0:   Forth PROM
    321   1.1       pk 		 *	banks 1-3: socket 0, windows 0-2
    322   1.1       pk 		 *	bank  4:   control registers
    323   1.1       pk 		 *	banks 5-7: socket 1, windows 0-2
    324   1.1       pk 		 */
    325  1.10       pk 
    326   1.9       pk 		if (i == STP4020_BANK_PROM)
    327   1.9       pk 			/* Skip the PROM */
    328   1.9       pk 			continue;
    329   1.9       pk 
    330   1.1       pk 		if (sbus_bus_map(sa->sa_bustag,
    331  1.24   martin 				 sa->sa_reg[i].oa_space,
    332  1.24   martin 				 sa->sa_reg[i].oa_base,
    333  1.24   martin 				 sa->sa_reg[i].oa_size,
    334  1.21      eeh 				 0, &bh) != 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.10       pk 
    340  1.10       pk 		if (i == STP4020_BANK_CTRL) {
    341  1.10       pk 			/*
    342  1.10       pk 			 * Copy tag and handle to both socket structures
    343  1.10       pk 			 * for easy access in control/status IO functions.
    344  1.10       pk 			 */
    345  1.10       pk 			sc->sc_socks[0].regs = sc->sc_socks[1].regs = bh;
    346  1.10       pk 		} else if (i < STP4020_BANK_CTRL) {
    347  1.10       pk 			/* banks 1-3 */
    348  1.10       pk 			sc->sc_socks[0].windows[i-1].winaddr = bh;
    349  1.10       pk 		} else {
    350  1.10       pk 			/* banks 5-7 */
    351  1.10       pk 			sc->sc_socks[1].windows[i-5].winaddr = bh;
    352  1.10       pk 		}
    353   1.1       pk 	}
    354   1.1       pk 
    355   1.1       pk 	sbus_establish(&sc->sc_sd, &sc->sc_dev);
    356   1.1       pk 
    357  1.28   martin 	/* We only use one interrupt level. */
    358  1.28   martin 	if (sa->sa_nintr > sbus_intno) {
    359  1.28   martin 		bus_intr_establish(sa->sa_bustag,
    360  1.28   martin 		    sa->sa_intr[sbus_intno].oi_pri,
    361  1.29       pk 		    IPL_NONE, stp4020_intr, 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.18   martin 		if (stp4020_debug)
    383  1.18   martin 			stp4020_dump_regs(h);
    384   1.6       pk #endif
    385  1.16   martin 		stp4020_attach_socket(h, sa->sa_frequency);
    386   1.1       pk 	}
    387   1.1       pk }
    388   1.1       pk 
    389   1.1       pk void
    390  1.16   martin stp4020_attach_socket(h, speed)
    391   1.1       pk 	struct stp4020_socket *h;
    392  1.16   martin 	int speed;
    393   1.1       pk {
    394   1.1       pk 	struct pcmciabus_attach_args paa;
    395   1.1       pk 	int v;
    396   1.1       pk 
    397  1.15   martin 	/* Map all three windows */
    398  1.16   martin 	stp4020_map_window(h, STP_WIN_ATTR, speed);
    399  1.16   martin 	stp4020_map_window(h, STP_WIN_MEM, speed);
    400  1.16   martin 	stp4020_map_window(h, STP_WIN_IO, speed);
    401   1.1       pk 
    402   1.1       pk 	/* Configure one pcmcia device per socket */
    403   1.9       pk 	paa.paa_busname = "pcmcia";
    404   1.1       pk 	paa.pct = (pcmcia_chipset_tag_t)h->sc->sc_pct;
    405   1.1       pk 	paa.pch = (pcmcia_chipset_handle_t)h;
    406   1.1       pk 	paa.iobase = 0;
    407  1.15   martin 	paa.iosize = STP4020_WINDOW_SIZE;
    408   1.1       pk 
    409   1.1       pk 	h->pcmcia = config_found(&h->sc->sc_dev, &paa, stp4020print);
    410   1.1       pk 
    411   1.1       pk 	if (h->pcmcia == NULL)
    412   1.1       pk 		return;
    413   1.1       pk 
    414   1.1       pk 	/*
    415   1.1       pk 	 * There's actually a pcmcia bus attached; initialize the slot.
    416   1.1       pk 	 */
    417   1.1       pk 
    418   1.1       pk 	/*
    419  1.16   martin 	 * Clear things up before we enable status change interrupts.
    420  1.16   martin 	 * This seems to not be fully initialized by the PROM.
    421  1.16   martin 	 */
    422  1.16   martin 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
    423  1.16   martin 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, 0);
    424  1.16   martin 	stp4020_wr_sockctl(h, STP4020_ISR1_IDX, 0x3fff);
    425  1.16   martin 	stp4020_wr_sockctl(h, STP4020_ISR0_IDX, 0x3fff);
    426  1.16   martin 
    427  1.16   martin 	/*
    428   1.1       pk 	 * Enable socket status change interrupts.
    429  1.28   martin 	 * We only use one common interrupt for status change
    430  1.28   martin 	 * and IO, to avoid locking issues.
    431   1.1       pk 	 */
    432  1.28   martin 	v = STP4020_ICR0_ALL_STATUS_IE
    433  1.28   martin 	    | (h->sbus_intno ? STP4020_ICR0_SCILVL_SB1
    434  1.28   martin 			     : STP4020_ICR0_SCILVL_SB0);
    435   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    436   1.1       pk 
    437   1.1       pk 	/* Get live status bits from ISR0 */
    438   1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    439   1.1       pk 	if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0)
    440   1.1       pk 		return;
    441   1.1       pk 
    442   1.1       pk 	pcmcia_card_attach(h->pcmcia);
    443   1.1       pk 	h->flags |= STP4020_SOCKET_BUSY;
    444   1.1       pk }
    445   1.1       pk 
    446   1.1       pk 
    447   1.1       pk /*
    448   1.1       pk  * Deferred thread creation callback.
    449   1.1       pk  */
    450   1.1       pk void
    451   1.1       pk stp4020_create_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 	const char *name = sc->sc_dev.dv_xname;
    456   1.1       pk 
    457   1.5  thorpej 	if (kthread_create1(stp4020_event_thread, sc, &sc->event_thread,
    458   1.1       pk 			   "%s", name)) {
    459   1.1       pk 		panic("%s: unable to create event thread", name);
    460   1.1       pk 	}
    461   1.1       pk }
    462   1.1       pk 
    463   1.1       pk /*
    464   1.1       pk  * The actual event handling thread.
    465   1.1       pk  */
    466   1.1       pk void
    467   1.1       pk stp4020_event_thread(arg)
    468   1.1       pk 	void *arg;
    469   1.1       pk {
    470   1.1       pk 	struct stp4020_softc *sc = arg;
    471   1.1       pk 	struct stp4020_event *e;
    472   1.1       pk 	int s;
    473   1.1       pk 
    474   1.1       pk 	while (1) {
    475   1.1       pk 		struct stp4020_socket *h;
    476   1.1       pk 		int n;
    477   1.1       pk 
    478   1.1       pk 		s = splhigh();
    479   1.1       pk 		if ((e = SIMPLEQ_FIRST(&sc->events)) == NULL) {
    480   1.1       pk 			splx(s);
    481   1.1       pk 			(void)tsleep(&sc->events, PWAIT, "pcicev", 0);
    482   1.1       pk 			continue;
    483   1.1       pk 		}
    484  1.23    lukem 		SIMPLEQ_REMOVE_HEAD(&sc->events, se_q);
    485   1.1       pk 		splx(s);
    486   1.1       pk 
    487   1.1       pk 		n = e->se_sock;
    488   1.1       pk 		if (n < 0 || n >= STP4020_NSOCK)
    489   1.1       pk 			panic("stp4020_event_thread: wayward socket number %d",
    490   1.1       pk 			      n);
    491   1.1       pk 
    492   1.1       pk 		h = &sc->sc_socks[n];
    493   1.1       pk 		switch (e->se_type) {
    494   1.1       pk 		case STP4020_EVENT_INSERTION:
    495   1.1       pk 			pcmcia_card_attach(h->pcmcia);
    496   1.1       pk 			break;
    497   1.1       pk 		case STP4020_EVENT_REMOVAL:
    498   1.1       pk 			pcmcia_card_detach(h->pcmcia, DETACH_FORCE);
    499   1.1       pk 			break;
    500   1.1       pk 		default:
    501   1.1       pk 			panic("stp4020_event_thread: unknown event type %d",
    502   1.1       pk 			      e->se_type);
    503   1.1       pk 		}
    504   1.1       pk 		free(e, M_TEMP);
    505   1.1       pk 	}
    506   1.1       pk }
    507   1.1       pk 
    508   1.1       pk void
    509   1.1       pk stp4020_queue_event(sc, sock, event)
    510   1.1       pk 	struct stp4020_softc *sc;
    511   1.1       pk 	int sock, event;
    512   1.1       pk {
    513   1.1       pk 	struct stp4020_event *e;
    514   1.1       pk 	int s;
    515   1.1       pk 
    516   1.1       pk 	e = malloc(sizeof(*e), M_TEMP, M_NOWAIT);
    517   1.1       pk 	if (e == NULL)
    518   1.1       pk 		panic("stp4020_queue_event: can't allocate event");
    519   1.1       pk 
    520   1.1       pk 	e->se_type = event;
    521   1.1       pk 	e->se_sock = sock;
    522   1.1       pk 	s = splhigh();
    523   1.1       pk 	SIMPLEQ_INSERT_TAIL(&sc->events, e, se_q);
    524   1.1       pk 	splx(s);
    525   1.1       pk 	wakeup(&sc->events);
    526   1.1       pk }
    527   1.1       pk 
    528   1.1       pk int
    529  1.28   martin stp4020_intr(arg)
    530   1.1       pk 	void *arg;
    531   1.1       pk {
    532   1.1       pk 	struct stp4020_softc *sc = arg;
    533  1.28   martin 	int i, r = 0, cd_change = 0;
    534   1.1       pk 
    535   1.1       pk 	/*
    536   1.1       pk 	 * Check each socket for pending requests.
    537   1.1       pk 	 */
    538   1.1       pk 	for (i = 0 ; i < STP4020_NSOCK; i++) {
    539   1.1       pk 		struct stp4020_socket *h;
    540  1.28   martin 		int v;
    541   1.1       pk 
    542   1.1       pk 		h = &sc->sc_socks[i];
    543  1.28   martin 		v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    544   1.1       pk 
    545  1.28   martin 		/* Ack all interrupts at once */
    546  1.28   martin 		stp4020_wr_sockctl(h, STP4020_ISR0_IDX, STP4020_ISR0_ALL_STATUS_IRQ);
    547   1.1       pk 
    548   1.1       pk #ifdef STP4020_DEBUG
    549   1.1       pk 		if (stp4020_debug != 0) {
    550   1.1       pk 			char bits[64];
    551   1.1       pk 			bitmask_snprintf(v, STP4020_ISR0_IOBITS,
    552   1.1       pk 					 bits, sizeof(bits));
    553   1.1       pk 			printf("stp4020_statintr: ISR0=%s\n", bits);
    554   1.1       pk 		}
    555   1.1       pk #endif
    556   1.1       pk 
    557   1.1       pk 		if ((v & STP4020_ISR0_CDCHG) != 0) {
    558   1.1       pk 			/*
    559   1.1       pk 			 * Card status change detect
    560   1.1       pk 			 */
    561  1.18   martin 			cd_change = 1;
    562  1.18   martin 			r = 1;
    563  1.18   martin 			if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)){
    564   1.1       pk 				if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
    565   1.1       pk 					stp4020_queue_event(sc, i,
    566   1.1       pk 						STP4020_EVENT_INSERTION);
    567   1.1       pk 					h->flags |= STP4020_SOCKET_BUSY;
    568   1.1       pk 				}
    569   1.1       pk 			}
    570   1.1       pk 			if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0){
    571   1.1       pk 				if ((h->flags & STP4020_SOCKET_BUSY) != 0) {
    572   1.1       pk 					stp4020_queue_event(sc, i,
    573   1.1       pk 						STP4020_EVENT_REMOVAL);
    574   1.1       pk 					h->flags &= ~STP4020_SOCKET_BUSY;
    575   1.1       pk 				}
    576   1.1       pk 			}
    577   1.1       pk 		}
    578  1.28   martin 
    579  1.28   martin 		if ((v & STP4020_ISR0_IOINT) != 0) {
    580  1.28   martin 			/* we can not deny this is ours, no matter what the
    581  1.28   martin 			   card driver says. */
    582  1.28   martin 			r = 1;
    583  1.28   martin 
    584  1.28   martin 			/* ack interrupt */
    585  1.28   martin 			stp4020_wr_sockctl(h, STP4020_ISR0_IDX, v);
    586  1.28   martin 
    587  1.28   martin 			/* It's a card interrupt */
    588  1.28   martin 			if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
    589  1.28   martin 				printf("stp4020[%d]: spurious interrupt?\n",
    590  1.28   martin 					h->sock);
    591  1.28   martin 				continue;
    592  1.28   martin 			}
    593  1.28   martin 			/* Call card handler, if any */
    594  1.28   martin 			if (h->intrhandler != NULL) {
    595  1.28   martin 				/*
    596  1.28   martin 				 * Called without handling of it's requested
    597  1.28   martin 				 * protection level (h->ipl), since we have
    598  1.28   martin 				 * no general queuing mechanism available
    599  1.28   martin 				 * right now and we know for sure we are
    600  1.28   martin 				 * running at a higher protection level
    601  1.28   martin 				 * right now.
    602  1.28   martin 				 */
    603  1.28   martin 				(*h->intrhandler)(h->intrarg);
    604  1.28   martin 			}
    605  1.28   martin 		}
    606   1.1       pk 
    607  1.18   martin 		/* informational messages */
    608   1.1       pk 		if ((v & STP4020_ISR0_BVD1CHG) != 0) {
    609  1.18   martin 			/* ignore if this is caused by insert or removal */
    610  1.18   martin 			if (!cd_change)
    611  1.18   martin 				printf("stp4020[%d]: Battery change 1\n", h->sock);
    612  1.15   martin 			r = 1;
    613   1.1       pk 		}
    614   1.1       pk 
    615   1.1       pk 		if ((v & STP4020_ISR0_BVD2CHG) != 0) {
    616  1.18   martin 			/* ignore if this is caused by insert or removal */
    617  1.18   martin 			if (!cd_change)
    618  1.18   martin 				printf("stp4020[%d]: Battery change 2\n", h->sock);
    619  1.15   martin 			r = 1;
    620   1.1       pk 		}
    621   1.1       pk 
    622   1.1       pk 		if ((v & STP4020_ISR0_RDYCHG) != 0) {
    623  1.18   martin 			DPRINTF(("stp4020[%d]: Ready/Busy change\n", h->sock));
    624  1.15   martin 			r = 1;
    625   1.1       pk 		}
    626   1.1       pk 
    627   1.1       pk 		if ((v & STP4020_ISR0_WPCHG) != 0) {
    628  1.18   martin 			DPRINTF(("stp4020[%d]: Write protect change\n", h->sock));
    629  1.15   martin 			r = 1;
    630   1.1       pk 		}
    631   1.1       pk 
    632   1.1       pk 		if ((v & STP4020_ISR0_PCTO) != 0) {
    633  1.18   martin 			DPRINTF(("stp4020[%d]: Card access timeout\n", h->sock));
    634  1.15   martin 			r = 1;
    635   1.1       pk 		}
    636  1.18   martin 
    637   1.1       pk 	}
    638   1.1       pk 
    639   1.1       pk 	return (r);
    640   1.1       pk }
    641   1.1       pk 
    642  1.16   martin /*
    643  1.16   martin  * The function gets the sbus speed and a access time and calculates
    644  1.16   martin  * values for the CMDLNG and CMDDLAY registers.
    645  1.16   martin  */
    646  1.15   martin static void
    647  1.16   martin stp4020_calc_speed(int bus_speed, int ns, int *length, int *delay)
    648   1.1       pk {
    649  1.16   martin 	int result;
    650  1.16   martin 
    651  1.16   martin 	if (ns < STP4020_MEM_SPEED_MIN)
    652  1.16   martin 		ns = STP4020_MEM_SPEED_MIN;
    653  1.16   martin 	else if (ns > STP4020_MEM_SPEED_MAX)
    654  1.16   martin 		ns = STP4020_MEM_SPEED_MAX;
    655  1.16   martin 	result = ns*(bus_speed/1000);
    656  1.16   martin 	if (result % 1000000)
    657  1.16   martin 		result = result/1000000 + 1;
    658  1.16   martin 	else
    659  1.16   martin 		result /= 1000000;
    660  1.16   martin 	*length = result;
    661  1.16   martin 
    662  1.16   martin 	/* the sbus frequency range is limited, so we can keep this simple */
    663  1.16   martin 	*delay = ns <= STP4020_MEM_SPEED_MIN? 1 : 2;
    664  1.16   martin }
    665  1.15   martin 
    666  1.16   martin static void
    667  1.16   martin stp4020_map_window(struct stp4020_socket *h, int win, int speed)
    668  1.16   martin {
    669  1.16   martin 	int v, length, delay;
    670  1.15   martin 
    671  1.15   martin 	/*
    672  1.16   martin 	 * According to the PC Card standard 300ns access timing should be
    673  1.16   martin 	 * used for attribute memory access. Our pcmcia framework does not
    674  1.16   martin 	 * seem to propagate timing information, so we use that
    675  1.16   martin 	 * everywhere.
    676  1.15   martin 	 */
    677  1.24   martin 	stp4020_calc_speed(speed, (win==STP_WIN_ATTR)? 300 : 100, &length, &delay);
    678   1.1       pk 
    679   1.1       pk 	/*
    680  1.15   martin 	 * Fill in the Address Space Select and Base Address
    681  1.15   martin 	 * fields of this windows control register 0.
    682   1.1       pk 	 */
    683  1.16   martin 	v = ((delay << STP4020_WCR0_CMDDLY_S)&STP4020_WCR0_CMDDLY_M)
    684  1.16   martin 	    | ((length << STP4020_WCR0_CMDLNG_S)&STP4020_WCR0_CMDLNG_M);
    685  1.15   martin 	switch (win) {
    686  1.15   martin 	case STP_WIN_ATTR:
    687  1.15   martin 		v |= STP4020_WCR0_ASPSEL_AM;
    688  1.15   martin 		break;
    689  1.15   martin 	case STP_WIN_MEM:
    690  1.15   martin 		v |= STP4020_WCR0_ASPSEL_CM;
    691  1.15   martin 		break;
    692  1.15   martin 	case STP_WIN_IO:
    693  1.15   martin 		v |= STP4020_WCR0_ASPSEL_IO;
    694  1.15   martin 		break;
    695  1.15   martin 	}
    696  1.15   martin 	v |= (STP4020_ADDR2PAGE(0) & STP4020_WCR0_BASE_M);
    697  1.15   martin 	stp4020_wr_winctl(h, win, STP4020_WCR0_IDX, v);
    698  1.16   martin 	stp4020_wr_winctl(h, win, STP4020_WCR1_IDX, 1<<STP4020_WCR1_WAITREQ_S);
    699  1.15   martin }
    700   1.1       pk 
    701  1.15   martin int
    702  1.15   martin stp4020_chip_mem_alloc(pch, size, pcmhp)
    703  1.15   martin 	pcmcia_chipset_handle_t pch;
    704  1.15   martin 	bus_size_t size;
    705  1.15   martin 	struct pcmcia_mem_handle *pcmhp;
    706  1.15   martin {
    707  1.15   martin 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    708   1.1       pk 
    709  1.15   martin 	/* we can not do much here, defere work to _mem_map */
    710  1.15   martin 	pcmhp->memt = h->tag;
    711   1.1       pk 	pcmhp->size = size;
    712  1.19   martin 	pcmhp->addr = 0;
    713  1.19   martin 	pcmhp->mhandle = 0;
    714  1.19   martin 	pcmhp->realsize = size;
    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_free(pch, pcmhp)
    721   1.1       pk 	pcmcia_chipset_handle_t pch;
    722   1.1       pk 	struct pcmcia_mem_handle *pcmhp;
    723   1.1       pk {
    724   1.1       pk }
    725   1.1       pk 
    726   1.1       pk int
    727   1.1       pk stp4020_chip_mem_map(pch, kind, card_addr, size, pcmhp, offsetp, windowp)
    728   1.1       pk 	pcmcia_chipset_handle_t pch;
    729   1.1       pk 	int kind;
    730   1.1       pk 	bus_addr_t card_addr;
    731   1.1       pk 	bus_size_t size;
    732   1.1       pk 	struct pcmcia_mem_handle *pcmhp;
    733  1.14    soren 	bus_size_t *offsetp;
    734   1.1       pk 	int *windowp;
    735   1.1       pk {
    736   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    737  1.15   martin 	int win = (kind&PCMCIA_MEM_ATTR)? STP_WIN_ATTR : STP_WIN_MEM;
    738   1.8     joda 
    739  1.15   martin 	pcmhp->memt = h->tag;
    740  1.15   martin 	bus_space_subregion(h->tag, h->windows[win].winaddr, card_addr, size, &pcmhp->memh);
    741  1.19   martin 	pcmhp->size = size;
    742  1.19   martin 	pcmhp->realsize = STP4020_WINDOW_SIZE - card_addr;
    743  1.15   martin 	*offsetp = 0;
    744  1.15   martin 	*windowp = 0;
    745   1.1       pk 
    746   1.1       pk 	return (0);
    747   1.1       pk }
    748   1.1       pk 
    749   1.1       pk void
    750   1.1       pk stp4020_chip_mem_unmap(pch, win)
    751   1.1       pk 	pcmcia_chipset_handle_t pch;
    752   1.1       pk 	int win;
    753   1.1       pk {
    754   1.1       pk }
    755   1.1       pk 
    756   1.1       pk int
    757   1.1       pk stp4020_chip_io_alloc(pch, start, size, align, pcihp)
    758   1.1       pk 	pcmcia_chipset_handle_t pch;
    759   1.1       pk 	bus_addr_t start;
    760   1.1       pk 	bus_size_t size;
    761   1.1       pk 	bus_size_t align;
    762   1.1       pk 	struct pcmcia_io_handle *pcihp;
    763   1.1       pk {
    764   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    765   1.1       pk 
    766   1.1       pk 	pcihp->iot = h->tag;
    767  1.15   martin 	pcihp->ioh = h->windows[STP_WIN_IO].winaddr;
    768  1.15   martin 	return 0;
    769   1.1       pk }
    770   1.1       pk 
    771   1.1       pk void
    772   1.1       pk stp4020_chip_io_free(pch, pcihp)
    773   1.1       pk 	pcmcia_chipset_handle_t pch;
    774   1.1       pk 	struct pcmcia_io_handle *pcihp;
    775   1.1       pk {
    776   1.1       pk }
    777   1.1       pk 
    778   1.1       pk int
    779   1.1       pk stp4020_chip_io_map(pch, width, offset, size, pcihp, windowp)
    780   1.1       pk 	pcmcia_chipset_handle_t pch;
    781   1.1       pk 	int width;
    782   1.1       pk 	bus_addr_t offset;
    783   1.1       pk 	bus_size_t size;
    784   1.1       pk 	struct pcmcia_io_handle *pcihp;
    785   1.1       pk 	int *windowp;
    786   1.1       pk {
    787   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    788   1.1       pk 
    789  1.15   martin 	pcihp->iot = h->tag;
    790  1.15   martin 	bus_space_subregion(h->tag, h->windows[STP_WIN_IO].winaddr, offset, size, &pcihp->ioh);
    791  1.15   martin 	*windowp = 0;
    792  1.15   martin 	return 0;
    793   1.1       pk }
    794   1.1       pk 
    795   1.1       pk void
    796   1.1       pk stp4020_chip_io_unmap(pch, win)
    797   1.1       pk 	pcmcia_chipset_handle_t pch;
    798   1.1       pk 	int win;
    799   1.1       pk {
    800   1.1       pk }
    801   1.1       pk 
    802   1.1       pk void
    803   1.1       pk stp4020_chip_socket_enable(pch)
    804   1.1       pk 	pcmcia_chipset_handle_t pch;
    805   1.1       pk {
    806   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    807  1.18   martin 	int i, v;
    808   1.1       pk 
    809   1.1       pk 	/* this bit is mostly stolen from pcic_attach_card */
    810   1.1       pk 
    811   1.1       pk 	/* Power down the socket to reset it, clear the card reset pin */
    812  1.18   martin 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
    813   1.1       pk 
    814   1.1       pk 	/*
    815   1.1       pk 	 * wait 300ms until power fails (Tpf).  Then, wait 100ms since
    816   1.1       pk 	 * we are changing Vcc (Toff).
    817   1.1       pk 	 */
    818   1.1       pk 	stp4020_delay((300 + 100) * 1000);
    819   1.1       pk 
    820   1.1       pk 	/* Power up the socket */
    821  1.18   martin 	v = STP4020_ICR1_MSTPWR;
    822   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    823   1.1       pk 
    824   1.1       pk 	/*
    825   1.1       pk 	 * wait 100ms until power raise (Tpr) and 20ms to become
    826   1.1       pk 	 * stable (Tsu(Vcc)).
    827   1.1       pk 	 */
    828   1.1       pk 	stp4020_delay((100 + 20) * 1000);
    829   1.1       pk 
    830  1.18   martin 	v |= STP4020_ICR1_PCIFOE|STP4020_ICR1_VPP1_VCC;
    831   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    832   1.1       pk 
    833   1.1       pk 	/*
    834   1.1       pk 	 * hold RESET at least 10us.
    835   1.1       pk 	 */
    836   1.1       pk 	delay(10);
    837   1.1       pk 
    838   1.1       pk 	/* Clear reset flag */
    839   1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    840   1.1       pk 	v &= ~STP4020_ICR0_RESET;
    841   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    842   1.1       pk 
    843   1.1       pk 	/* wait 20ms as per pc card standard (r2.01) section 4.3.6 */
    844   1.1       pk 	stp4020_delay(20000);
    845   1.1       pk 
    846   1.1       pk 	/* Wait for the chip to finish initializing (5 seconds max) */
    847   1.1       pk 	for (i = 10000; i > 0; i--) {
    848   1.1       pk 		v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    849   1.1       pk 		if ((v & STP4020_ISR0_RDYST) != 0)
    850   1.1       pk 			break;
    851   1.1       pk 		delay(500);
    852   1.1       pk 	}
    853   1.1       pk 	if (i <= 0) {
    854   1.1       pk 		char bits[64];
    855   1.1       pk 		bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
    856   1.1       pk 				 STP4020_ISR0_IOBITS, bits, sizeof(bits));
    857   1.1       pk 		printf("stp4020_chip_socket_enable: not ready: status %s\n",
    858   1.1       pk 			bits);
    859   1.1       pk 		return;
    860   1.1       pk 	}
    861   1.1       pk 
    862   1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    863   1.1       pk 
    864   1.1       pk 	/*
    865  1.18   martin 	 * Check the card type.
    866  1.18   martin 	 * Enable socket I/O interrupts for IO cards.
    867   1.1       pk 	 * We use level SB_INT[0] for I/O interrupts.
    868   1.1       pk 	 */
    869  1.18   martin 	if (pcmcia_card_gettype(h->pcmcia) == PCMCIA_IFTYPE_IO) {
    870  1.18   martin 		v &= ~(STP4020_ICR0_IOILVL|STP4020_ICR0_IFTYPE);
    871  1.18   martin 		v |= STP4020_ICR0_IFTYPE_IO|STP4020_ICR0_IOIE
    872  1.28   martin 		    |STP4020_ICR0_SPKREN;
    873  1.28   martin 		v |= h->sbus_intno ? STP4020_ICR0_IOILVL_SB1
    874  1.28   martin 				   : STP4020_ICR0_IOILVL_SB0;
    875  1.18   martin 		DPRINTF(("%s: configuring card for IO useage\n", h->sc->sc_dev.dv_xname));
    876  1.18   martin 	} else {
    877  1.18   martin 		v &= ~(STP4020_ICR0_IOILVL|STP4020_ICR0_IFTYPE
    878  1.28   martin 		    |STP4020_ICR0_SPKREN);
    879  1.18   martin 		v |= STP4020_ICR0_IFTYPE_MEM;
    880  1.18   martin 		DPRINTF(("%s: configuring card for MEM ONLY useage\n", h->sc->sc_dev.dv_xname));
    881  1.18   martin 	}
    882   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    883   1.1       pk }
    884   1.1       pk 
    885   1.1       pk void
    886   1.1       pk stp4020_chip_socket_disable(pch)
    887   1.1       pk 	pcmcia_chipset_handle_t pch;
    888   1.1       pk {
    889   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    890   1.1       pk 	int v;
    891   1.1       pk 
    892   1.1       pk 	/*
    893   1.1       pk 	 * Disable socket I/O interrupts.
    894   1.1       pk 	 */
    895   1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    896   1.1       pk 	v &= ~(STP4020_ICR0_IOIE | STP4020_ICR0_IOILVL);
    897   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    898   1.1       pk 
    899   1.1       pk 	/* Power down the socket */
    900  1.18   martin 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
    901   1.1       pk 
    902   1.1       pk 	/*
    903   1.1       pk 	 * wait 300ms until power fails (Tpf).
    904   1.1       pk 	 */
    905   1.1       pk 	stp4020_delay(300 * 1000);
    906   1.1       pk }
    907   1.1       pk 
    908   1.1       pk void *
    909   1.1       pk stp4020_chip_intr_establish(pch, pf, ipl, handler, arg)
    910   1.1       pk 	pcmcia_chipset_handle_t pch;
    911   1.1       pk 	struct pcmcia_function *pf;
    912   1.1       pk 	int ipl;
    913   1.1       pk 	int (*handler) __P((void *));
    914   1.1       pk 	void *arg;
    915   1.1       pk {
    916   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    917   1.1       pk 
    918   1.1       pk 	h->intrhandler = handler;
    919   1.1       pk 	h->intrarg = arg;
    920   1.1       pk 	h->ipl = ipl;
    921  1.16   martin 	return h;
    922   1.1       pk }
    923   1.1       pk 
    924   1.1       pk void
    925   1.1       pk stp4020_chip_intr_disestablish(pch, ih)
    926   1.1       pk 	pcmcia_chipset_handle_t pch;
    927   1.1       pk 	void *ih;
    928   1.1       pk {
    929   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    930   1.1       pk 
    931   1.1       pk 	h->intrhandler = NULL;
    932   1.1       pk 	h->intrarg = NULL;
    933   1.1       pk }
    934   1.1       pk 
    935   1.1       pk /*
    936   1.1       pk  * Delay and possibly yield CPU.
    937   1.1       pk  * XXX - assumes a context
    938   1.1       pk  */
    939   1.1       pk void
    940   1.1       pk stp4020_delay(ms)
    941   1.1       pk 	unsigned int ms;
    942   1.1       pk {
    943   1.1       pk 	unsigned int ticks;
    944   1.1       pk 
    945   1.1       pk 	/* Convert to ticks */
    946   1.1       pk 	ticks = (ms * hz ) / 1000000;
    947   1.1       pk 
    948   1.1       pk 	if (cold || ticks == 0) {
    949   1.1       pk 		delay(ms);
    950   1.1       pk 		return;
    951   1.1       pk 	}
    952   1.1       pk 
    953   1.1       pk #ifdef DIAGNOSTIC
    954   1.1       pk 	if (ticks > 60*hz)
    955   1.1       pk 		panic("stp4020: preposterous delay: %u", ticks);
    956   1.1       pk #endif
    957   1.1       pk 	tsleep(&ticks, 0, "stp4020_delay", ticks);
    958   1.1       pk }
    959   1.6       pk 
    960   1.6       pk #ifdef STP4020_DEBUG
    961   1.6       pk void
    962   1.6       pk stp4020_dump_regs(h)
    963   1.6       pk 	struct stp4020_socket *h;
    964   1.6       pk {
    965   1.6       pk 	char bits[64];
    966   1.6       pk 	/*
    967   1.6       pk 	 * Dump control and status registers.
    968   1.6       pk 	 */
    969   1.6       pk 	printf("socket[%d] registers:\n", h->sock);
    970   1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR0_IDX),
    971   1.6       pk 			 STP4020_ICR0_BITS, bits, sizeof(bits));
    972   1.6       pk 	printf("\tICR0=%s\n", bits);
    973   1.6       pk 
    974   1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR1_IDX),
    975   1.6       pk 			 STP4020_ICR1_BITS, bits, sizeof(bits));
    976   1.6       pk 	printf("\tICR1=%s\n", bits);
    977   1.6       pk 
    978   1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
    979   1.6       pk 			 STP4020_ISR0_IOBITS, bits, sizeof(bits));
    980   1.6       pk 	printf("\tISR0=%s\n", bits);
    981   1.6       pk 
    982   1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR1_IDX),
    983   1.6       pk 			 STP4020_ISR1_BITS, bits, sizeof(bits));
    984   1.6       pk 	printf("\tISR1=%s\n", bits);
    985   1.6       pk }
    986   1.6       pk #endif /* STP4020_DEBUG */
    987