de956cbcda
intterupts. No more races between the two interrupt handlers, without any locking, and the driver becomes a bit simpler too. Use the last bit of the config flags to select between the first and the second sbus interrupt level the firmware has assigned to us.
987 lines
25 KiB
C
987 lines
25 KiB
C
/* $NetBSD: stp4020.c,v 1.28 2002/10/10 22:23:16 martin Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1998 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Paul Kranenburg.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
* 3. All advertising materials mentioning features or use of this software
|
|
* must display the following acknowledgement:
|
|
* This product includes software developed by the NetBSD
|
|
* Foundation, Inc. and its contributors.
|
|
* 4. Neither the name of The NetBSD Foundation nor the names of its
|
|
* contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
|
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
|
|
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
|
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGE.
|
|
*/
|
|
|
|
/*
|
|
* STP4020: SBus/PCMCIA bridge supporting two Type-3 PCMCIA cards.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: stp4020.c,v 1.28 2002/10/10 22:23:16 martin Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/extent.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/kthread.h>
|
|
#include <sys/device.h>
|
|
|
|
#include <dev/pcmcia/pcmciareg.h>
|
|
#include <dev/pcmcia/pcmciavar.h>
|
|
#include <dev/pcmcia/pcmciachip.h>
|
|
|
|
#include <machine/bus.h>
|
|
#include <machine/intr.h>
|
|
|
|
#include <dev/sbus/sbusvar.h>
|
|
#include <dev/sbus/stp4020reg.h>
|
|
|
|
#define STP4020_DEBUG 1 /* XXX-temp */
|
|
|
|
/*
|
|
* We use the three available windows per socket in a simple, fixed
|
|
* arrangement. Each window maps (at full 1 MB size) one of the pcmcia
|
|
* spaces into sbus space.
|
|
*/
|
|
#define STP_WIN_ATTR 0 /* index of the attribute memory space window */
|
|
#define STP_WIN_MEM 1 /* index of the common memory space window */
|
|
#define STP_WIN_IO 2 /* index of the io space window */
|
|
|
|
|
|
#if defined(STP4020_DEBUG)
|
|
int stp4020_debug = 0;
|
|
#define DPRINTF(x) do { if (stp4020_debug) printf x; } while(0)
|
|
#else
|
|
#define DPRINTF(x)
|
|
#endif
|
|
|
|
/*
|
|
* Event queue; events detected in an interrupt context go here
|
|
* awaiting attention from our event handling thread.
|
|
*/
|
|
struct stp4020_event {
|
|
SIMPLEQ_ENTRY(stp4020_event) se_q;
|
|
int se_type;
|
|
int se_sock;
|
|
};
|
|
/* Defined event types */
|
|
#define STP4020_EVENT_INSERTION 0
|
|
#define STP4020_EVENT_REMOVAL 1
|
|
|
|
/*
|
|
* Per socket data.
|
|
*/
|
|
struct stp4020_socket {
|
|
struct stp4020_softc *sc; /* Back link */
|
|
int flags;
|
|
#define STP4020_SOCKET_BUSY 0x0001
|
|
#define STP4020_SOCKET_SHUTDOWN 0x0002
|
|
int sock; /* Socket number (0 or 1) */
|
|
int sbus_intno; /* Do we use first (0) or second (1)
|
|
interrupt? */
|
|
bus_space_tag_t tag; /* socket control space */
|
|
bus_space_handle_t regs; /* */
|
|
struct device *pcmcia; /* Associated PCMCIA device */
|
|
int (*intrhandler) /* Card driver interrupt handler */
|
|
__P((void *));
|
|
void *intrarg; /* Card interrupt handler argument */
|
|
int ipl; /* Interrupt level suggested by card */
|
|
struct {
|
|
bus_space_handle_t winaddr;/* this window's address */
|
|
} windows[STP4020_NWIN];
|
|
|
|
};
|
|
|
|
struct stp4020_softc {
|
|
struct device sc_dev; /* Base device */
|
|
struct sbusdev sc_sd; /* SBus device */
|
|
bus_space_tag_t sc_bustag;
|
|
bus_dma_tag_t sc_dmatag;
|
|
pcmcia_chipset_tag_t sc_pct; /* Chipset methods */
|
|
|
|
struct proc *event_thread; /* event handling thread */
|
|
SIMPLEQ_HEAD(, stp4020_event) events; /* Pending events for thread */
|
|
|
|
struct stp4020_socket sc_socks[STP4020_NSOCK];
|
|
};
|
|
|
|
|
|
static int stp4020print __P((void *, const char *));
|
|
static int stp4020match __P((struct device *, struct cfdata *, void *));
|
|
static void stp4020attach __P((struct device *, struct device *, void *));
|
|
static int stp4020_intr __P((void *));
|
|
static void stp4020_map_window(struct stp4020_socket *h, int win, int speed);
|
|
static void stp4020_calc_speed(int bus_speed, int ns, int *length, int *delay);
|
|
|
|
CFATTACH_DECL(nell, sizeof(struct stp4020_softc),
|
|
stp4020match, stp4020attach, NULL, NULL);
|
|
|
|
#ifdef STP4020_DEBUG
|
|
static void stp4020_dump_regs __P((struct stp4020_socket *));
|
|
#endif
|
|
|
|
static int stp4020_rd_sockctl __P((struct stp4020_socket *, int));
|
|
static void stp4020_wr_sockctl __P((struct stp4020_socket *, int, int));
|
|
static int stp4020_rd_winctl __P((struct stp4020_socket *, int, int));
|
|
static void stp4020_wr_winctl __P((struct stp4020_socket *, int, int, int));
|
|
|
|
void stp4020_delay __P((unsigned int));
|
|
void stp4020_attach_socket __P((struct stp4020_socket *, int));
|
|
void stp4020_create_event_thread __P((void *));
|
|
void stp4020_event_thread __P((void *));
|
|
void stp4020_queue_event __P((struct stp4020_softc *, int, int));
|
|
|
|
int stp4020_chip_mem_alloc __P((pcmcia_chipset_handle_t, bus_size_t,
|
|
struct pcmcia_mem_handle *));
|
|
void stp4020_chip_mem_free __P((pcmcia_chipset_handle_t,
|
|
struct pcmcia_mem_handle *));
|
|
int stp4020_chip_mem_map __P((pcmcia_chipset_handle_t, int, bus_addr_t,
|
|
bus_size_t, struct pcmcia_mem_handle *,
|
|
bus_size_t *, int *));
|
|
void stp4020_chip_mem_unmap __P((pcmcia_chipset_handle_t, int));
|
|
|
|
int stp4020_chip_io_alloc __P((pcmcia_chipset_handle_t,
|
|
bus_addr_t, bus_size_t, bus_size_t,
|
|
struct pcmcia_io_handle *));
|
|
void stp4020_chip_io_free __P((pcmcia_chipset_handle_t,
|
|
struct pcmcia_io_handle *));
|
|
int stp4020_chip_io_map __P((pcmcia_chipset_handle_t, int, bus_addr_t,
|
|
bus_size_t, struct pcmcia_io_handle *, int *));
|
|
void stp4020_chip_io_unmap __P((pcmcia_chipset_handle_t, int));
|
|
|
|
void stp4020_chip_socket_enable __P((pcmcia_chipset_handle_t));
|
|
void stp4020_chip_socket_disable __P((pcmcia_chipset_handle_t));
|
|
void *stp4020_chip_intr_establish __P((pcmcia_chipset_handle_t,
|
|
struct pcmcia_function *, int,
|
|
int (*) __P((void *)), void *));
|
|
void stp4020_chip_intr_disestablish __P((pcmcia_chipset_handle_t, void *));
|
|
|
|
/* Our PCMCIA chipset methods */
|
|
static struct pcmcia_chip_functions stp4020_functions = {
|
|
stp4020_chip_mem_alloc,
|
|
stp4020_chip_mem_free,
|
|
stp4020_chip_mem_map,
|
|
stp4020_chip_mem_unmap,
|
|
|
|
stp4020_chip_io_alloc,
|
|
stp4020_chip_io_free,
|
|
stp4020_chip_io_map,
|
|
stp4020_chip_io_unmap,
|
|
|
|
stp4020_chip_intr_establish,
|
|
stp4020_chip_intr_disestablish,
|
|
|
|
stp4020_chip_socket_enable,
|
|
stp4020_chip_socket_disable
|
|
};
|
|
|
|
|
|
static __inline__ int
|
|
stp4020_rd_sockctl(h, idx)
|
|
struct stp4020_socket *h;
|
|
int idx;
|
|
{
|
|
int o = ((STP4020_SOCKREGS_SIZE * (h->sock)) + idx);
|
|
return (bus_space_read_2(h->tag, h->regs, o));
|
|
}
|
|
|
|
static __inline__ void
|
|
stp4020_wr_sockctl(h, idx, v)
|
|
struct stp4020_socket *h;
|
|
int idx;
|
|
int v;
|
|
{
|
|
int o = (STP4020_SOCKREGS_SIZE * (h->sock)) + idx;
|
|
bus_space_write_2(h->tag, h->regs, o, v);
|
|
}
|
|
|
|
static __inline__ int
|
|
stp4020_rd_winctl(h, win, idx)
|
|
struct stp4020_socket *h;
|
|
int win;
|
|
int idx;
|
|
{
|
|
int o = (STP4020_SOCKREGS_SIZE * (h->sock)) +
|
|
(STP4020_WINREGS_SIZE * win) + idx;
|
|
return (bus_space_read_2(h->tag, h->regs, o));
|
|
}
|
|
|
|
static __inline__ void
|
|
stp4020_wr_winctl(h, win, idx, v)
|
|
struct stp4020_socket *h;
|
|
int win;
|
|
int idx;
|
|
int v;
|
|
{
|
|
int o = (STP4020_SOCKREGS_SIZE * (h->sock)) +
|
|
(STP4020_WINREGS_SIZE * win) + idx;
|
|
|
|
bus_space_write_2(h->tag, h->regs, o, v);
|
|
}
|
|
|
|
|
|
int
|
|
stp4020print(aux, busname)
|
|
void *aux;
|
|
const char *busname;
|
|
{
|
|
struct pcmciabus_attach_args *paa = aux;
|
|
struct stp4020_socket *h = paa->pch;
|
|
|
|
printf(" socket %d", h->sock);
|
|
return (UNCONF);
|
|
}
|
|
|
|
int
|
|
stp4020match(parent, cf, aux)
|
|
struct device *parent;
|
|
struct cfdata *cf;
|
|
void *aux;
|
|
{
|
|
struct sbus_attach_args *sa = aux;
|
|
|
|
return (strcmp("SUNW,pcmcia", sa->sa_name) == 0);
|
|
}
|
|
|
|
/*
|
|
* Attach all the sub-devices we can find
|
|
*/
|
|
void
|
|
stp4020attach(parent, self, aux)
|
|
struct device *parent, *self;
|
|
void *aux;
|
|
{
|
|
struct sbus_attach_args *sa = aux;
|
|
struct stp4020_softc *sc = (void *)self;
|
|
int node, rev;
|
|
int i, sbus_intno;
|
|
bus_space_handle_t bh;
|
|
|
|
node = sa->sa_node;
|
|
|
|
/* lsb of our config flags decides which interrupt we use */
|
|
sbus_intno = sc->sc_dev.dv_cfdata->cf_flags & 1;
|
|
|
|
/* Transfer bus tags */
|
|
sc->sc_bustag = sa->sa_bustag;
|
|
sc->sc_dmatag = sa->sa_dmatag;
|
|
|
|
/* Set up per-socket static initialization */
|
|
sc->sc_socks[0].sc = sc->sc_socks[1].sc = sc;
|
|
sc->sc_socks[0].tag = sc->sc_socks[1].tag = sa->sa_bustag;
|
|
sc->sc_socks[0].sbus_intno =
|
|
sc->sc_socks[1].sbus_intno = sbus_intno;
|
|
|
|
if (sa->sa_nreg < 8) {
|
|
printf("%s: only %d register sets\n",
|
|
self->dv_xname, sa->sa_nreg);
|
|
return;
|
|
}
|
|
|
|
if (sa->sa_nintr != 2) {
|
|
printf("%s: expect 2 interrupt Sbus levels; got %d\n",
|
|
self->dv_xname, sa->sa_nintr);
|
|
return;
|
|
}
|
|
|
|
#define STP4020_BANK_PROM 0
|
|
#define STP4020_BANK_CTRL 4
|
|
for (i = 0; i < 8; i++) {
|
|
|
|
/*
|
|
* STP4020 Register address map:
|
|
* bank 0: Forth PROM
|
|
* banks 1-3: socket 0, windows 0-2
|
|
* bank 4: control registers
|
|
* banks 5-7: socket 1, windows 0-2
|
|
*/
|
|
|
|
if (i == STP4020_BANK_PROM)
|
|
/* Skip the PROM */
|
|
continue;
|
|
|
|
if (sbus_bus_map(sa->sa_bustag,
|
|
sa->sa_reg[i].oa_space,
|
|
sa->sa_reg[i].oa_base,
|
|
sa->sa_reg[i].oa_size,
|
|
0, &bh) != 0) {
|
|
printf("%s: attach: cannot map registers\n",
|
|
self->dv_xname);
|
|
return;
|
|
}
|
|
|
|
if (i == STP4020_BANK_CTRL) {
|
|
/*
|
|
* Copy tag and handle to both socket structures
|
|
* for easy access in control/status IO functions.
|
|
*/
|
|
sc->sc_socks[0].regs = sc->sc_socks[1].regs = bh;
|
|
} else if (i < STP4020_BANK_CTRL) {
|
|
/* banks 1-3 */
|
|
sc->sc_socks[0].windows[i-1].winaddr = bh;
|
|
} else {
|
|
/* banks 5-7 */
|
|
sc->sc_socks[1].windows[i-5].winaddr = bh;
|
|
}
|
|
}
|
|
|
|
sbus_establish(&sc->sc_sd, &sc->sc_dev);
|
|
|
|
/* We only use one interrupt level. */
|
|
if (sa->sa_nintr > sbus_intno) {
|
|
bus_intr_establish(sa->sa_bustag,
|
|
sa->sa_intr[sbus_intno].oi_pri,
|
|
IPL_NONE, 0, stp4020_intr, sc);
|
|
}
|
|
|
|
rev = stp4020_rd_sockctl(&sc->sc_socks[0], STP4020_ISR1_IDX) &
|
|
STP4020_ISR1_REV_M;
|
|
printf(": rev %x\n", rev);
|
|
|
|
sc->sc_pct = (pcmcia_chipset_tag_t)&stp4020_functions;
|
|
|
|
/*
|
|
* Arrange that a kernel thread be created to handle
|
|
* insert/removal events.
|
|
*/
|
|
SIMPLEQ_INIT(&sc->events);
|
|
kthread_create(stp4020_create_event_thread, sc);
|
|
|
|
for (i = 0; i < STP4020_NSOCK; i++) {
|
|
struct stp4020_socket *h = &sc->sc_socks[i];
|
|
h->sock = i;
|
|
h->sc = sc;
|
|
#ifdef STP4020_DEBUG
|
|
if (stp4020_debug)
|
|
stp4020_dump_regs(h);
|
|
#endif
|
|
stp4020_attach_socket(h, sa->sa_frequency);
|
|
}
|
|
}
|
|
|
|
void
|
|
stp4020_attach_socket(h, speed)
|
|
struct stp4020_socket *h;
|
|
int speed;
|
|
{
|
|
struct pcmciabus_attach_args paa;
|
|
int v;
|
|
|
|
/* Map all three windows */
|
|
stp4020_map_window(h, STP_WIN_ATTR, speed);
|
|
stp4020_map_window(h, STP_WIN_MEM, speed);
|
|
stp4020_map_window(h, STP_WIN_IO, speed);
|
|
|
|
/* Configure one pcmcia device per socket */
|
|
paa.paa_busname = "pcmcia";
|
|
paa.pct = (pcmcia_chipset_tag_t)h->sc->sc_pct;
|
|
paa.pch = (pcmcia_chipset_handle_t)h;
|
|
paa.iobase = 0;
|
|
paa.iosize = STP4020_WINDOW_SIZE;
|
|
|
|
h->pcmcia = config_found(&h->sc->sc_dev, &paa, stp4020print);
|
|
|
|
if (h->pcmcia == NULL)
|
|
return;
|
|
|
|
/*
|
|
* There's actually a pcmcia bus attached; initialize the slot.
|
|
*/
|
|
|
|
/*
|
|
* Clear things up before we enable status change interrupts.
|
|
* This seems to not be fully initialized by the PROM.
|
|
*/
|
|
stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
|
|
stp4020_wr_sockctl(h, STP4020_ICR0_IDX, 0);
|
|
stp4020_wr_sockctl(h, STP4020_ISR1_IDX, 0x3fff);
|
|
stp4020_wr_sockctl(h, STP4020_ISR0_IDX, 0x3fff);
|
|
|
|
/*
|
|
* Enable socket status change interrupts.
|
|
* We only use one common interrupt for status change
|
|
* and IO, to avoid locking issues.
|
|
*/
|
|
v = STP4020_ICR0_ALL_STATUS_IE
|
|
| (h->sbus_intno ? STP4020_ICR0_SCILVL_SB1
|
|
: STP4020_ICR0_SCILVL_SB0);
|
|
stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
|
|
|
|
/* Get live status bits from ISR0 */
|
|
v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
|
|
if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0)
|
|
return;
|
|
|
|
pcmcia_card_attach(h->pcmcia);
|
|
h->flags |= STP4020_SOCKET_BUSY;
|
|
}
|
|
|
|
|
|
/*
|
|
* Deferred thread creation callback.
|
|
*/
|
|
void
|
|
stp4020_create_event_thread(arg)
|
|
void *arg;
|
|
{
|
|
struct stp4020_softc *sc = arg;
|
|
const char *name = sc->sc_dev.dv_xname;
|
|
|
|
if (kthread_create1(stp4020_event_thread, sc, &sc->event_thread,
|
|
"%s", name)) {
|
|
panic("%s: unable to create event thread", name);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* The actual event handling thread.
|
|
*/
|
|
void
|
|
stp4020_event_thread(arg)
|
|
void *arg;
|
|
{
|
|
struct stp4020_softc *sc = arg;
|
|
struct stp4020_event *e;
|
|
int s;
|
|
|
|
while (1) {
|
|
struct stp4020_socket *h;
|
|
int n;
|
|
|
|
s = splhigh();
|
|
if ((e = SIMPLEQ_FIRST(&sc->events)) == NULL) {
|
|
splx(s);
|
|
(void)tsleep(&sc->events, PWAIT, "pcicev", 0);
|
|
continue;
|
|
}
|
|
SIMPLEQ_REMOVE_HEAD(&sc->events, se_q);
|
|
splx(s);
|
|
|
|
n = e->se_sock;
|
|
if (n < 0 || n >= STP4020_NSOCK)
|
|
panic("stp4020_event_thread: wayward socket number %d",
|
|
n);
|
|
|
|
h = &sc->sc_socks[n];
|
|
switch (e->se_type) {
|
|
case STP4020_EVENT_INSERTION:
|
|
pcmcia_card_attach(h->pcmcia);
|
|
break;
|
|
case STP4020_EVENT_REMOVAL:
|
|
pcmcia_card_detach(h->pcmcia, DETACH_FORCE);
|
|
break;
|
|
default:
|
|
panic("stp4020_event_thread: unknown event type %d",
|
|
e->se_type);
|
|
}
|
|
free(e, M_TEMP);
|
|
}
|
|
}
|
|
|
|
void
|
|
stp4020_queue_event(sc, sock, event)
|
|
struct stp4020_softc *sc;
|
|
int sock, event;
|
|
{
|
|
struct stp4020_event *e;
|
|
int s;
|
|
|
|
e = malloc(sizeof(*e), M_TEMP, M_NOWAIT);
|
|
if (e == NULL)
|
|
panic("stp4020_queue_event: can't allocate event");
|
|
|
|
e->se_type = event;
|
|
e->se_sock = sock;
|
|
s = splhigh();
|
|
SIMPLEQ_INSERT_TAIL(&sc->events, e, se_q);
|
|
splx(s);
|
|
wakeup(&sc->events);
|
|
}
|
|
|
|
int
|
|
stp4020_intr(arg)
|
|
void *arg;
|
|
{
|
|
struct stp4020_softc *sc = arg;
|
|
int i, r = 0, cd_change = 0;
|
|
|
|
/*
|
|
* Check each socket for pending requests.
|
|
*/
|
|
for (i = 0 ; i < STP4020_NSOCK; i++) {
|
|
struct stp4020_socket *h;
|
|
int v;
|
|
|
|
h = &sc->sc_socks[i];
|
|
v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
|
|
|
|
/* Ack all interrupts at once */
|
|
stp4020_wr_sockctl(h, STP4020_ISR0_IDX, STP4020_ISR0_ALL_STATUS_IRQ);
|
|
|
|
#ifdef STP4020_DEBUG
|
|
if (stp4020_debug != 0) {
|
|
char bits[64];
|
|
bitmask_snprintf(v, STP4020_ISR0_IOBITS,
|
|
bits, sizeof(bits));
|
|
printf("stp4020_statintr: ISR0=%s\n", bits);
|
|
}
|
|
#endif
|
|
|
|
if ((v & STP4020_ISR0_CDCHG) != 0) {
|
|
/*
|
|
* Card status change detect
|
|
*/
|
|
cd_change = 1;
|
|
r = 1;
|
|
if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)){
|
|
if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
|
|
stp4020_queue_event(sc, i,
|
|
STP4020_EVENT_INSERTION);
|
|
h->flags |= STP4020_SOCKET_BUSY;
|
|
}
|
|
}
|
|
if ((v & (STP4020_ISR0_CD1ST|STP4020_ISR0_CD2ST)) == 0){
|
|
if ((h->flags & STP4020_SOCKET_BUSY) != 0) {
|
|
stp4020_queue_event(sc, i,
|
|
STP4020_EVENT_REMOVAL);
|
|
h->flags &= ~STP4020_SOCKET_BUSY;
|
|
}
|
|
}
|
|
}
|
|
|
|
if ((v & STP4020_ISR0_IOINT) != 0) {
|
|
/* we can not deny this is ours, no matter what the
|
|
card driver says. */
|
|
r = 1;
|
|
|
|
/* ack interrupt */
|
|
stp4020_wr_sockctl(h, STP4020_ISR0_IDX, v);
|
|
|
|
/* It's a card interrupt */
|
|
if ((h->flags & STP4020_SOCKET_BUSY) == 0) {
|
|
printf("stp4020[%d]: spurious interrupt?\n",
|
|
h->sock);
|
|
continue;
|
|
}
|
|
/* Call card handler, if any */
|
|
if (h->intrhandler != NULL) {
|
|
/*
|
|
* Called without handling of it's requested
|
|
* protection level (h->ipl), since we have
|
|
* no general queuing mechanism available
|
|
* right now and we know for sure we are
|
|
* running at a higher protection level
|
|
* right now.
|
|
*/
|
|
(*h->intrhandler)(h->intrarg);
|
|
}
|
|
}
|
|
|
|
/* informational messages */
|
|
if ((v & STP4020_ISR0_BVD1CHG) != 0) {
|
|
/* ignore if this is caused by insert or removal */
|
|
if (!cd_change)
|
|
printf("stp4020[%d]: Battery change 1\n", h->sock);
|
|
r = 1;
|
|
}
|
|
|
|
if ((v & STP4020_ISR0_BVD2CHG) != 0) {
|
|
/* ignore if this is caused by insert or removal */
|
|
if (!cd_change)
|
|
printf("stp4020[%d]: Battery change 2\n", h->sock);
|
|
r = 1;
|
|
}
|
|
|
|
if ((v & STP4020_ISR0_RDYCHG) != 0) {
|
|
DPRINTF(("stp4020[%d]: Ready/Busy change\n", h->sock));
|
|
r = 1;
|
|
}
|
|
|
|
if ((v & STP4020_ISR0_WPCHG) != 0) {
|
|
DPRINTF(("stp4020[%d]: Write protect change\n", h->sock));
|
|
r = 1;
|
|
}
|
|
|
|
if ((v & STP4020_ISR0_PCTO) != 0) {
|
|
DPRINTF(("stp4020[%d]: Card access timeout\n", h->sock));
|
|
r = 1;
|
|
}
|
|
|
|
}
|
|
|
|
return (r);
|
|
}
|
|
|
|
/*
|
|
* The function gets the sbus speed and a access time and calculates
|
|
* values for the CMDLNG and CMDDLAY registers.
|
|
*/
|
|
static void
|
|
stp4020_calc_speed(int bus_speed, int ns, int *length, int *delay)
|
|
{
|
|
int result;
|
|
|
|
if (ns < STP4020_MEM_SPEED_MIN)
|
|
ns = STP4020_MEM_SPEED_MIN;
|
|
else if (ns > STP4020_MEM_SPEED_MAX)
|
|
ns = STP4020_MEM_SPEED_MAX;
|
|
result = ns*(bus_speed/1000);
|
|
if (result % 1000000)
|
|
result = result/1000000 + 1;
|
|
else
|
|
result /= 1000000;
|
|
*length = result;
|
|
|
|
/* the sbus frequency range is limited, so we can keep this simple */
|
|
*delay = ns <= STP4020_MEM_SPEED_MIN? 1 : 2;
|
|
}
|
|
|
|
static void
|
|
stp4020_map_window(struct stp4020_socket *h, int win, int speed)
|
|
{
|
|
int v, length, delay;
|
|
|
|
/*
|
|
* According to the PC Card standard 300ns access timing should be
|
|
* used for attribute memory access. Our pcmcia framework does not
|
|
* seem to propagate timing information, so we use that
|
|
* everywhere.
|
|
*/
|
|
stp4020_calc_speed(speed, (win==STP_WIN_ATTR)? 300 : 100, &length, &delay);
|
|
|
|
/*
|
|
* Fill in the Address Space Select and Base Address
|
|
* fields of this windows control register 0.
|
|
*/
|
|
v = ((delay << STP4020_WCR0_CMDDLY_S)&STP4020_WCR0_CMDDLY_M)
|
|
| ((length << STP4020_WCR0_CMDLNG_S)&STP4020_WCR0_CMDLNG_M);
|
|
switch (win) {
|
|
case STP_WIN_ATTR:
|
|
v |= STP4020_WCR0_ASPSEL_AM;
|
|
break;
|
|
case STP_WIN_MEM:
|
|
v |= STP4020_WCR0_ASPSEL_CM;
|
|
break;
|
|
case STP_WIN_IO:
|
|
v |= STP4020_WCR0_ASPSEL_IO;
|
|
break;
|
|
}
|
|
v |= (STP4020_ADDR2PAGE(0) & STP4020_WCR0_BASE_M);
|
|
stp4020_wr_winctl(h, win, STP4020_WCR0_IDX, v);
|
|
stp4020_wr_winctl(h, win, STP4020_WCR1_IDX, 1<<STP4020_WCR1_WAITREQ_S);
|
|
}
|
|
|
|
int
|
|
stp4020_chip_mem_alloc(pch, size, pcmhp)
|
|
pcmcia_chipset_handle_t pch;
|
|
bus_size_t size;
|
|
struct pcmcia_mem_handle *pcmhp;
|
|
{
|
|
struct stp4020_socket *h = (struct stp4020_socket *)pch;
|
|
|
|
/* we can not do much here, defere work to _mem_map */
|
|
pcmhp->memt = h->tag;
|
|
pcmhp->size = size;
|
|
pcmhp->addr = 0;
|
|
pcmhp->mhandle = 0;
|
|
pcmhp->realsize = size;
|
|
|
|
return (0);
|
|
}
|
|
|
|
void
|
|
stp4020_chip_mem_free(pch, pcmhp)
|
|
pcmcia_chipset_handle_t pch;
|
|
struct pcmcia_mem_handle *pcmhp;
|
|
{
|
|
}
|
|
|
|
int
|
|
stp4020_chip_mem_map(pch, kind, card_addr, size, pcmhp, offsetp, windowp)
|
|
pcmcia_chipset_handle_t pch;
|
|
int kind;
|
|
bus_addr_t card_addr;
|
|
bus_size_t size;
|
|
struct pcmcia_mem_handle *pcmhp;
|
|
bus_size_t *offsetp;
|
|
int *windowp;
|
|
{
|
|
struct stp4020_socket *h = (struct stp4020_socket *)pch;
|
|
int win = (kind&PCMCIA_MEM_ATTR)? STP_WIN_ATTR : STP_WIN_MEM;
|
|
|
|
pcmhp->memt = h->tag;
|
|
bus_space_subregion(h->tag, h->windows[win].winaddr, card_addr, size, &pcmhp->memh);
|
|
pcmhp->size = size;
|
|
pcmhp->realsize = STP4020_WINDOW_SIZE - card_addr;
|
|
*offsetp = 0;
|
|
*windowp = 0;
|
|
|
|
return (0);
|
|
}
|
|
|
|
void
|
|
stp4020_chip_mem_unmap(pch, win)
|
|
pcmcia_chipset_handle_t pch;
|
|
int win;
|
|
{
|
|
}
|
|
|
|
int
|
|
stp4020_chip_io_alloc(pch, start, size, align, pcihp)
|
|
pcmcia_chipset_handle_t pch;
|
|
bus_addr_t start;
|
|
bus_size_t size;
|
|
bus_size_t align;
|
|
struct pcmcia_io_handle *pcihp;
|
|
{
|
|
struct stp4020_socket *h = (struct stp4020_socket *)pch;
|
|
|
|
pcihp->iot = h->tag;
|
|
pcihp->ioh = h->windows[STP_WIN_IO].winaddr;
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
stp4020_chip_io_free(pch, pcihp)
|
|
pcmcia_chipset_handle_t pch;
|
|
struct pcmcia_io_handle *pcihp;
|
|
{
|
|
}
|
|
|
|
int
|
|
stp4020_chip_io_map(pch, width, offset, size, pcihp, windowp)
|
|
pcmcia_chipset_handle_t pch;
|
|
int width;
|
|
bus_addr_t offset;
|
|
bus_size_t size;
|
|
struct pcmcia_io_handle *pcihp;
|
|
int *windowp;
|
|
{
|
|
struct stp4020_socket *h = (struct stp4020_socket *)pch;
|
|
|
|
pcihp->iot = h->tag;
|
|
bus_space_subregion(h->tag, h->windows[STP_WIN_IO].winaddr, offset, size, &pcihp->ioh);
|
|
*windowp = 0;
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
stp4020_chip_io_unmap(pch, win)
|
|
pcmcia_chipset_handle_t pch;
|
|
int win;
|
|
{
|
|
}
|
|
|
|
void
|
|
stp4020_chip_socket_enable(pch)
|
|
pcmcia_chipset_handle_t pch;
|
|
{
|
|
struct stp4020_socket *h = (struct stp4020_socket *)pch;
|
|
int i, v;
|
|
|
|
/* this bit is mostly stolen from pcic_attach_card */
|
|
|
|
/* Power down the socket to reset it, clear the card reset pin */
|
|
stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
|
|
|
|
/*
|
|
* wait 300ms until power fails (Tpf). Then, wait 100ms since
|
|
* we are changing Vcc (Toff).
|
|
*/
|
|
stp4020_delay((300 + 100) * 1000);
|
|
|
|
/* Power up the socket */
|
|
v = STP4020_ICR1_MSTPWR;
|
|
stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
|
|
|
|
/*
|
|
* wait 100ms until power raise (Tpr) and 20ms to become
|
|
* stable (Tsu(Vcc)).
|
|
*/
|
|
stp4020_delay((100 + 20) * 1000);
|
|
|
|
v |= STP4020_ICR1_PCIFOE|STP4020_ICR1_VPP1_VCC;
|
|
stp4020_wr_sockctl(h, STP4020_ICR1_IDX, v);
|
|
|
|
/*
|
|
* hold RESET at least 10us.
|
|
*/
|
|
delay(10);
|
|
|
|
/* Clear reset flag */
|
|
v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
|
|
v &= ~STP4020_ICR0_RESET;
|
|
stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
|
|
|
|
/* wait 20ms as per pc card standard (r2.01) section 4.3.6 */
|
|
stp4020_delay(20000);
|
|
|
|
/* Wait for the chip to finish initializing (5 seconds max) */
|
|
for (i = 10000; i > 0; i--) {
|
|
v = stp4020_rd_sockctl(h, STP4020_ISR0_IDX);
|
|
if ((v & STP4020_ISR0_RDYST) != 0)
|
|
break;
|
|
delay(500);
|
|
}
|
|
if (i <= 0) {
|
|
char bits[64];
|
|
bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
|
|
STP4020_ISR0_IOBITS, bits, sizeof(bits));
|
|
printf("stp4020_chip_socket_enable: not ready: status %s\n",
|
|
bits);
|
|
return;
|
|
}
|
|
|
|
v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
|
|
|
|
/*
|
|
* Check the card type.
|
|
* Enable socket I/O interrupts for IO cards.
|
|
* We use level SB_INT[0] for I/O interrupts.
|
|
*/
|
|
if (pcmcia_card_gettype(h->pcmcia) == PCMCIA_IFTYPE_IO) {
|
|
v &= ~(STP4020_ICR0_IOILVL|STP4020_ICR0_IFTYPE);
|
|
v |= STP4020_ICR0_IFTYPE_IO|STP4020_ICR0_IOIE
|
|
|STP4020_ICR0_SPKREN;
|
|
v |= h->sbus_intno ? STP4020_ICR0_IOILVL_SB1
|
|
: STP4020_ICR0_IOILVL_SB0;
|
|
DPRINTF(("%s: configuring card for IO useage\n", h->sc->sc_dev.dv_xname));
|
|
} else {
|
|
v &= ~(STP4020_ICR0_IOILVL|STP4020_ICR0_IFTYPE
|
|
|STP4020_ICR0_SPKREN);
|
|
v |= STP4020_ICR0_IFTYPE_MEM;
|
|
DPRINTF(("%s: configuring card for MEM ONLY useage\n", h->sc->sc_dev.dv_xname));
|
|
}
|
|
stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
|
|
}
|
|
|
|
void
|
|
stp4020_chip_socket_disable(pch)
|
|
pcmcia_chipset_handle_t pch;
|
|
{
|
|
struct stp4020_socket *h = (struct stp4020_socket *)pch;
|
|
int v;
|
|
|
|
/*
|
|
* Disable socket I/O interrupts.
|
|
*/
|
|
v = stp4020_rd_sockctl(h, STP4020_ICR0_IDX);
|
|
v &= ~(STP4020_ICR0_IOIE | STP4020_ICR0_IOILVL);
|
|
stp4020_wr_sockctl(h, STP4020_ICR0_IDX, v);
|
|
|
|
/* Power down the socket */
|
|
stp4020_wr_sockctl(h, STP4020_ICR1_IDX, 0);
|
|
|
|
/*
|
|
* wait 300ms until power fails (Tpf).
|
|
*/
|
|
stp4020_delay(300 * 1000);
|
|
}
|
|
|
|
void *
|
|
stp4020_chip_intr_establish(pch, pf, ipl, handler, arg)
|
|
pcmcia_chipset_handle_t pch;
|
|
struct pcmcia_function *pf;
|
|
int ipl;
|
|
int (*handler) __P((void *));
|
|
void *arg;
|
|
{
|
|
struct stp4020_socket *h = (struct stp4020_socket *)pch;
|
|
|
|
h->intrhandler = handler;
|
|
h->intrarg = arg;
|
|
h->ipl = ipl;
|
|
return h;
|
|
}
|
|
|
|
void
|
|
stp4020_chip_intr_disestablish(pch, ih)
|
|
pcmcia_chipset_handle_t pch;
|
|
void *ih;
|
|
{
|
|
struct stp4020_socket *h = (struct stp4020_socket *)pch;
|
|
|
|
h->intrhandler = NULL;
|
|
h->intrarg = NULL;
|
|
}
|
|
|
|
/*
|
|
* Delay and possibly yield CPU.
|
|
* XXX - assumes a context
|
|
*/
|
|
void
|
|
stp4020_delay(ms)
|
|
unsigned int ms;
|
|
{
|
|
unsigned int ticks;
|
|
|
|
/* Convert to ticks */
|
|
ticks = (ms * hz ) / 1000000;
|
|
|
|
if (cold || ticks == 0) {
|
|
delay(ms);
|
|
return;
|
|
}
|
|
|
|
#ifdef DIAGNOSTIC
|
|
if (ticks > 60*hz)
|
|
panic("stp4020: preposterous delay: %u", ticks);
|
|
#endif
|
|
tsleep(&ticks, 0, "stp4020_delay", ticks);
|
|
}
|
|
|
|
#ifdef STP4020_DEBUG
|
|
void
|
|
stp4020_dump_regs(h)
|
|
struct stp4020_socket *h;
|
|
{
|
|
char bits[64];
|
|
/*
|
|
* Dump control and status registers.
|
|
*/
|
|
printf("socket[%d] registers:\n", h->sock);
|
|
bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR0_IDX),
|
|
STP4020_ICR0_BITS, bits, sizeof(bits));
|
|
printf("\tICR0=%s\n", bits);
|
|
|
|
bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ICR1_IDX),
|
|
STP4020_ICR1_BITS, bits, sizeof(bits));
|
|
printf("\tICR1=%s\n", bits);
|
|
|
|
bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR0_IDX),
|
|
STP4020_ISR0_IOBITS, bits, sizeof(bits));
|
|
printf("\tISR0=%s\n", bits);
|
|
|
|
bitmask_snprintf(stp4020_rd_sockctl(h, STP4020_ISR1_IDX),
|
|
STP4020_ISR1_BITS, bits, sizeof(bits));
|
|
printf("\tISR1=%s\n", bits);
|
|
}
|
|
#endif /* STP4020_DEBUG */
|