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