1494 lines
42 KiB
C
1494 lines
42 KiB
C
/* $NetBSD: pcmcia.c,v 1.23 2000/07/28 19:17:02 drochner Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1997 Marc Horowitz. All rights reserved.
|
|
*
|
|
* 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 Marc Horowitz.
|
|
* 4. The name of the author may not be used to endorse or promote products
|
|
* derived from this software without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``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 AUTHOR 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.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/module.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/queue.h>
|
|
#include <sys/sysctl.h>
|
|
#include <sys/types.h>
|
|
|
|
#include <sys/bus.h>
|
|
#include <machine/bus.h>
|
|
#include <sys/rman.h>
|
|
#include <machine/resource.h>
|
|
|
|
#include <net/ethernet.h>
|
|
|
|
#include <dev/pccard/pccardreg.h>
|
|
#include <dev/pccard/pccardvar.h>
|
|
#include <dev/pccard/pccardvarp.h>
|
|
#include <dev/pccard/pccard_cis.h>
|
|
|
|
#include "power_if.h"
|
|
#include "card_if.h"
|
|
|
|
#define PCCARDDEBUG
|
|
|
|
/* sysctl vars */
|
|
static SYSCTL_NODE(_hw, OID_AUTO, pccard, CTLFLAG_RD, 0, "PCCARD parameters");
|
|
|
|
int pccard_debug = 0;
|
|
SYSCTL_INT(_hw_pccard, OID_AUTO, debug, CTLFLAG_RWTUN,
|
|
&pccard_debug, 0,
|
|
"pccard debug");
|
|
|
|
int pccard_cis_debug = 0;
|
|
SYSCTL_INT(_hw_pccard, OID_AUTO, cis_debug, CTLFLAG_RWTUN,
|
|
&pccard_cis_debug, 0, "pccard CIS debug");
|
|
|
|
#ifdef PCCARDDEBUG
|
|
#define DPRINTF(arg) if (pccard_debug) printf arg
|
|
#define DEVPRINTF(arg) if (pccard_debug) device_printf arg
|
|
#define PRVERBOSE(arg) printf arg
|
|
#define DEVPRVERBOSE(arg) device_printf arg
|
|
#else
|
|
#define DPRINTF(arg)
|
|
#define DEVPRINTF(arg)
|
|
#define PRVERBOSE(arg) if (bootverbose) printf arg
|
|
#define DEVPRVERBOSE(arg) if (bootverbose) device_printf arg
|
|
#endif
|
|
|
|
static int pccard_ccr_read(struct pccard_function *pf, int ccr);
|
|
static void pccard_ccr_write(struct pccard_function *pf, int ccr, int val);
|
|
static int pccard_attach_card(device_t dev);
|
|
static int pccard_detach_card(device_t dev);
|
|
static void pccard_function_init(struct pccard_function *pf, int entry);
|
|
static void pccard_function_free(struct pccard_function *pf);
|
|
static int pccard_function_enable(struct pccard_function *pf);
|
|
static void pccard_function_disable(struct pccard_function *pf);
|
|
static int pccard_probe(device_t dev);
|
|
static int pccard_attach(device_t dev);
|
|
static int pccard_detach(device_t dev);
|
|
static void pccard_print_resources(struct resource_list *rl,
|
|
const char *name, int type, int count, const char *format);
|
|
static int pccard_print_child(device_t dev, device_t child);
|
|
static int pccard_set_resource(device_t dev, device_t child, int type,
|
|
int rid, u_long start, u_long count);
|
|
static int pccard_get_resource(device_t dev, device_t child, int type,
|
|
int rid, u_long *startp, u_long *countp);
|
|
static void pccard_delete_resource(device_t dev, device_t child, int type,
|
|
int rid);
|
|
static int pccard_set_res_flags(device_t dev, device_t child, int type,
|
|
int rid, u_long flags);
|
|
static int pccard_set_memory_offset(device_t dev, device_t child, int rid,
|
|
uint32_t offset, uint32_t *deltap);
|
|
static int pccard_probe_and_attach_child(device_t dev, device_t child,
|
|
struct pccard_function *pf);
|
|
static void pccard_probe_nomatch(device_t cbdev, device_t child);
|
|
static int pccard_read_ivar(device_t bus, device_t child, int which,
|
|
uintptr_t *result);
|
|
static void pccard_driver_added(device_t dev, driver_t *driver);
|
|
static struct resource *pccard_alloc_resource(device_t dev,
|
|
device_t child, int type, int *rid, u_long start,
|
|
u_long end, u_long count, u_int flags);
|
|
static int pccard_release_resource(device_t dev, device_t child, int type,
|
|
int rid, struct resource *r);
|
|
static void pccard_child_detached(device_t parent, device_t dev);
|
|
static int pccard_filter(void *arg);
|
|
static void pccard_intr(void *arg);
|
|
static int pccard_setup_intr(device_t dev, device_t child,
|
|
struct resource *irq, int flags, driver_filter_t *filt,
|
|
driver_intr_t *intr, void *arg, void **cookiep);
|
|
static int pccard_teardown_intr(device_t dev, device_t child,
|
|
struct resource *r, void *cookie);
|
|
|
|
static const struct pccard_product *
|
|
pccard_do_product_lookup(device_t bus, device_t dev,
|
|
const struct pccard_product *tab, size_t ent_size,
|
|
pccard_product_match_fn matchfn);
|
|
|
|
|
|
static int
|
|
pccard_ccr_read(struct pccard_function *pf, int ccr)
|
|
{
|
|
return (bus_space_read_1(pf->pf_ccrt, pf->pf_ccrh,
|
|
pf->pf_ccr_offset + ccr));
|
|
}
|
|
|
|
static void
|
|
pccard_ccr_write(struct pccard_function *pf, int ccr, int val)
|
|
{
|
|
if ((pf->ccr_mask) & (1 << (ccr / 2))) {
|
|
bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh,
|
|
pf->pf_ccr_offset + ccr, val);
|
|
}
|
|
}
|
|
|
|
static int
|
|
pccard_set_default_descr(device_t dev)
|
|
{
|
|
const char *vendorstr, *prodstr;
|
|
uint32_t vendor, prod;
|
|
char *str;
|
|
|
|
if (pccard_get_vendor_str(dev, &vendorstr))
|
|
return (0);
|
|
if (pccard_get_product_str(dev, &prodstr))
|
|
return (0);
|
|
if (vendorstr != NULL && prodstr != NULL) {
|
|
str = malloc(strlen(vendorstr) + strlen(prodstr) + 2, M_DEVBUF,
|
|
M_WAITOK);
|
|
sprintf(str, "%s %s", vendorstr, prodstr);
|
|
device_set_desc_copy(dev, str);
|
|
free(str, M_DEVBUF);
|
|
} else {
|
|
if (pccard_get_vendor(dev, &vendor))
|
|
return (0);
|
|
if (pccard_get_product(dev, &prod))
|
|
return (0);
|
|
str = malloc(100, M_DEVBUF, M_WAITOK);
|
|
snprintf(str, 100, "vendor=%#x product=%#x", vendor, prod);
|
|
device_set_desc_copy(dev, str);
|
|
free(str, M_DEVBUF);
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
pccard_attach_card(device_t dev)
|
|
{
|
|
struct pccard_softc *sc = PCCARD_SOFTC(dev);
|
|
struct pccard_function *pf;
|
|
struct pccard_ivar *ivar;
|
|
device_t child;
|
|
int i;
|
|
|
|
if (!STAILQ_EMPTY(&sc->card.pf_head)) {
|
|
if (bootverbose || pccard_debug)
|
|
device_printf(dev, "Card already inserted.\n");
|
|
}
|
|
|
|
DEVPRINTF((dev, "chip_socket_enable\n"));
|
|
POWER_ENABLE_SOCKET(device_get_parent(dev), dev);
|
|
|
|
DEVPRINTF((dev, "read_cis\n"));
|
|
pccard_read_cis(sc);
|
|
|
|
DEVPRINTF((dev, "check_cis_quirks\n"));
|
|
pccard_check_cis_quirks(dev);
|
|
|
|
/*
|
|
* bail now if the card has no functions, or if there was an error in
|
|
* the cis.
|
|
*/
|
|
|
|
if (sc->card.error) {
|
|
device_printf(dev, "CARD ERROR!\n");
|
|
return (1);
|
|
}
|
|
if (STAILQ_EMPTY(&sc->card.pf_head)) {
|
|
device_printf(dev, "Card has no functions!\n");
|
|
return (1);
|
|
}
|
|
|
|
if (bootverbose || pccard_debug)
|
|
pccard_print_cis(dev);
|
|
|
|
DEVPRINTF((dev, "functions scanning\n"));
|
|
i = -1;
|
|
STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
|
|
i++;
|
|
if (STAILQ_EMPTY(&pf->cfe_head)) {
|
|
device_printf(dev,
|
|
"Function %d has no config entries.!\n", i);
|
|
continue;
|
|
}
|
|
pf->sc = sc;
|
|
pf->cfe = NULL;
|
|
pf->dev = NULL;
|
|
}
|
|
DEVPRINTF((dev, "Card has %d functions. pccard_mfc is %d\n", i + 1,
|
|
pccard_mfc(sc)));
|
|
|
|
STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
|
|
if (STAILQ_EMPTY(&pf->cfe_head))
|
|
continue;
|
|
ivar = malloc(sizeof(struct pccard_ivar), M_DEVBUF,
|
|
M_WAITOK | M_ZERO);
|
|
resource_list_init(&ivar->resources);
|
|
child = device_add_child(dev, NULL, -1);
|
|
device_set_ivars(child, ivar);
|
|
ivar->pf = pf;
|
|
pf->dev = child;
|
|
pccard_probe_and_attach_child(dev, child, pf);
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
pccard_probe_and_attach_child(device_t dev, device_t child,
|
|
struct pccard_function *pf)
|
|
{
|
|
struct pccard_softc *sc = PCCARD_SOFTC(dev);
|
|
int error;
|
|
|
|
/*
|
|
* In NetBSD, the drivers are responsible for activating each
|
|
* function of a card and selecting the config to use. In
|
|
* FreeBSD, all that's done automatically in the typical lazy
|
|
* way we do device resoruce allocation (except we pick the
|
|
* cfe up front). This is the biggest depature from the
|
|
* inherited NetBSD model, apart from the FreeBSD resource code.
|
|
*
|
|
* This seems to work well in practice for most cards.
|
|
* However, there are two cases that are problematic. If a
|
|
* driver wishes to pick and chose which config entry to use,
|
|
* then this method falls down. These are usually older
|
|
* cards. In addition, there are some cards that have
|
|
* multiple hardware units on the cards, but presents only one
|
|
* CIS chain. These cards are combination cards, but only one
|
|
* of these units can be on at a time.
|
|
*
|
|
* To overcome this limitation, while preserving the basic
|
|
* model, the probe routine can select a cfe and try to
|
|
* activate it. If that succeeds, then we'll keep track of
|
|
* and let that information persist until we attach the card.
|
|
* Probe routines that do this MUST return 0, and cannot
|
|
* participate in the bidding process for a device. This
|
|
* seems harsh until you realize that if a probe routine knows
|
|
* enough to override the cfe we pick, then chances are very
|
|
* very good that it is the only driver that could hope to
|
|
* cope with the card. Bidding is for generic drivers, and
|
|
* while some of them may also match, none of them will do
|
|
* configuration override.
|
|
*/
|
|
error = device_probe(child);
|
|
if (error != 0)
|
|
goto out;
|
|
pccard_function_init(pf, -1);
|
|
if (sc->sc_enabled_count == 0)
|
|
POWER_ENABLE_SOCKET(device_get_parent(dev), dev);
|
|
if (pccard_function_enable(pf) == 0 &&
|
|
pccard_set_default_descr(child) == 0 &&
|
|
device_attach(child) == 0) {
|
|
DEVPRINTF((sc->dev, "function %d CCR at %d offset %#x "
|
|
"mask %#x: %#x %#x %#x %#x, %#x %#x %#x %#x, %#x\n",
|
|
pf->number, pf->pf_ccr_window, pf->pf_ccr_offset,
|
|
pf->ccr_mask, pccard_ccr_read(pf, 0x00),
|
|
pccard_ccr_read(pf, 0x02), pccard_ccr_read(pf, 0x04),
|
|
pccard_ccr_read(pf, 0x06), pccard_ccr_read(pf, 0x0A),
|
|
pccard_ccr_read(pf, 0x0C), pccard_ccr_read(pf, 0x0E),
|
|
pccard_ccr_read(pf, 0x10), pccard_ccr_read(pf, 0x12)));
|
|
return (0);
|
|
}
|
|
error = ENXIO;
|
|
out:;
|
|
/*
|
|
* Probe may fail AND also try to select a cfe, if so, free
|
|
* it. This is how we do cfe override. Or the attach fails.
|
|
* Either way, we have to clean up.
|
|
*/
|
|
if (pf->cfe != NULL)
|
|
pccard_function_disable(pf);
|
|
pf->cfe = NULL;
|
|
pccard_function_free(pf);
|
|
return error;
|
|
}
|
|
|
|
static int
|
|
pccard_detach_card(device_t dev)
|
|
{
|
|
struct pccard_softc *sc = PCCARD_SOFTC(dev);
|
|
struct pccard_function *pf;
|
|
struct pccard_config_entry *cfe;
|
|
struct pccard_ivar *devi;
|
|
int state;
|
|
|
|
/*
|
|
* We are running on either the PCCARD socket's event thread
|
|
* or in user context detaching a device by user request.
|
|
*/
|
|
STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
|
|
if (pf->dev == NULL)
|
|
continue;
|
|
state = device_get_state(pf->dev);
|
|
if (state == DS_ATTACHED || state == DS_BUSY)
|
|
device_detach(pf->dev);
|
|
if (pf->cfe != NULL)
|
|
pccard_function_disable(pf);
|
|
pccard_function_free(pf);
|
|
devi = PCCARD_IVAR(pf->dev);
|
|
device_delete_child(dev, pf->dev);
|
|
free(devi, M_DEVBUF);
|
|
}
|
|
if (sc->sc_enabled_count == 0)
|
|
POWER_DISABLE_SOCKET(device_get_parent(dev), dev);
|
|
|
|
while (NULL != (pf = STAILQ_FIRST(&sc->card.pf_head))) {
|
|
while (NULL != (cfe = STAILQ_FIRST(&pf->cfe_head))) {
|
|
STAILQ_REMOVE_HEAD(&pf->cfe_head, cfe_list);
|
|
free(cfe, M_DEVBUF);
|
|
}
|
|
STAILQ_REMOVE_HEAD(&sc->card.pf_head, pf_list);
|
|
free(pf, M_DEVBUF);
|
|
}
|
|
STAILQ_INIT(&sc->card.pf_head);
|
|
return (0);
|
|
}
|
|
|
|
static const struct pccard_product *
|
|
pccard_do_product_lookup(device_t bus, device_t dev,
|
|
const struct pccard_product *tab, size_t ent_size,
|
|
pccard_product_match_fn matchfn)
|
|
{
|
|
const struct pccard_product *ent;
|
|
int matches;
|
|
uint32_t vendor;
|
|
uint32_t prod;
|
|
const char *vendorstr;
|
|
const char *prodstr;
|
|
const char *cis3str;
|
|
const char *cis4str;
|
|
|
|
#ifdef DIAGNOSTIC
|
|
if (sizeof *ent > ent_size)
|
|
panic("pccard_product_lookup: bogus ent_size %jd",
|
|
(intmax_t) ent_size);
|
|
#endif
|
|
if (pccard_get_vendor(dev, &vendor))
|
|
return (NULL);
|
|
if (pccard_get_product(dev, &prod))
|
|
return (NULL);
|
|
if (pccard_get_vendor_str(dev, &vendorstr))
|
|
return (NULL);
|
|
if (pccard_get_product_str(dev, &prodstr))
|
|
return (NULL);
|
|
if (pccard_get_cis3_str(dev, &cis3str))
|
|
return (NULL);
|
|
if (pccard_get_cis4_str(dev, &cis4str))
|
|
return (NULL);
|
|
for (ent = tab; ent->pp_vendor != 0; ent =
|
|
(const struct pccard_product *) ((const char *) ent + ent_size)) {
|
|
matches = 1;
|
|
if (ent->pp_vendor == PCCARD_VENDOR_ANY &&
|
|
ent->pp_product == PCCARD_PRODUCT_ANY &&
|
|
ent->pp_cis[0] == NULL &&
|
|
ent->pp_cis[1] == NULL) {
|
|
if (ent->pp_name)
|
|
device_printf(dev,
|
|
"Total wildcard entry ignored for %s\n",
|
|
ent->pp_name);
|
|
continue;
|
|
}
|
|
if (matches && ent->pp_vendor != PCCARD_VENDOR_ANY &&
|
|
vendor != ent->pp_vendor)
|
|
matches = 0;
|
|
if (matches && ent->pp_product != PCCARD_PRODUCT_ANY &&
|
|
prod != ent->pp_product)
|
|
matches = 0;
|
|
if (matches && ent->pp_cis[0] &&
|
|
(vendorstr == NULL ||
|
|
strcmp(ent->pp_cis[0], vendorstr) != 0))
|
|
matches = 0;
|
|
if (matches && ent->pp_cis[1] &&
|
|
(prodstr == NULL ||
|
|
strcmp(ent->pp_cis[1], prodstr) != 0))
|
|
matches = 0;
|
|
if (matches && ent->pp_cis[2] &&
|
|
(cis3str == NULL ||
|
|
strcmp(ent->pp_cis[2], cis3str) != 0))
|
|
matches = 0;
|
|
if (matches && ent->pp_cis[3] &&
|
|
(cis4str == NULL ||
|
|
strcmp(ent->pp_cis[3], cis4str) != 0))
|
|
matches = 0;
|
|
if (matchfn != NULL)
|
|
matches = (*matchfn)(dev, ent, matches);
|
|
if (matches)
|
|
return (ent);
|
|
}
|
|
return (NULL);
|
|
}
|
|
|
|
/**
|
|
* @brief pccard_select_cfe
|
|
*
|
|
* Select a cfe entry to use. Should be called from the pccard's probe
|
|
* routine after it knows for sure that it wants this card.
|
|
*
|
|
* XXX I think we need to make this symbol be static, ala the kobj stuff
|
|
* we do for everything else. This is a quick hack.
|
|
*/
|
|
int
|
|
pccard_select_cfe(device_t dev, int entry)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(dev);
|
|
struct pccard_function *pf = devi->pf;
|
|
|
|
pccard_function_init(pf, entry);
|
|
return (pf->cfe ? 0 : ENOMEM);
|
|
}
|
|
|
|
/*
|
|
* Initialize a PCCARD function. May be called as long as the function is
|
|
* disabled.
|
|
*
|
|
* Note: pccard_function_init should not keep resources allocated. It should
|
|
* only set them up ala isa pnp, set the values in the rl lists, and return.
|
|
* Any resource held after pccard_function_init is called is a bug. However,
|
|
* the bus routines to get the resources also assume that pccard_function_init
|
|
* does this, so they need to be fixed too.
|
|
*/
|
|
static void
|
|
pccard_function_init(struct pccard_function *pf, int entry)
|
|
{
|
|
struct pccard_config_entry *cfe;
|
|
struct pccard_ivar *devi = PCCARD_IVAR(pf->dev);
|
|
struct resource_list *rl = &devi->resources;
|
|
struct resource_list_entry *rle;
|
|
struct resource *r = 0;
|
|
struct pccard_ce_iospace *ios;
|
|
struct pccard_ce_memspace *mems;
|
|
device_t bus;
|
|
u_long start, end, len;
|
|
int i, rid, spaces;
|
|
|
|
if (pf->pf_flags & PFF_ENABLED) {
|
|
printf("pccard_function_init: function is enabled");
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Driver probe routine requested a specific entry already
|
|
* that succeeded.
|
|
*/
|
|
if (pf->cfe != NULL)
|
|
return;
|
|
|
|
/*
|
|
* walk the list of configuration entries until we find one that
|
|
* we can allocate all the resources to.
|
|
*/
|
|
bus = device_get_parent(pf->dev);
|
|
STAILQ_FOREACH(cfe, &pf->cfe_head, cfe_list) {
|
|
if (cfe->iftype != PCCARD_IFTYPE_IO)
|
|
continue;
|
|
if (entry != -1 && cfe->number != entry)
|
|
continue;
|
|
spaces = 0;
|
|
for (i = 0; i < cfe->num_iospace; i++) {
|
|
ios = cfe->iospace + i;
|
|
start = ios->start;
|
|
if (start)
|
|
end = start + ios->length - 1;
|
|
else
|
|
end = ~0UL;
|
|
DEVPRINTF((bus, "I/O rid %d start %#lx end %#lx\n",
|
|
i, start, end));
|
|
rid = i;
|
|
len = ios->length;
|
|
r = bus_alloc_resource(bus, SYS_RES_IOPORT, &rid,
|
|
start, end, len, rman_make_alignment_flags(len));
|
|
if (r == NULL) {
|
|
DEVPRINTF((bus, "I/O rid %d failed\n", i));
|
|
goto not_this_one;
|
|
}
|
|
rle = resource_list_add(rl, SYS_RES_IOPORT,
|
|
rid, rman_get_start(r), rman_get_end(r), len);
|
|
if (rle == NULL)
|
|
panic("Cannot add resource rid %d IOPORT", rid);
|
|
rle->res = r;
|
|
spaces++;
|
|
}
|
|
for (i = 0; i < cfe->num_memspace; i++) {
|
|
mems = cfe->memspace + i;
|
|
start = mems->cardaddr + mems->hostaddr;
|
|
if (start)
|
|
end = start + mems->length - 1;
|
|
else
|
|
end = ~0UL;
|
|
DEVPRINTF((bus, "Memory rid %d start %#lx end %#lx\ncardaddr %#lx hostaddr %#lx length %#lx\n",
|
|
i, start, end, mems->cardaddr, mems->hostaddr,
|
|
mems->length));
|
|
rid = i;
|
|
len = mems->length;
|
|
r = bus_alloc_resource(bus, SYS_RES_MEMORY, &rid,
|
|
start, end, len, rman_make_alignment_flags(len));
|
|
if (r == NULL) {
|
|
DEVPRINTF((bus, "Memory rid %d failed\n", i));
|
|
// goto not_this_one;
|
|
continue;
|
|
}
|
|
rle = resource_list_add(rl, SYS_RES_MEMORY,
|
|
rid, rman_get_start(r), rman_get_end(r), len);
|
|
if (rle == NULL)
|
|
panic("Cannot add resource rid %d MEM", rid);
|
|
rle->res = r;
|
|
spaces++;
|
|
}
|
|
if (spaces == 0) {
|
|
DEVPRINTF((bus, "Neither memory nor I/O mapped\n"));
|
|
goto not_this_one;
|
|
}
|
|
if (cfe->irqmask) {
|
|
rid = 0;
|
|
r = bus_alloc_resource_any(bus, SYS_RES_IRQ, &rid,
|
|
RF_SHAREABLE);
|
|
if (r == NULL) {
|
|
DEVPRINTF((bus, "IRQ rid %d failed\n", rid));
|
|
goto not_this_one;
|
|
}
|
|
rle = resource_list_add(rl, SYS_RES_IRQ, rid,
|
|
rman_get_start(r), rman_get_end(r), 1);
|
|
if (rle == NULL)
|
|
panic("Cannot add resource rid %d IRQ", rid);
|
|
rle->res = r;
|
|
}
|
|
/* If we get to here, we've allocated all we need */
|
|
pf->cfe = cfe;
|
|
break;
|
|
not_this_one:;
|
|
DEVPRVERBOSE((bus, "Allocation failed for cfe %d\n",
|
|
cfe->number));
|
|
resource_list_purge(rl);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Free resources allocated by pccard_function_init(), May be called as long
|
|
* as the function is disabled.
|
|
*
|
|
* NOTE: This function should be unnecessary. pccard_function_init should
|
|
* never keep resources initialized.
|
|
*/
|
|
static void
|
|
pccard_function_free(struct pccard_function *pf)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(pf->dev);
|
|
struct resource_list_entry *rle;
|
|
|
|
if (pf->pf_flags & PFF_ENABLED) {
|
|
printf("pccard_function_free: function is enabled");
|
|
return;
|
|
}
|
|
|
|
STAILQ_FOREACH(rle, &devi->resources, link) {
|
|
if (rle->res) {
|
|
if (rman_get_device(rle->res) != pf->sc->dev)
|
|
device_printf(pf->sc->dev,
|
|
"function_free: Resource still owned by "
|
|
"child, oops. "
|
|
"(type=%d, rid=%d, addr=%#lx)\n",
|
|
rle->type, rle->rid,
|
|
rman_get_start(rle->res));
|
|
BUS_RELEASE_RESOURCE(device_get_parent(pf->sc->dev),
|
|
pf->sc->dev, rle->type, rle->rid, rle->res);
|
|
rle->res = NULL;
|
|
}
|
|
}
|
|
resource_list_free(&devi->resources);
|
|
}
|
|
|
|
static void
|
|
pccard_mfc_adjust_iobase(struct pccard_function *pf, bus_addr_t addr,
|
|
bus_addr_t offset, bus_size_t size)
|
|
{
|
|
bus_size_t iosize, tmp;
|
|
|
|
if (addr != 0) {
|
|
if (pf->pf_mfc_iomax == 0) {
|
|
pf->pf_mfc_iobase = addr + offset;
|
|
pf->pf_mfc_iomax = pf->pf_mfc_iobase + size;
|
|
} else {
|
|
/* this makes the assumption that nothing overlaps */
|
|
if (pf->pf_mfc_iobase > addr + offset)
|
|
pf->pf_mfc_iobase = addr + offset;
|
|
if (pf->pf_mfc_iomax < addr + offset + size)
|
|
pf->pf_mfc_iomax = addr + offset + size;
|
|
}
|
|
}
|
|
|
|
tmp = pf->pf_mfc_iomax - pf->pf_mfc_iobase;
|
|
/* round up to nearest (2^n)-1 */
|
|
for (iosize = 1; iosize < tmp; iosize <<= 1)
|
|
;
|
|
iosize--;
|
|
|
|
DEVPRINTF((pf->dev, "MFC: I/O base %#jx IOSIZE %#jx\n",
|
|
(uintmax_t)pf->pf_mfc_iobase, (uintmax_t)(iosize + 1)));
|
|
pccard_ccr_write(pf, PCCARD_CCR_IOBASE0,
|
|
pf->pf_mfc_iobase & 0xff);
|
|
pccard_ccr_write(pf, PCCARD_CCR_IOBASE1,
|
|
(pf->pf_mfc_iobase >> 8) & 0xff);
|
|
pccard_ccr_write(pf, PCCARD_CCR_IOBASE2, 0);
|
|
pccard_ccr_write(pf, PCCARD_CCR_IOBASE3, 0);
|
|
pccard_ccr_write(pf, PCCARD_CCR_IOSIZE, iosize);
|
|
}
|
|
|
|
/* Enable a PCCARD function */
|
|
static int
|
|
pccard_function_enable(struct pccard_function *pf)
|
|
{
|
|
struct pccard_function *tmp;
|
|
int reg;
|
|
device_t dev = pf->sc->dev;
|
|
|
|
if (pf->cfe == NULL) {
|
|
DEVPRVERBOSE((dev, "No config entry could be allocated.\n"));
|
|
return (ENOMEM);
|
|
}
|
|
|
|
if (pf->pf_flags & PFF_ENABLED)
|
|
return (0);
|
|
pf->sc->sc_enabled_count++;
|
|
|
|
/*
|
|
* it's possible for different functions' CCRs to be in the same
|
|
* underlying page. Check for that.
|
|
*/
|
|
STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) {
|
|
if ((tmp->pf_flags & PFF_ENABLED) &&
|
|
(pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) &&
|
|
((pf->ccr_base + PCCARD_CCR_SIZE) <=
|
|
(tmp->ccr_base - tmp->pf_ccr_offset +
|
|
tmp->pf_ccr_realsize))) {
|
|
pf->pf_ccrt = tmp->pf_ccrt;
|
|
pf->pf_ccrh = tmp->pf_ccrh;
|
|
pf->pf_ccr_realsize = tmp->pf_ccr_realsize;
|
|
|
|
/*
|
|
* pf->pf_ccr_offset = (tmp->pf_ccr_offset -
|
|
* tmp->ccr_base) + pf->ccr_base;
|
|
*/
|
|
/* pf->pf_ccr_offset =
|
|
(tmp->pf_ccr_offset + pf->ccr_base) -
|
|
tmp->ccr_base; */
|
|
pf->pf_ccr_window = tmp->pf_ccr_window;
|
|
break;
|
|
}
|
|
}
|
|
if (tmp == NULL) {
|
|
pf->ccr_rid = 0;
|
|
pf->ccr_res = bus_alloc_resource(dev, SYS_RES_MEMORY,
|
|
&pf->ccr_rid, 0, ~0, PCCARD_MEM_PAGE_SIZE, RF_ACTIVE);
|
|
if (!pf->ccr_res)
|
|
goto bad;
|
|
DEVPRINTF((dev, "ccr_res == %#lx-%#lx, base=%#x\n",
|
|
rman_get_start(pf->ccr_res), rman_get_end(pf->ccr_res),
|
|
pf->ccr_base));
|
|
CARD_SET_RES_FLAGS(device_get_parent(dev), dev, SYS_RES_MEMORY,
|
|
pf->ccr_rid, PCCARD_A_MEM_ATTR);
|
|
CARD_SET_MEMORY_OFFSET(device_get_parent(dev), dev,
|
|
pf->ccr_rid, pf->ccr_base, &pf->pf_ccr_offset);
|
|
pf->pf_ccrt = rman_get_bustag(pf->ccr_res);
|
|
pf->pf_ccrh = rman_get_bushandle(pf->ccr_res);
|
|
pf->pf_ccr_realsize = 1;
|
|
}
|
|
|
|
reg = (pf->cfe->number & PCCARD_CCR_OPTION_CFINDEX);
|
|
reg |= PCCARD_CCR_OPTION_LEVIREQ;
|
|
if (pccard_mfc(pf->sc)) {
|
|
reg |= (PCCARD_CCR_OPTION_FUNC_ENABLE |
|
|
PCCARD_CCR_OPTION_ADDR_DECODE);
|
|
/* PCCARD_CCR_OPTION_IRQ_ENABLE set elsewhere as needed */
|
|
}
|
|
pccard_ccr_write(pf, PCCARD_CCR_OPTION, reg);
|
|
|
|
reg = 0;
|
|
if ((pf->cfe->flags & PCCARD_CFE_IO16) == 0)
|
|
reg |= PCCARD_CCR_STATUS_IOIS8;
|
|
if (pf->cfe->flags & PCCARD_CFE_AUDIO)
|
|
reg |= PCCARD_CCR_STATUS_AUDIO;
|
|
pccard_ccr_write(pf, PCCARD_CCR_STATUS, reg);
|
|
|
|
pccard_ccr_write(pf, PCCARD_CCR_SOCKETCOPY, 0);
|
|
|
|
if (pccard_mfc(pf->sc))
|
|
pccard_mfc_adjust_iobase(pf, 0, 0, 0);
|
|
|
|
#ifdef PCCARDDEBUG
|
|
if (pccard_debug) {
|
|
STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) {
|
|
device_printf(tmp->sc->dev,
|
|
"function %d CCR at %d offset %#x: "
|
|
"%#x %#x %#x %#x, %#x %#x %#x %#x, %#x\n",
|
|
tmp->number, tmp->pf_ccr_window,
|
|
tmp->pf_ccr_offset,
|
|
pccard_ccr_read(tmp, 0x00),
|
|
pccard_ccr_read(tmp, 0x02),
|
|
pccard_ccr_read(tmp, 0x04),
|
|
pccard_ccr_read(tmp, 0x06),
|
|
pccard_ccr_read(tmp, 0x0A),
|
|
pccard_ccr_read(tmp, 0x0C),
|
|
pccard_ccr_read(tmp, 0x0E),
|
|
pccard_ccr_read(tmp, 0x10),
|
|
pccard_ccr_read(tmp, 0x12));
|
|
}
|
|
}
|
|
#endif
|
|
pf->pf_flags |= PFF_ENABLED;
|
|
return (0);
|
|
|
|
bad:
|
|
/*
|
|
* Decrement the reference count, and power down the socket, if
|
|
* necessary.
|
|
*/
|
|
pf->sc->sc_enabled_count--;
|
|
DEVPRINTF((dev, "bad --enabled_count = %d\n", pf->sc->sc_enabled_count));
|
|
|
|
return (1);
|
|
}
|
|
|
|
/* Disable PCCARD function. */
|
|
static void
|
|
pccard_function_disable(struct pccard_function *pf)
|
|
{
|
|
struct pccard_function *tmp;
|
|
device_t dev = pf->sc->dev;
|
|
|
|
if (pf->cfe == NULL)
|
|
panic("pccard_function_disable: function not initialized");
|
|
|
|
if ((pf->pf_flags & PFF_ENABLED) == 0)
|
|
return;
|
|
if (pf->intr_handler != NULL) {
|
|
struct pccard_ivar *devi = PCCARD_IVAR(pf->dev);
|
|
struct resource_list_entry *rle =
|
|
resource_list_find(&devi->resources, SYS_RES_IRQ, 0);
|
|
if (rle == NULL)
|
|
panic("Can't disable an interrupt with no IRQ res\n");
|
|
BUS_TEARDOWN_INTR(dev, pf->dev, rle->res,
|
|
pf->intr_handler_cookie);
|
|
}
|
|
|
|
/*
|
|
* it's possible for different functions' CCRs to be in the same
|
|
* underlying page. Check for that. Note we mark us as disabled
|
|
* first to avoid matching ourself.
|
|
*/
|
|
|
|
pf->pf_flags &= ~PFF_ENABLED;
|
|
STAILQ_FOREACH(tmp, &pf->sc->card.pf_head, pf_list) {
|
|
if ((tmp->pf_flags & PFF_ENABLED) &&
|
|
(pf->ccr_base >= (tmp->ccr_base - tmp->pf_ccr_offset)) &&
|
|
((pf->ccr_base + PCCARD_CCR_SIZE) <=
|
|
(tmp->ccr_base - tmp->pf_ccr_offset +
|
|
tmp->pf_ccr_realsize)))
|
|
break;
|
|
}
|
|
|
|
/* Not used by anyone else; unmap the CCR. */
|
|
if (tmp == NULL) {
|
|
bus_release_resource(dev, SYS_RES_MEMORY, pf->ccr_rid,
|
|
pf->ccr_res);
|
|
pf->ccr_res = NULL;
|
|
}
|
|
|
|
/*
|
|
* Decrement the reference count, and power down the socket, if
|
|
* necessary.
|
|
*/
|
|
pf->sc->sc_enabled_count--;
|
|
}
|
|
|
|
#define PCCARD_NPORT 2
|
|
#define PCCARD_NMEM 5
|
|
#define PCCARD_NIRQ 1
|
|
#define PCCARD_NDRQ 0
|
|
|
|
static int
|
|
pccard_probe(device_t dev)
|
|
{
|
|
device_set_desc(dev, "16-bit PCCard bus");
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
pccard_attach(device_t dev)
|
|
{
|
|
struct pccard_softc *sc = PCCARD_SOFTC(dev);
|
|
int err;
|
|
|
|
sc->dev = dev;
|
|
sc->sc_enabled_count = 0;
|
|
if ((err = pccard_device_create(sc)) != 0)
|
|
return (err);
|
|
STAILQ_INIT(&sc->card.pf_head);
|
|
return (bus_generic_attach(dev));
|
|
}
|
|
|
|
static int
|
|
pccard_detach(device_t dev)
|
|
{
|
|
pccard_detach_card(dev);
|
|
pccard_device_destroy(device_get_softc(dev));
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
pccard_suspend(device_t self)
|
|
{
|
|
pccard_detach_card(self);
|
|
return (0);
|
|
}
|
|
|
|
static
|
|
int
|
|
pccard_resume(device_t self)
|
|
{
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
pccard_print_resources(struct resource_list *rl, const char *name, int type,
|
|
int count, const char *format)
|
|
{
|
|
struct resource_list_entry *rle;
|
|
int printed;
|
|
int i;
|
|
|
|
printed = 0;
|
|
for (i = 0; i < count; i++) {
|
|
rle = resource_list_find(rl, type, i);
|
|
if (rle != NULL) {
|
|
if (printed == 0)
|
|
printf(" %s ", name);
|
|
else if (printed > 0)
|
|
printf(",");
|
|
printed++;
|
|
printf(format, rle->start);
|
|
if (rle->count > 1) {
|
|
printf("-");
|
|
printf(format, rle->start + rle->count - 1);
|
|
}
|
|
} else if (i > 3) {
|
|
/* check the first few regardless */
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
static int
|
|
pccard_print_child(device_t dev, device_t child)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
struct resource_list *rl = &devi->resources;
|
|
int retval = 0;
|
|
|
|
retval += bus_print_child_header(dev, child);
|
|
retval += printf(" at");
|
|
|
|
if (devi != NULL) {
|
|
pccard_print_resources(rl, "port", SYS_RES_IOPORT,
|
|
PCCARD_NPORT, "%#lx");
|
|
pccard_print_resources(rl, "iomem", SYS_RES_MEMORY,
|
|
PCCARD_NMEM, "%#lx");
|
|
pccard_print_resources(rl, "irq", SYS_RES_IRQ, PCCARD_NIRQ,
|
|
"%ld");
|
|
pccard_print_resources(rl, "drq", SYS_RES_DRQ, PCCARD_NDRQ,
|
|
"%ld");
|
|
retval += printf(" function %d config %d", devi->pf->number,
|
|
devi->pf->cfe->number);
|
|
}
|
|
|
|
retval += bus_print_child_footer(dev, child);
|
|
|
|
return (retval);
|
|
}
|
|
|
|
static int
|
|
pccard_set_resource(device_t dev, device_t child, int type, int rid,
|
|
u_long start, u_long count)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
struct resource_list *rl = &devi->resources;
|
|
|
|
if (type != SYS_RES_IOPORT && type != SYS_RES_MEMORY
|
|
&& type != SYS_RES_IRQ && type != SYS_RES_DRQ)
|
|
return (EINVAL);
|
|
if (rid < 0)
|
|
return (EINVAL);
|
|
if (type == SYS_RES_IOPORT && rid >= PCCARD_NPORT)
|
|
return (EINVAL);
|
|
if (type == SYS_RES_MEMORY && rid >= PCCARD_NMEM)
|
|
return (EINVAL);
|
|
if (type == SYS_RES_IRQ && rid >= PCCARD_NIRQ)
|
|
return (EINVAL);
|
|
if (type == SYS_RES_DRQ && rid >= PCCARD_NDRQ)
|
|
return (EINVAL);
|
|
|
|
resource_list_add(rl, type, rid, start, start + count - 1, count);
|
|
if (NULL != resource_list_alloc(rl, device_get_parent(dev), dev,
|
|
type, &rid, start, start + count - 1, count, 0))
|
|
return 0;
|
|
else
|
|
return ENOMEM;
|
|
}
|
|
|
|
static int
|
|
pccard_get_resource(device_t dev, device_t child, int type, int rid,
|
|
u_long *startp, u_long *countp)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
struct resource_list *rl = &devi->resources;
|
|
struct resource_list_entry *rle;
|
|
|
|
rle = resource_list_find(rl, type, rid);
|
|
if (rle == NULL)
|
|
return (ENOENT);
|
|
|
|
if (startp != NULL)
|
|
*startp = rle->start;
|
|
if (countp != NULL)
|
|
*countp = rle->count;
|
|
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
pccard_delete_resource(device_t dev, device_t child, int type, int rid)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
struct resource_list *rl = &devi->resources;
|
|
resource_list_delete(rl, type, rid);
|
|
}
|
|
|
|
static int
|
|
pccard_set_res_flags(device_t dev, device_t child, int type, int rid,
|
|
u_long flags)
|
|
{
|
|
return (CARD_SET_RES_FLAGS(device_get_parent(dev), child, type,
|
|
rid, flags));
|
|
}
|
|
|
|
static int
|
|
pccard_set_memory_offset(device_t dev, device_t child, int rid,
|
|
uint32_t offset, uint32_t *deltap)
|
|
|
|
{
|
|
return (CARD_SET_MEMORY_OFFSET(device_get_parent(dev), child, rid,
|
|
offset, deltap));
|
|
}
|
|
|
|
static void
|
|
pccard_probe_nomatch(device_t bus, device_t child)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
struct pccard_function *pf = devi->pf;
|
|
struct pccard_softc *sc = PCCARD_SOFTC(bus);
|
|
int i;
|
|
|
|
device_printf(bus, "<unknown card>");
|
|
printf(" (manufacturer=0x%04x, product=0x%04x, function_type=%d) "
|
|
"at function %d\n", sc->card.manufacturer, sc->card.product,
|
|
pf->function, pf->number);
|
|
device_printf(bus, " CIS info: ");
|
|
for (i = 0; sc->card.cis1_info[i] != NULL && i < 4; i++)
|
|
printf("%s%s", i > 0 ? ", " : "", sc->card.cis1_info[i]);
|
|
printf("\n");
|
|
return;
|
|
}
|
|
|
|
static int
|
|
pccard_child_location_str(device_t bus, device_t child, char *buf,
|
|
size_t buflen)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
struct pccard_function *pf = devi->pf;
|
|
|
|
snprintf(buf, buflen, "function=%d", pf->number);
|
|
return (0);
|
|
}
|
|
|
|
/* XXX Maybe this should be in subr_bus? */
|
|
static void
|
|
pccard_safe_quote(char *dst, const char *src, size_t len)
|
|
{
|
|
char *walker = dst, *ep = dst + len - 1;
|
|
|
|
if (len == 0)
|
|
return;
|
|
while (src != NULL && walker < ep)
|
|
{
|
|
if (*src == '"') {
|
|
if (ep - walker < 2)
|
|
break;
|
|
*walker++ = '\\';
|
|
}
|
|
*walker++ = *src++;
|
|
}
|
|
*walker = '\0';
|
|
}
|
|
|
|
static int
|
|
pccard_child_pnpinfo_str(device_t bus, device_t child, char *buf,
|
|
size_t buflen)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
struct pccard_function *pf = devi->pf;
|
|
struct pccard_softc *sc = PCCARD_SOFTC(bus);
|
|
char cis0[128], cis1[128];
|
|
|
|
pccard_safe_quote(cis0, sc->card.cis1_info[0], sizeof(cis0));
|
|
pccard_safe_quote(cis1, sc->card.cis1_info[1], sizeof(cis1));
|
|
snprintf(buf, buflen, "manufacturer=0x%04x product=0x%04x "
|
|
"cisvendor=\"%s\" cisproduct=\"%s\" function_type=%d",
|
|
sc->card.manufacturer, sc->card.product, cis0, cis1, pf->function);
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
pccard_read_ivar(device_t bus, device_t child, int which, uintptr_t *result)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
struct pccard_function *pf = devi->pf;
|
|
struct pccard_softc *sc = PCCARD_SOFTC(bus);
|
|
|
|
if (!pf)
|
|
panic("No pccard function pointer");
|
|
switch (which) {
|
|
default:
|
|
return (EINVAL);
|
|
case PCCARD_IVAR_FUNCE_DISK:
|
|
*(uint16_t *)result = pf->pf_funce_disk_interface |
|
|
(pf->pf_funce_disk_power << 8);
|
|
break;
|
|
case PCCARD_IVAR_ETHADDR:
|
|
bcopy(pf->pf_funce_lan_nid, result, ETHER_ADDR_LEN);
|
|
break;
|
|
case PCCARD_IVAR_VENDOR:
|
|
*(uint32_t *)result = sc->card.manufacturer;
|
|
break;
|
|
case PCCARD_IVAR_PRODUCT:
|
|
*(uint32_t *)result = sc->card.product;
|
|
break;
|
|
case PCCARD_IVAR_PRODEXT:
|
|
*(uint16_t *)result = sc->card.prodext;
|
|
break;
|
|
case PCCARD_IVAR_FUNCTION:
|
|
*(uint32_t *)result = pf->function;
|
|
break;
|
|
case PCCARD_IVAR_FUNCTION_NUMBER:
|
|
*(uint32_t *)result = pf->number;
|
|
break;
|
|
case PCCARD_IVAR_VENDOR_STR:
|
|
*(const char **)result = sc->card.cis1_info[0];
|
|
break;
|
|
case PCCARD_IVAR_PRODUCT_STR:
|
|
*(const char **)result = sc->card.cis1_info[1];
|
|
break;
|
|
case PCCARD_IVAR_CIS3_STR:
|
|
*(const char **)result = sc->card.cis1_info[2];
|
|
break;
|
|
case PCCARD_IVAR_CIS4_STR:
|
|
*(const char **)result = sc->card.cis1_info[3];
|
|
break;
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
pccard_driver_added(device_t dev, driver_t *driver)
|
|
{
|
|
struct pccard_softc *sc = PCCARD_SOFTC(dev);
|
|
struct pccard_function *pf;
|
|
device_t child;
|
|
|
|
STAILQ_FOREACH(pf, &sc->card.pf_head, pf_list) {
|
|
if (STAILQ_EMPTY(&pf->cfe_head))
|
|
continue;
|
|
child = pf->dev;
|
|
if (device_get_state(child) != DS_NOTPRESENT)
|
|
continue;
|
|
pccard_probe_and_attach_child(dev, child, pf);
|
|
}
|
|
return;
|
|
}
|
|
|
|
static struct resource *
|
|
pccard_alloc_resource(device_t dev, device_t child, int type, int *rid,
|
|
u_long start, u_long end, u_long count, u_int flags)
|
|
{
|
|
struct pccard_ivar *dinfo;
|
|
struct resource_list_entry *rle = 0;
|
|
int passthrough = (device_get_parent(child) != dev);
|
|
int isdefault = (start == 0 && end == ~0UL && count == 1);
|
|
struct resource *r = NULL;
|
|
|
|
/* XXX I'm no longer sure this is right */
|
|
if (passthrough) {
|
|
return (BUS_ALLOC_RESOURCE(device_get_parent(dev), child,
|
|
type, rid, start, end, count, flags));
|
|
}
|
|
|
|
dinfo = device_get_ivars(child);
|
|
rle = resource_list_find(&dinfo->resources, type, *rid);
|
|
|
|
if (rle == NULL && isdefault)
|
|
return (NULL); /* no resource of that type/rid */
|
|
if (rle == NULL || rle->res == NULL) {
|
|
/* XXX Need to adjust flags */
|
|
r = bus_alloc_resource(dev, type, rid, start, end,
|
|
count, flags);
|
|
if (r == NULL)
|
|
goto bad;
|
|
resource_list_add(&dinfo->resources, type, *rid,
|
|
rman_get_start(r), rman_get_end(r), count);
|
|
rle = resource_list_find(&dinfo->resources, type, *rid);
|
|
if (!rle)
|
|
goto bad;
|
|
rle->res = r;
|
|
}
|
|
/*
|
|
* If dev doesn't own the device, then we can't give this device
|
|
* out.
|
|
*/
|
|
if (rman_get_device(rle->res) != dev)
|
|
return (NULL);
|
|
rman_set_device(rle->res, child);
|
|
if (flags & RF_ACTIVE)
|
|
BUS_ACTIVATE_RESOURCE(dev, child, type, *rid, rle->res);
|
|
return (rle->res);
|
|
bad:;
|
|
device_printf(dev, "WARNING: Resource not reserved by pccard\n");
|
|
return (NULL);
|
|
}
|
|
|
|
static int
|
|
pccard_release_resource(device_t dev, device_t child, int type, int rid,
|
|
struct resource *r)
|
|
{
|
|
struct pccard_ivar *dinfo;
|
|
int passthrough = (device_get_parent(child) != dev);
|
|
struct resource_list_entry *rle = 0;
|
|
|
|
if (passthrough)
|
|
return BUS_RELEASE_RESOURCE(device_get_parent(dev), child,
|
|
type, rid, r);
|
|
|
|
dinfo = device_get_ivars(child);
|
|
|
|
rle = resource_list_find(&dinfo->resources, type, rid);
|
|
|
|
if (!rle) {
|
|
device_printf(dev, "Allocated resource not found, "
|
|
"%d %#x %#lx %#lx\n",
|
|
type, rid, rman_get_start(r), rman_get_size(r));
|
|
return ENOENT;
|
|
}
|
|
if (!rle->res) {
|
|
device_printf(dev, "Allocated resource not recorded\n");
|
|
return ENOENT;
|
|
}
|
|
/*
|
|
* Deactivate the resource (since it is being released), and
|
|
* assign it to the bus.
|
|
*/
|
|
BUS_DEACTIVATE_RESOURCE(dev, child, type, rid, rle->res);
|
|
rman_set_device(rle->res, dev);
|
|
return (0);
|
|
}
|
|
|
|
static void
|
|
pccard_child_detached(device_t parent, device_t dev)
|
|
{
|
|
struct pccard_ivar *ivar = PCCARD_IVAR(dev);
|
|
struct pccard_function *pf = ivar->pf;
|
|
|
|
pccard_function_disable(pf);
|
|
}
|
|
|
|
static int
|
|
pccard_filter(void *arg)
|
|
{
|
|
struct pccard_function *pf = (struct pccard_function*) arg;
|
|
int reg;
|
|
int doisr = 1;
|
|
|
|
/*
|
|
* MFC cards know if they interrupted, so we have to ack the
|
|
* interrupt and call the ISR. Non-MFC cards don't have these
|
|
* bits, so they always get called. Many non-MFC cards have
|
|
* this bit set always upon read, but some do not.
|
|
*
|
|
* We always ack the interrupt, even if there's no ISR
|
|
* for the card. This is done on the theory that acking
|
|
* the interrupt will pacify the card enough to keep an
|
|
* interrupt storm from happening. Of course this won't
|
|
* help in the non-MFC case.
|
|
*
|
|
* This has no impact for MPSAFEness of the client drivers.
|
|
* We register this with whatever flags the intr_handler
|
|
* was registered with. All these functions are MPSAFE.
|
|
*/
|
|
if (pccard_mfc(pf->sc)) {
|
|
reg = pccard_ccr_read(pf, PCCARD_CCR_STATUS);
|
|
if (reg & PCCARD_CCR_STATUS_INTR)
|
|
pccard_ccr_write(pf, PCCARD_CCR_STATUS,
|
|
reg & ~PCCARD_CCR_STATUS_INTR);
|
|
else
|
|
doisr = 0;
|
|
}
|
|
if (doisr) {
|
|
if (pf->intr_filter != NULL)
|
|
return (pf->intr_filter(pf->intr_handler_arg));
|
|
return (FILTER_SCHEDULE_THREAD);
|
|
}
|
|
return (FILTER_STRAY);
|
|
}
|
|
|
|
static void
|
|
pccard_intr(void *arg)
|
|
{
|
|
struct pccard_function *pf = (struct pccard_function*) arg;
|
|
|
|
pf->intr_handler(pf->intr_handler_arg);
|
|
}
|
|
|
|
static int
|
|
pccard_setup_intr(device_t dev, device_t child, struct resource *irq,
|
|
int flags, driver_filter_t *filt, driver_intr_t *intr, void *arg,
|
|
void **cookiep)
|
|
{
|
|
struct pccard_softc *sc = PCCARD_SOFTC(dev);
|
|
struct pccard_ivar *ivar = PCCARD_IVAR(child);
|
|
struct pccard_function *pf = ivar->pf;
|
|
int err;
|
|
|
|
if (pf->intr_filter != NULL || pf->intr_handler != NULL)
|
|
panic("Only one interrupt handler per function allowed");
|
|
err = bus_generic_setup_intr(dev, child, irq, flags, pccard_filter,
|
|
intr ? pccard_intr : NULL, pf, cookiep);
|
|
if (err != 0)
|
|
return (err);
|
|
pf->intr_filter = filt;
|
|
pf->intr_handler = intr;
|
|
pf->intr_handler_arg = arg;
|
|
pf->intr_handler_cookie = *cookiep;
|
|
if (pccard_mfc(sc)) {
|
|
pccard_ccr_write(pf, PCCARD_CCR_OPTION,
|
|
pccard_ccr_read(pf, PCCARD_CCR_OPTION) |
|
|
PCCARD_CCR_OPTION_IREQ_ENABLE);
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
pccard_teardown_intr(device_t dev, device_t child, struct resource *r,
|
|
void *cookie)
|
|
{
|
|
struct pccard_softc *sc = PCCARD_SOFTC(dev);
|
|
struct pccard_ivar *ivar = PCCARD_IVAR(child);
|
|
struct pccard_function *pf = ivar->pf;
|
|
int ret;
|
|
|
|
if (pccard_mfc(sc)) {
|
|
pccard_ccr_write(pf, PCCARD_CCR_OPTION,
|
|
pccard_ccr_read(pf, PCCARD_CCR_OPTION) &
|
|
~PCCARD_CCR_OPTION_IREQ_ENABLE);
|
|
}
|
|
ret = bus_generic_teardown_intr(dev, child, r, cookie);
|
|
if (ret == 0) {
|
|
pf->intr_handler = NULL;
|
|
pf->intr_handler_arg = NULL;
|
|
pf->intr_handler_cookie = NULL;
|
|
}
|
|
|
|
return (ret);
|
|
}
|
|
|
|
static int
|
|
pccard_activate_resource(device_t brdev, device_t child, int type, int rid,
|
|
struct resource *r)
|
|
{
|
|
struct pccard_ivar *ivar = PCCARD_IVAR(child);
|
|
struct pccard_function *pf = ivar->pf;
|
|
|
|
switch(type) {
|
|
case SYS_RES_IOPORT:
|
|
/*
|
|
* We need to adjust IOBASE[01] and IOSIZE if we're an MFC
|
|
* card.
|
|
*/
|
|
if (pccard_mfc(pf->sc))
|
|
pccard_mfc_adjust_iobase(pf, rman_get_start(r), 0,
|
|
rman_get_size(r));
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
return (bus_generic_activate_resource(brdev, child, type, rid, r));
|
|
}
|
|
|
|
static int
|
|
pccard_deactivate_resource(device_t brdev, device_t child, int type,
|
|
int rid, struct resource *r)
|
|
{
|
|
/* XXX undo pccard_activate_resource? XXX */
|
|
return (bus_generic_deactivate_resource(brdev, child, type, rid, r));
|
|
}
|
|
|
|
static int
|
|
pccard_attr_read_impl(device_t brdev, device_t child, uint32_t offset,
|
|
uint8_t *val)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
struct pccard_function *pf = devi->pf;
|
|
|
|
/*
|
|
* Optimization. Most of the time, devices want to access
|
|
* the same page of the attribute memory that the CCR is in.
|
|
* We take advantage of this fact here.
|
|
*/
|
|
if (offset / PCCARD_MEM_PAGE_SIZE ==
|
|
pf->ccr_base / PCCARD_MEM_PAGE_SIZE)
|
|
*val = bus_space_read_1(pf->pf_ccrt, pf->pf_ccrh,
|
|
offset % PCCARD_MEM_PAGE_SIZE);
|
|
else {
|
|
CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, offset,
|
|
&offset);
|
|
*val = bus_space_read_1(pf->pf_ccrt, pf->pf_ccrh, offset);
|
|
CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, pf->ccr_base,
|
|
&offset);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
pccard_attr_write_impl(device_t brdev, device_t child, uint32_t offset,
|
|
uint8_t val)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
struct pccard_function *pf = devi->pf;
|
|
|
|
/*
|
|
* Optimization. Most of the time, devices want to access
|
|
* the same page of the attribute memory that the CCR is in.
|
|
* We take advantage of this fact here.
|
|
*/
|
|
if (offset / PCCARD_MEM_PAGE_SIZE ==
|
|
pf->ccr_base / PCCARD_MEM_PAGE_SIZE)
|
|
bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh,
|
|
offset % PCCARD_MEM_PAGE_SIZE, val);
|
|
else {
|
|
CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, offset,
|
|
&offset);
|
|
bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh, offset, val);
|
|
CARD_SET_MEMORY_OFFSET(brdev, child, pf->ccr_rid, pf->ccr_base,
|
|
&offset);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
pccard_ccr_read_impl(device_t brdev, device_t child, uint32_t offset,
|
|
uint8_t *val)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
|
|
*val = pccard_ccr_read(devi->pf, offset);
|
|
DEVPRINTF((child, "ccr_read of %#x (%#x) is %#x\n", offset,
|
|
devi->pf->pf_ccr_offset, *val));
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
pccard_ccr_write_impl(device_t brdev, device_t child, uint32_t offset,
|
|
uint8_t val)
|
|
{
|
|
struct pccard_ivar *devi = PCCARD_IVAR(child);
|
|
struct pccard_function *pf = devi->pf;
|
|
|
|
/*
|
|
* Can't use pccard_ccr_write since client drivers may access
|
|
* registers not contained in the 'mask' if they are non-standard.
|
|
*/
|
|
DEVPRINTF((child, "ccr_write of %#x to %#x (%#x)\n", val, offset,
|
|
devi->pf->pf_ccr_offset));
|
|
bus_space_write_1(pf->pf_ccrt, pf->pf_ccrh, pf->pf_ccr_offset + offset,
|
|
val);
|
|
return 0;
|
|
}
|
|
|
|
|
|
static device_method_t pccard_methods[] = {
|
|
/* Device interface */
|
|
DEVMETHOD(device_probe, pccard_probe),
|
|
DEVMETHOD(device_attach, pccard_attach),
|
|
DEVMETHOD(device_detach, pccard_detach),
|
|
DEVMETHOD(device_shutdown, bus_generic_shutdown),
|
|
DEVMETHOD(device_suspend, pccard_suspend),
|
|
DEVMETHOD(device_resume, pccard_resume),
|
|
|
|
/* Bus interface */
|
|
DEVMETHOD(bus_print_child, pccard_print_child),
|
|
DEVMETHOD(bus_driver_added, pccard_driver_added),
|
|
DEVMETHOD(bus_child_detached, pccard_child_detached),
|
|
DEVMETHOD(bus_alloc_resource, pccard_alloc_resource),
|
|
DEVMETHOD(bus_release_resource, pccard_release_resource),
|
|
DEVMETHOD(bus_activate_resource, pccard_activate_resource),
|
|
DEVMETHOD(bus_deactivate_resource, pccard_deactivate_resource),
|
|
DEVMETHOD(bus_setup_intr, pccard_setup_intr),
|
|
DEVMETHOD(bus_teardown_intr, pccard_teardown_intr),
|
|
DEVMETHOD(bus_set_resource, pccard_set_resource),
|
|
DEVMETHOD(bus_get_resource, pccard_get_resource),
|
|
DEVMETHOD(bus_delete_resource, pccard_delete_resource),
|
|
DEVMETHOD(bus_probe_nomatch, pccard_probe_nomatch),
|
|
DEVMETHOD(bus_read_ivar, pccard_read_ivar),
|
|
DEVMETHOD(bus_child_pnpinfo_str, pccard_child_pnpinfo_str),
|
|
DEVMETHOD(bus_child_location_str, pccard_child_location_str),
|
|
|
|
/* Card Interface */
|
|
DEVMETHOD(card_set_res_flags, pccard_set_res_flags),
|
|
DEVMETHOD(card_set_memory_offset, pccard_set_memory_offset),
|
|
DEVMETHOD(card_attach_card, pccard_attach_card),
|
|
DEVMETHOD(card_detach_card, pccard_detach_card),
|
|
DEVMETHOD(card_do_product_lookup, pccard_do_product_lookup),
|
|
DEVMETHOD(card_cis_scan, pccard_scan_cis),
|
|
DEVMETHOD(card_attr_read, pccard_attr_read_impl),
|
|
DEVMETHOD(card_attr_write, pccard_attr_write_impl),
|
|
DEVMETHOD(card_ccr_read, pccard_ccr_read_impl),
|
|
DEVMETHOD(card_ccr_write, pccard_ccr_write_impl),
|
|
|
|
{ 0, 0 }
|
|
};
|
|
|
|
static driver_t pccard_driver = {
|
|
"pccard",
|
|
pccard_methods,
|
|
sizeof(struct pccard_softc)
|
|
};
|
|
|
|
devclass_t pccard_devclass;
|
|
|
|
/* Maybe we need to have a slot device? */
|
|
DRIVER_MODULE(pccard, pcic, pccard_driver, pccard_devclass, 0, 0);
|
|
DRIVER_MODULE(pccard, cbb, pccard_driver, pccard_devclass, 0, 0);
|
|
MODULE_VERSION(pccard, 1);
|