Home | History | Annotate | Line # | Download | only in sbus
stp4020.c revision 1.22
      1  1.22   martin /*	$NetBSD: stp4020.c,v 1.22 2002/03/25 09:02:54 martin 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.22   martin __KERNEL_RCSID(0, "$NetBSD: stp4020.c,v 1.22 2002/03/25 09:02:54 martin 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.1       pk 	bus_space_tag_t	tag;		/* socket control space */
    108   1.1       pk 	bus_space_handle_t	regs;	/* 			*/
    109   1.1       pk 	struct device	*pcmcia;	/* Associated PCMCIA device */
    110   1.1       pk 	int		(*intrhandler)	/* Card driver interrupt handler */
    111   1.1       pk 			    __P((void *));
    112   1.1       pk 	void		*intrarg;	/* Card interrupt handler argument */
    113   1.1       pk 	int		ipl;		/* Interrupt level suggested by card */
    114   1.1       pk 	struct {
    115   1.1       pk 		bus_space_handle_t	winaddr;/* this window's address */
    116   1.1       pk 	} windows[STP4020_NWIN];
    117   1.1       pk 
    118   1.1       pk };
    119   1.1       pk 
    120   1.1       pk struct stp4020_softc {
    121   1.1       pk 	struct device	sc_dev;		/* Base device */
    122   1.1       pk 	struct sbusdev	sc_sd;		/* SBus device */
    123   1.1       pk 	bus_space_tag_t	sc_bustag;
    124   1.1       pk 	bus_dma_tag_t	sc_dmatag;
    125   1.1       pk 	pcmcia_chipset_tag_t	sc_pct;	/* Chipset methods */
    126   1.1       pk 
    127   1.1       pk 	struct proc	*event_thread;		/* event handling thread */
    128   1.1       pk 	SIMPLEQ_HEAD(, stp4020_event)	events;	/* Pending events for thread */
    129   1.1       pk 
    130   1.1       pk 	struct stp4020_socket sc_socks[STP4020_NSOCK];
    131   1.1       pk };
    132   1.1       pk 
    133   1.1       pk 
    134   1.1       pk static int	stp4020print	__P((void *, const char *));
    135   1.1       pk static int	stp4020match	__P((struct device *, struct cfdata *, void *));
    136   1.1       pk static void	stp4020attach	__P((struct device *, struct device *, void *));
    137   1.1       pk static int	stp4020_iointr	__P((void *));
    138   1.1       pk static int	stp4020_statintr __P((void *));
    139  1.16   martin static void	stp4020_map_window(struct stp4020_socket *h, int win, int speed);
    140  1.16   martin static void	stp4020_calc_speed(int bus_speed, int ns, int *length, int *delay);
    141   1.1       pk 
    142   1.1       pk struct cfattach nell_ca = {
    143   1.1       pk 	sizeof(struct stp4020_softc), stp4020match, stp4020attach
    144   1.1       pk };
    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.1       pk 	int i;
    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.1       pk 	/* Transfer bus tags */
    290   1.1       pk 	sc->sc_bustag = sa->sa_bustag;
    291   1.1       pk 	sc->sc_dmatag = sa->sa_dmatag;
    292   1.1       pk 
    293   1.1       pk 	/* Set up per-socket static initialization */
    294   1.1       pk 	sc->sc_socks[0].sc = sc->sc_socks[1].sc = sc;
    295   1.1       pk 	sc->sc_socks[0].tag = sc->sc_socks[1].tag = sa->sa_bustag;
    296   1.1       pk 
    297   1.9       pk 	if (sa->sa_nreg < 8) {
    298   1.1       pk 		printf("%s: only %d register sets\n",
    299   1.1       pk 			self->dv_xname, sa->sa_nreg);
    300   1.1       pk 		return;
    301   1.1       pk 	}
    302   1.1       pk 
    303   1.1       pk 	if (sa->sa_nintr != 2) {
    304   1.1       pk 		printf("%s: expect 2 interrupt Sbus levels; got %d\n",
    305   1.1       pk 			self->dv_xname, sa->sa_nintr);
    306   1.1       pk 		return;
    307   1.1       pk 	}
    308   1.1       pk 
    309   1.9       pk #define STP4020_BANK_PROM	0
    310   1.1       pk #define STP4020_BANK_CTRL	4
    311   1.1       pk 	for (i = 0; i < 8; i++) {
    312  1.10       pk 
    313   1.1       pk 		/*
    314   1.1       pk 		 * STP4020 Register address map:
    315   1.1       pk 		 *	bank  0:   Forth PROM
    316   1.1       pk 		 *	banks 1-3: socket 0, windows 0-2
    317   1.1       pk 		 *	bank  4:   control registers
    318   1.1       pk 		 *	banks 5-7: socket 1, windows 0-2
    319   1.1       pk 		 */
    320  1.10       pk 
    321   1.9       pk 		if (i == STP4020_BANK_PROM)
    322   1.9       pk 			/* Skip the PROM */
    323   1.9       pk 			continue;
    324   1.9       pk 
    325   1.1       pk 		if (sbus_bus_map(sa->sa_bustag,
    326   1.1       pk 				 sa->sa_reg[i].sbr_slot,
    327   1.1       pk 				 sa->sa_reg[i].sbr_offset,
    328   1.1       pk 				 sa->sa_reg[i].sbr_size,
    329  1.21      eeh 				 0, &bh) != 0) {
    330   1.1       pk 			printf("%s: attach: cannot map registers\n",
    331   1.1       pk 				self->dv_xname);
    332   1.1       pk 			return;
    333   1.1       pk 		}
    334  1.10       pk 
    335  1.10       pk 		if (i == STP4020_BANK_CTRL) {
    336  1.10       pk 			/*
    337  1.10       pk 			 * Copy tag and handle to both socket structures
    338  1.10       pk 			 * for easy access in control/status IO functions.
    339  1.10       pk 			 */
    340  1.10       pk 			sc->sc_socks[0].regs = sc->sc_socks[1].regs = bh;
    341  1.10       pk 		} else if (i < STP4020_BANK_CTRL) {
    342  1.10       pk 			/* banks 1-3 */
    343  1.10       pk 			sc->sc_socks[0].windows[i-1].winaddr = bh;
    344  1.10       pk 		} else {
    345  1.10       pk 			/* banks 5-7 */
    346  1.10       pk 			sc->sc_socks[1].windows[i-5].winaddr = bh;
    347  1.10       pk 		}
    348   1.1       pk 	}
    349   1.1       pk 
    350   1.1       pk 	sbus_establish(&sc->sc_sd, &sc->sc_dev);
    351   1.1       pk 
    352   1.1       pk 	/*
    353   1.1       pk 	 * We get to use two SBus interrupt levels.
    354   1.1       pk 	 * The higher level we use for status change interrupts;
    355   1.1       pk 	 * the lower level for PC card I/O.
    356   1.1       pk 	 */
    357   1.7       pk 	if (sa->sa_nintr != 0) {
    358   1.7       pk 		bus_intr_establish(sa->sa_bustag, sa->sa_intr[1].sbi_pri,
    359  1.11       pk 				   IPL_NONE, 0, stp4020_statintr, sc);
    360   1.1       pk 
    361   1.7       pk 		bus_intr_establish(sa->sa_bustag, sa->sa_intr[0].sbi_pri,
    362  1.11       pk 				   IPL_NONE, 0, stp4020_iointr, sc);
    363   1.7       pk 	}
    364   1.1       pk 
    365   1.1       pk 	rev = stp4020_rd_sockctl(&sc->sc_socks[0], STP4020_ISR1_IDX) &
    366   1.1       pk 		STP4020_ISR1_REV_M;
    367   1.1       pk 	printf(": rev %x\n", rev);
    368   1.1       pk 
    369   1.1       pk 	sc->sc_pct = (pcmcia_chipset_tag_t)&stp4020_functions;
    370   1.1       pk 
    371   1.1       pk 	/*
    372   1.1       pk 	 * Arrange that a kernel thread be created to handle
    373   1.1       pk 	 * insert/removal events.
    374   1.1       pk 	 */
    375   1.1       pk 	SIMPLEQ_INIT(&sc->events);
    376   1.5  thorpej 	kthread_create(stp4020_create_event_thread, sc);
    377   1.1       pk 
    378   1.1       pk 	for (i = 0; i < STP4020_NSOCK; i++) {
    379   1.1       pk 		struct stp4020_socket *h = &sc->sc_socks[i];
    380   1.1       pk 		h->sock = i;
    381   1.1       pk 		h->sc = sc;
    382   1.6       pk #ifdef STP4020_DEBUG
    383  1.18   martin 		if (stp4020_debug)
    384  1.18   martin 			stp4020_dump_regs(h);
    385   1.6       pk #endif
    386  1.16   martin 		stp4020_attach_socket(h, sa->sa_frequency);
    387   1.1       pk 	}
    388   1.1       pk }
    389   1.1       pk 
    390   1.1       pk void
    391  1.16   martin stp4020_attach_socket(h, speed)
    392   1.1       pk 	struct stp4020_socket *h;
    393  1.16   martin 	int speed;
    394   1.1       pk {
    395   1.1       pk 	struct pcmciabus_attach_args paa;
    396   1.1       pk 	int v;
    397   1.1       pk 
    398  1.15   martin 	/* Map all three windows */
    399  1.16   martin 	stp4020_map_window(h, STP_WIN_ATTR, speed);
    400  1.16   martin 	stp4020_map_window(h, STP_WIN_MEM, speed);
    401  1.16   martin 	stp4020_map_window(h, STP_WIN_IO, speed);
    402   1.1       pk 
    403   1.1       pk 	/* Configure one pcmcia device per socket */
    404   1.9       pk 	paa.paa_busname = "pcmcia";
    405   1.1       pk 	paa.pct = (pcmcia_chipset_tag_t)h->sc->sc_pct;
    406   1.1       pk 	paa.pch = (pcmcia_chipset_handle_t)h;
    407   1.1       pk 	paa.iobase = 0;
    408  1.15   martin 	paa.iosize = STP4020_WINDOW_SIZE;
    409   1.1       pk 
    410   1.1       pk 	h->pcmcia = config_found(&h->sc->sc_dev, &paa, stp4020print);
    411   1.1       pk 
    412   1.1       pk 	if (h->pcmcia == NULL)
    413   1.1       pk 		return;
    414   1.1       pk 
    415   1.1       pk 	/*
    416   1.1       pk 	 * There's actually a pcmcia bus attached; initialize the slot.
    417   1.1       pk 	 */
    418   1.1       pk 
    419   1.1       pk 	/*
    420  1.16   martin 	 * Clear things up before we enable status change interrupts.
    421  1.16   martin 	 * This seems to not be fully initialized by the PROM.
    422  1.16   martin 	 */
    423  1.16   martin 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
    424  1.16   martin 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, 0);
    425  1.16   martin 	stp4020_wr_sockctl(h, STP4020_ISR1_IDX, 0x3fff);
    426  1.16   martin 	stp4020_wr_sockctl(h, STP4020_ISR0_IDX, 0x3fff);
    427  1.16   martin 
    428  1.16   martin 	/*
    429   1.1       pk 	 * Enable socket status change interrupts.
    430   1.1       pk 	 * We use SB_INT[1] for status change interrupts.
    431   1.1       pk 	 */
    432  1.18   martin 	v = STP4020_ICR0_ALL_STATUS_IE | STP4020_ICR0_SCILVL_SB1;
    433   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    434   1.1       pk 
    435   1.1       pk 	/* Get live status bits from ISR0 */
    436   1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    437   1.1       pk 	if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0)
    438   1.1       pk 		return;
    439   1.1       pk 
    440   1.1       pk 	pcmcia_card_attach(h->pcmcia);
    441   1.1       pk 	h->flags |= STP4020_SOCKET_BUSY;
    442   1.1       pk }
    443   1.1       pk 
    444   1.1       pk 
    445   1.1       pk /*
    446   1.1       pk  * Deferred thread creation callback.
    447   1.1       pk  */
    448   1.1       pk void
    449   1.1       pk stp4020_create_event_thread(arg)
    450   1.1       pk 	void *arg;
    451   1.1       pk {
    452   1.1       pk 	struct stp4020_softc *sc = arg;
    453   1.1       pk 	const char *name = sc->sc_dev.dv_xname;
    454   1.1       pk 
    455   1.5  thorpej 	if (kthread_create1(stp4020_event_thread, sc, &sc->event_thread,
    456   1.1       pk 			   "%s", name)) {
    457   1.1       pk 		panic("%s: unable to create event thread", name);
    458   1.1       pk 	}
    459   1.1       pk }
    460   1.1       pk 
    461   1.1       pk /*
    462   1.1       pk  * The actual event handling thread.
    463   1.1       pk  */
    464   1.1       pk void
    465   1.1       pk stp4020_event_thread(arg)
    466   1.1       pk 	void *arg;
    467   1.1       pk {
    468   1.1       pk 	struct stp4020_softc *sc = arg;
    469   1.1       pk 	struct stp4020_event *e;
    470   1.1       pk 	int s;
    471   1.1       pk 
    472   1.1       pk 	while (1) {
    473   1.1       pk 		struct stp4020_socket *h;
    474   1.1       pk 		int n;
    475   1.1       pk 
    476   1.1       pk 		s = splhigh();
    477   1.1       pk 		if ((e = SIMPLEQ_FIRST(&sc->events)) == NULL) {
    478   1.1       pk 			splx(s);
    479   1.1       pk 			(void)tsleep(&sc->events, PWAIT, "pcicev", 0);
    480   1.1       pk 			continue;
    481   1.1       pk 		}
    482   1.1       pk 		SIMPLEQ_REMOVE_HEAD(&sc->events, e, se_q);
    483   1.1       pk 		splx(s);
    484   1.1       pk 
    485   1.1       pk 		n = e->se_sock;
    486   1.1       pk 		if (n < 0 || n >= STP4020_NSOCK)
    487   1.1       pk 			panic("stp4020_event_thread: wayward socket number %d",
    488   1.1       pk 			      n);
    489   1.1       pk 
    490   1.1       pk 		h = &sc->sc_socks[n];
    491   1.1       pk 		switch (e->se_type) {
    492   1.1       pk 		case STP4020_EVENT_INSERTION:
    493   1.1       pk 			pcmcia_card_attach(h->pcmcia);
    494   1.1       pk 			break;
    495   1.1       pk 		case STP4020_EVENT_REMOVAL:
    496   1.1       pk 			pcmcia_card_detach(h->pcmcia, DETACH_FORCE);
    497   1.1       pk 			break;
    498   1.1       pk 		default:
    499   1.1       pk 			panic("stp4020_event_thread: unknown event type %d",
    500   1.1       pk 			      e->se_type);
    501   1.1       pk 		}
    502   1.1       pk 		free(e, M_TEMP);
    503   1.1       pk 	}
    504   1.1       pk }
    505   1.1       pk 
    506   1.1       pk void
    507   1.1       pk stp4020_queue_event(sc, sock, event)
    508   1.1       pk 	struct stp4020_softc *sc;
    509   1.1       pk 	int sock, event;
    510   1.1       pk {
    511   1.1       pk 	struct stp4020_event *e;
    512   1.1       pk 	int s;
    513   1.1       pk 
    514   1.1       pk 	e = malloc(sizeof(*e), M_TEMP, M_NOWAIT);
    515   1.1       pk 	if (e == NULL)
    516   1.1       pk 		panic("stp4020_queue_event: can't allocate event");
    517   1.1       pk 
    518   1.1       pk 	e->se_type = event;
    519   1.1       pk 	e->se_sock = sock;
    520   1.1       pk 	s = splhigh();
    521   1.1       pk 	SIMPLEQ_INSERT_TAIL(&sc->events, e, se_q);
    522   1.1       pk 	splx(s);
    523   1.1       pk 	wakeup(&sc->events);
    524   1.1       pk }
    525   1.1       pk 
    526   1.1       pk int
    527   1.1       pk stp4020_statintr(arg)
    528   1.1       pk 	void *arg;
    529   1.1       pk {
    530   1.1       pk 	struct stp4020_softc *sc = arg;
    531   1.1       pk 	int i, r = 0;
    532   1.1       pk 
    533   1.1       pk 	/*
    534   1.1       pk 	 * Check each socket for pending requests.
    535   1.1       pk 	 */
    536   1.1       pk 	for (i = 0 ; i < STP4020_NSOCK; i++) {
    537   1.1       pk 		struct stp4020_socket *h;
    538  1.18   martin 		int v, cd_change = 0;
    539   1.1       pk 
    540   1.1       pk 		h = &sc->sc_socks[i];
    541   1.1       pk 
    542   1.1       pk 		/* Read socket's ISR0 for the interrupt status bits */
    543   1.1       pk 		v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    544   1.1       pk 
    545   1.1       pk #ifdef STP4020_DEBUG
    546   1.1       pk 		if (stp4020_debug != 0) {
    547   1.1       pk 			char bits[64];
    548   1.1       pk 			bitmask_snprintf(v, STP4020_ISR0_IOBITS,
    549   1.1       pk 					 bits, sizeof(bits));
    550   1.1       pk 			printf("stp4020_statintr: ISR0=%s\n", bits);
    551   1.1       pk 		}
    552   1.1       pk #endif
    553   1.1       pk 
    554   1.1       pk 		/* Ack all interrupts at once */
    555  1.18   martin 		stp4020_wr_sockctl(h, STP4020_ISR0_IDX, STP4020_ISR0_ALL_STATUS_IRQ);
    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.1       pk 
    579  1.18   martin 		/* informational messages */
    580   1.1       pk 		if ((v & STP4020_ISR0_BVD1CHG) != 0) {
    581  1.18   martin 			/* ignore if this is caused by insert or removal */
    582  1.18   martin 			if (!cd_change)
    583  1.18   martin 				printf("stp4020[%d]: Battery change 1\n", h->sock);
    584  1.15   martin 			r = 1;
    585   1.1       pk 		}
    586   1.1       pk 
    587   1.1       pk 		if ((v & STP4020_ISR0_BVD2CHG) != 0) {
    588  1.18   martin 			/* ignore if this is caused by insert or removal */
    589  1.18   martin 			if (!cd_change)
    590  1.18   martin 				printf("stp4020[%d]: Battery change 2\n", h->sock);
    591  1.15   martin 			r = 1;
    592   1.1       pk 		}
    593   1.1       pk 
    594   1.1       pk 		if ((v & STP4020_ISR0_RDYCHG) != 0) {
    595  1.18   martin 			DPRINTF(("stp4020[%d]: Ready/Busy change\n", h->sock));
    596  1.15   martin 			r = 1;
    597   1.1       pk 		}
    598   1.1       pk 
    599   1.1       pk 		if ((v & STP4020_ISR0_WPCHG) != 0) {
    600  1.18   martin 			DPRINTF(("stp4020[%d]: Write protect change\n", h->sock));
    601  1.15   martin 			r = 1;
    602   1.1       pk 		}
    603   1.1       pk 
    604   1.1       pk 		if ((v & STP4020_ISR0_PCTO) != 0) {
    605  1.18   martin 			DPRINTF(("stp4020[%d]: Card access timeout\n", h->sock));
    606  1.15   martin 			r = 1;
    607   1.1       pk 		}
    608  1.18   martin 
    609   1.1       pk 	}
    610   1.1       pk 
    611   1.1       pk 	return (r);
    612   1.1       pk }
    613   1.1       pk 
    614   1.1       pk int
    615   1.1       pk stp4020_iointr(arg)
    616   1.1       pk 	void *arg;
    617   1.1       pk {
    618   1.1       pk 	struct stp4020_softc *sc = arg;
    619  1.22   martin 	int i, r = 0;
    620   1.1       pk 
    621   1.1       pk 	/*
    622   1.1       pk 	 * Check each socket for pending requests.
    623   1.1       pk 	 */
    624   1.1       pk 	for (i = 0 ; i < STP4020_NSOCK; i++) {
    625   1.1       pk 		struct stp4020_socket *h;
    626   1.1       pk 		int v;
    627   1.1       pk 
    628   1.1       pk 		h = &sc->sc_socks[i];
    629   1.1       pk 		v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    630   1.1       pk 
    631   1.1       pk 		if ((v & STP4020_ISR0_IOINT) != 0) {
    632  1.18   martin 			/* we can not deny this is ours, no matter what the
    633  1.18   martin 			   card driver says. */
    634  1.18   martin 			r = 1;
    635  1.22   martin 
    636  1.18   martin 			/* ack interrupt */
    637  1.18   martin 			stp4020_wr_sockctl(h, STP4020_ISR0_IDX, v);
    638  1.18   martin 
    639   1.1       pk 			/* It's a card interrupt */
    640   1.1       pk 			if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
    641   1.1       pk 				printf("stp4020[%d]: spurious interrupt?\n",
    642   1.1       pk 					h->sock);
    643   1.1       pk 				continue;
    644   1.1       pk 			}
    645   1.1       pk 			/* Call card handler, if any */
    646  1.15   martin 			if (h->intrhandler != NULL) {
    647  1.22   martin 				/*
    648  1.22   martin 				 * Called without handling of it's requested
    649  1.22   martin 				 * protection level (h->ipl), since we have
    650  1.22   martin 				 * no general queuing mechanism available
    651  1.22   martin 				 * right now and we know for sure we are
    652  1.22   martin 				 * running at a higher protection level
    653  1.22   martin 				 * right now.
    654  1.22   martin 				 */
    655  1.19   martin 				(*h->intrhandler)(h->intrarg);
    656  1.15   martin 			}
    657   1.1       pk 		}
    658   1.1       pk 
    659   1.1       pk 	}
    660   1.1       pk 
    661   1.1       pk 	return (r);
    662   1.1       pk }
    663   1.1       pk 
    664  1.16   martin /*
    665  1.16   martin  * The function gets the sbus speed and a access time and calculates
    666  1.16   martin  * values for the CMDLNG and CMDDLAY registers.
    667  1.16   martin  */
    668  1.15   martin static void
    669  1.16   martin stp4020_calc_speed(int bus_speed, int ns, int *length, int *delay)
    670   1.1       pk {
    671  1.16   martin 	int result;
    672  1.16   martin 
    673  1.16   martin 	if (ns < STP4020_MEM_SPEED_MIN)
    674  1.16   martin 		ns = STP4020_MEM_SPEED_MIN;
    675  1.16   martin 	else if (ns > STP4020_MEM_SPEED_MAX)
    676  1.16   martin 		ns = STP4020_MEM_SPEED_MAX;
    677  1.16   martin 	result = ns*(bus_speed/1000);
    678  1.16   martin 	if (result % 1000000)
    679  1.16   martin 		result = result/1000000 + 1;
    680  1.16   martin 	else
    681  1.16   martin 		result /= 1000000;
    682  1.16   martin 	*length = result;
    683  1.16   martin 
    684  1.16   martin 	/* the sbus frequency range is limited, so we can keep this simple */
    685  1.16   martin 	*delay = ns <= STP4020_MEM_SPEED_MIN? 1 : 2;
    686  1.16   martin }
    687  1.15   martin 
    688  1.16   martin static void
    689  1.16   martin stp4020_map_window(struct stp4020_socket *h, int win, int speed)
    690  1.16   martin {
    691  1.16   martin 	int v, length, delay;
    692  1.15   martin 
    693  1.15   martin 	/*
    694  1.16   martin 	 * According to the PC Card standard 300ns access timing should be
    695  1.16   martin 	 * used for attribute memory access. Our pcmcia framework does not
    696  1.16   martin 	 * seem to propagate timing information, so we use that
    697  1.16   martin 	 * everywhere.
    698  1.15   martin 	 */
    699  1.16   martin 	stp4020_calc_speed(speed, 300, &length, &delay);
    700   1.1       pk 
    701   1.1       pk 	/*
    702  1.15   martin 	 * Fill in the Address Space Select and Base Address
    703  1.15   martin 	 * fields of this windows control register 0.
    704   1.1       pk 	 */
    705  1.16   martin 	v = ((delay << STP4020_WCR0_CMDDLY_S)&STP4020_WCR0_CMDDLY_M)
    706  1.16   martin 	    | ((length << STP4020_WCR0_CMDLNG_S)&STP4020_WCR0_CMDLNG_M);
    707  1.15   martin 	switch (win) {
    708  1.15   martin 	case STP_WIN_ATTR:
    709  1.15   martin 		v |= STP4020_WCR0_ASPSEL_AM;
    710  1.15   martin 		break;
    711  1.15   martin 	case STP_WIN_MEM:
    712  1.15   martin 		v |= STP4020_WCR0_ASPSEL_CM;
    713  1.15   martin 		break;
    714  1.15   martin 	case STP_WIN_IO:
    715  1.15   martin 		v |= STP4020_WCR0_ASPSEL_IO;
    716  1.15   martin 		break;
    717  1.15   martin 	}
    718  1.15   martin 	v |= (STP4020_ADDR2PAGE(0) & STP4020_WCR0_BASE_M);
    719  1.15   martin 	stp4020_wr_winctl(h, win, STP4020_WCR0_IDX, v);
    720  1.16   martin 	stp4020_wr_winctl(h, win, STP4020_WCR1_IDX, 1<<STP4020_WCR1_WAITREQ_S);
    721  1.15   martin }
    722   1.1       pk 
    723  1.15   martin int
    724  1.15   martin stp4020_chip_mem_alloc(pch, size, pcmhp)
    725  1.15   martin 	pcmcia_chipset_handle_t pch;
    726  1.15   martin 	bus_size_t size;
    727  1.15   martin 	struct pcmcia_mem_handle *pcmhp;
    728  1.15   martin {
    729  1.15   martin 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    730   1.1       pk 
    731  1.15   martin 	/* we can not do much here, defere work to _mem_map */
    732  1.15   martin 	pcmhp->memt = h->tag;
    733   1.1       pk 	pcmhp->size = size;
    734  1.19   martin 	pcmhp->addr = 0;
    735  1.19   martin 	pcmhp->mhandle = 0;
    736  1.19   martin 	pcmhp->realsize = size;
    737   1.1       pk 
    738   1.1       pk 	return (0);
    739   1.1       pk }
    740   1.1       pk 
    741   1.1       pk void
    742   1.1       pk stp4020_chip_mem_free(pch, pcmhp)
    743   1.1       pk 	pcmcia_chipset_handle_t pch;
    744   1.1       pk 	struct pcmcia_mem_handle *pcmhp;
    745   1.1       pk {
    746   1.1       pk }
    747   1.1       pk 
    748   1.1       pk int
    749   1.1       pk stp4020_chip_mem_map(pch, kind, card_addr, size, pcmhp, offsetp, windowp)
    750   1.1       pk 	pcmcia_chipset_handle_t pch;
    751   1.1       pk 	int kind;
    752   1.1       pk 	bus_addr_t card_addr;
    753   1.1       pk 	bus_size_t size;
    754   1.1       pk 	struct pcmcia_mem_handle *pcmhp;
    755  1.14    soren 	bus_size_t *offsetp;
    756   1.1       pk 	int *windowp;
    757   1.1       pk {
    758   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    759  1.15   martin 	int win = (kind&PCMCIA_MEM_ATTR)? STP_WIN_ATTR : STP_WIN_MEM;
    760   1.8     joda 
    761  1.15   martin 	pcmhp->memt = h->tag;
    762  1.15   martin 	bus_space_subregion(h->tag, h->windows[win].winaddr, card_addr, size, &pcmhp->memh);
    763  1.19   martin 	pcmhp->size = size;
    764  1.19   martin 	pcmhp->realsize = STP4020_WINDOW_SIZE - card_addr;
    765  1.15   martin 	*offsetp = 0;
    766  1.15   martin 	*windowp = 0;
    767   1.1       pk 
    768   1.1       pk 	return (0);
    769   1.1       pk }
    770   1.1       pk 
    771   1.1       pk void
    772   1.1       pk stp4020_chip_mem_unmap(pch, win)
    773   1.1       pk 	pcmcia_chipset_handle_t pch;
    774   1.1       pk 	int win;
    775   1.1       pk {
    776   1.1       pk }
    777   1.1       pk 
    778   1.1       pk int
    779   1.1       pk stp4020_chip_io_alloc(pch, start, size, align, pcihp)
    780   1.1       pk 	pcmcia_chipset_handle_t pch;
    781   1.1       pk 	bus_addr_t start;
    782   1.1       pk 	bus_size_t size;
    783   1.1       pk 	bus_size_t align;
    784   1.1       pk 	struct pcmcia_io_handle *pcihp;
    785   1.1       pk {
    786   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    787   1.1       pk 
    788   1.1       pk 	pcihp->iot = h->tag;
    789  1.15   martin 	pcihp->ioh = h->windows[STP_WIN_IO].winaddr;
    790  1.15   martin 	return 0;
    791   1.1       pk }
    792   1.1       pk 
    793   1.1       pk void
    794   1.1       pk stp4020_chip_io_free(pch, pcihp)
    795   1.1       pk 	pcmcia_chipset_handle_t pch;
    796   1.1       pk 	struct pcmcia_io_handle *pcihp;
    797   1.1       pk {
    798   1.1       pk }
    799   1.1       pk 
    800   1.1       pk int
    801   1.1       pk stp4020_chip_io_map(pch, width, offset, size, pcihp, windowp)
    802   1.1       pk 	pcmcia_chipset_handle_t pch;
    803   1.1       pk 	int width;
    804   1.1       pk 	bus_addr_t offset;
    805   1.1       pk 	bus_size_t size;
    806   1.1       pk 	struct pcmcia_io_handle *pcihp;
    807   1.1       pk 	int *windowp;
    808   1.1       pk {
    809   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    810   1.1       pk 
    811  1.15   martin 	pcihp->iot = h->tag;
    812  1.15   martin 	bus_space_subregion(h->tag, h->windows[STP_WIN_IO].winaddr, offset, size, &pcihp->ioh);
    813  1.15   martin 	*windowp = 0;
    814  1.15   martin 	return 0;
    815   1.1       pk }
    816   1.1       pk 
    817   1.1       pk void
    818   1.1       pk stp4020_chip_io_unmap(pch, win)
    819   1.1       pk 	pcmcia_chipset_handle_t pch;
    820   1.1       pk 	int win;
    821   1.1       pk {
    822   1.1       pk }
    823   1.1       pk 
    824   1.1       pk void
    825   1.1       pk stp4020_chip_socket_enable(pch)
    826   1.1       pk 	pcmcia_chipset_handle_t pch;
    827   1.1       pk {
    828   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    829  1.18   martin 	int i, v;
    830   1.1       pk 
    831   1.1       pk 	/* this bit is mostly stolen from pcic_attach_card */
    832   1.1       pk 
    833   1.1       pk 	/* Power down the socket to reset it, clear the card reset pin */
    834  1.18   martin 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
    835   1.1       pk 
    836   1.1       pk 	/*
    837   1.1       pk 	 * wait 300ms until power fails (Tpf).  Then, wait 100ms since
    838   1.1       pk 	 * we are changing Vcc (Toff).
    839   1.1       pk 	 */
    840   1.1       pk 	stp4020_delay((300 + 100) * 1000);
    841   1.1       pk 
    842   1.1       pk 	/* Power up the socket */
    843  1.18   martin 	v = STP4020_ICR1_MSTPWR;
    844   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    845   1.1       pk 
    846   1.1       pk 	/*
    847   1.1       pk 	 * wait 100ms until power raise (Tpr) and 20ms to become
    848   1.1       pk 	 * stable (Tsu(Vcc)).
    849   1.1       pk 	 */
    850   1.1       pk 	stp4020_delay((100 + 20) * 1000);
    851   1.1       pk 
    852  1.18   martin 	v |= STP4020_ICR1_PCIFOE|STP4020_ICR1_VPP1_VCC;
    853   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
    854   1.1       pk 
    855   1.1       pk 	/*
    856   1.1       pk 	 * hold RESET at least 10us.
    857   1.1       pk 	 */
    858   1.1       pk 	delay(10);
    859   1.1       pk 
    860   1.1       pk 	/* Clear reset flag */
    861   1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    862   1.1       pk 	v &= ~STP4020_ICR0_RESET;
    863   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    864   1.1       pk 
    865   1.1       pk 	/* wait 20ms as per pc card standard (r2.01) section 4.3.6 */
    866   1.1       pk 	stp4020_delay(20000);
    867   1.1       pk 
    868   1.1       pk 	/* Wait for the chip to finish initializing (5 seconds max) */
    869   1.1       pk 	for (i = 10000; i > 0; i--) {
    870   1.1       pk 		v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
    871   1.1       pk 		if ((v & STP4020_ISR0_RDYST) != 0)
    872   1.1       pk 			break;
    873   1.1       pk 		delay(500);
    874   1.1       pk 	}
    875   1.1       pk 	if (i <= 0) {
    876   1.1       pk 		char bits[64];
    877   1.1       pk 		bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
    878   1.1       pk 				 STP4020_ISR0_IOBITS, bits, sizeof(bits));
    879   1.1       pk 		printf("stp4020_chip_socket_enable: not ready: status %s\n",
    880   1.1       pk 			bits);
    881   1.1       pk 		return;
    882   1.1       pk 	}
    883   1.1       pk 
    884   1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    885   1.1       pk 
    886   1.1       pk 	/*
    887  1.18   martin 	 * Check the card type.
    888  1.18   martin 	 * Enable socket I/O interrupts for IO cards.
    889   1.1       pk 	 * We use level SB_INT[0] for I/O interrupts.
    890   1.1       pk 	 */
    891  1.18   martin 	if (pcmcia_card_gettype(h->pcmcia) == PCMCIA_IFTYPE_IO) {
    892  1.18   martin 		v &= ~(STP4020_ICR0_IOILVL|STP4020_ICR0_IFTYPE);
    893  1.18   martin 		v |= STP4020_ICR0_IFTYPE_IO|STP4020_ICR0_IOIE
    894  1.18   martin 		    |STP4020_ICR0_IOILVL_SB0|STP4020_ICR0_SPKREN;
    895  1.18   martin 		DPRINTF(("%s: configuring card for IO useage\n", h->sc->sc_dev.dv_xname));
    896  1.18   martin 	} else {
    897  1.18   martin 		v &= ~(STP4020_ICR0_IOILVL|STP4020_ICR0_IFTYPE
    898  1.18   martin 		    |STP4020_ICR0_SPKREN|STP4020_ICR0_IOILVL_SB0
    899  1.18   martin 		    |STP4020_ICR0_IOILVL_SB1|STP4020_ICR0_SPKREN);
    900  1.18   martin 		v |= STP4020_ICR0_IFTYPE_MEM;
    901  1.18   martin 		DPRINTF(("%s: configuring card for MEM ONLY useage\n", h->sc->sc_dev.dv_xname));
    902  1.18   martin 	}
    903   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    904   1.1       pk }
    905   1.1       pk 
    906   1.1       pk void
    907   1.1       pk stp4020_chip_socket_disable(pch)
    908   1.1       pk 	pcmcia_chipset_handle_t pch;
    909   1.1       pk {
    910   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    911   1.1       pk 	int v;
    912   1.1       pk 
    913   1.1       pk 	/*
    914   1.1       pk 	 * Disable socket I/O interrupts.
    915   1.1       pk 	 */
    916   1.1       pk 	v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
    917   1.1       pk 	v &= ~(STP4020_ICR0_IOIE | STP4020_ICR0_IOILVL);
    918   1.1       pk 	stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
    919   1.1       pk 
    920   1.1       pk 	/* Power down the socket */
    921  1.18   martin 	stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
    922   1.1       pk 
    923   1.1       pk 	/*
    924   1.1       pk 	 * wait 300ms until power fails (Tpf).
    925   1.1       pk 	 */
    926   1.1       pk 	stp4020_delay(300 * 1000);
    927   1.1       pk }
    928   1.1       pk 
    929   1.1       pk void *
    930   1.1       pk stp4020_chip_intr_establish(pch, pf, ipl, handler, arg)
    931   1.1       pk 	pcmcia_chipset_handle_t pch;
    932   1.1       pk 	struct pcmcia_function *pf;
    933   1.1       pk 	int ipl;
    934   1.1       pk 	int (*handler) __P((void *));
    935   1.1       pk 	void *arg;
    936   1.1       pk {
    937   1.1       pk 	struct stp4020_socket *h = (struct stp4020_socket *)pch;
    938   1.1       pk 
    939   1.1       pk 	h->intrhandler = handler;
    940   1.1       pk 	h->intrarg = arg;
    941   1.1       pk 	h->ipl = ipl;
    942  1.16   martin 	return h;
    943   1.1       pk }
    944   1.1       pk 
    945   1.1       pk void
    946   1.1       pk stp4020_chip_intr_disestablish(pch, ih)
    947   1.1       pk 	pcmcia_chipset_handle_t pch;
    948   1.1       pk 	void *ih;
    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 = NULL;
    953   1.1       pk 	h->intrarg = NULL;
    954   1.1       pk }
    955   1.1       pk 
    956   1.1       pk /*
    957   1.1       pk  * Delay and possibly yield CPU.
    958   1.1       pk  * XXX - assumes a context
    959   1.1       pk  */
    960   1.1       pk void
    961   1.1       pk stp4020_delay(ms)
    962   1.1       pk 	unsigned int ms;
    963   1.1       pk {
    964   1.1       pk 	unsigned int ticks;
    965   1.1       pk 
    966   1.1       pk 	/* Convert to ticks */
    967   1.1       pk 	ticks = (ms * hz ) / 1000000;
    968   1.1       pk 
    969   1.1       pk 	if (cold || ticks == 0) {
    970   1.1       pk 		delay(ms);
    971   1.1       pk 		return;
    972   1.1       pk 	}
    973   1.1       pk 
    974   1.1       pk #ifdef DIAGNOSTIC
    975   1.1       pk 	if (ticks > 60*hz)
    976   1.1       pk 		panic("stp4020: preposterous delay: %u", ticks);
    977   1.1       pk #endif
    978   1.1       pk 	tsleep(&ticks, 0, "stp4020_delay", ticks);
    979   1.1       pk }
    980   1.6       pk 
    981   1.6       pk #ifdef STP4020_DEBUG
    982   1.6       pk void
    983   1.6       pk stp4020_dump_regs(h)
    984   1.6       pk 	struct stp4020_socket *h;
    985   1.6       pk {
    986   1.6       pk 	char bits[64];
    987   1.6       pk 	/*
    988   1.6       pk 	 * Dump control and status registers.
    989   1.6       pk 	 */
    990   1.6       pk 	printf("socket[%d] registers:\n", h->sock);
    991   1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR0_IDX),
    992   1.6       pk 			 STP4020_ICR0_BITS, bits, sizeof(bits));
    993   1.6       pk 	printf("\tICR0=%s\n", bits);
    994   1.6       pk 
    995   1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR1_IDX),
    996   1.6       pk 			 STP4020_ICR1_BITS, bits, sizeof(bits));
    997   1.6       pk 	printf("\tICR1=%s\n", bits);
    998   1.6       pk 
    999   1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
   1000   1.6       pk 			 STP4020_ISR0_IOBITS, bits, sizeof(bits));
   1001   1.6       pk 	printf("\tISR0=%s\n", bits);
   1002   1.6       pk 
   1003   1.6       pk 	bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR1_IDX),
   1004   1.6       pk 			 STP4020_ISR1_BITS, bits, sizeof(bits));
   1005   1.6       pk 	printf("\tISR1=%s\n", bits);
   1006   1.6       pk }
   1007   1.6       pk #endif /* STP4020_DEBUG */
   1008