4e96c99bdf
were the new kids on the block and F00F hacks were all the rage, one needed to take out Giant to do anything moderately complicated with the VM, mappings and such. So the pccard / cardbus code held Giant for the entire insertion or removal process. Today, the VM is MP safe. The lock is only needed for dealing with newbus things. Move locking and unlocking Giant to be only around adding and probing devices in pccard and cardbus.
1478 lines
42 KiB
C
1478 lines
42 KiB
C
/* $NetBSD: pcmcia.c,v 1.23 2000/07/28 19:17:02 drochner Exp $ */
|
|
|
|
/*-
|
|
* SPDX-License-Identifier: BSD-4-Clause
|
|
*
|
|
* 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, rman_res_t start, rman_res_t count);
|
|
static int pccard_get_resource(device_t dev, device_t child, int type,
|
|
int rid, rman_res_t *startp, rman_res_t *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, rman_res_t start,
|
|
rman_res_t end, rman_res_t 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)));
|
|
|
|
mtx_lock(&Giant);
|
|
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);
|
|
}
|
|
mtx_unlock(&Giant);
|
|
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 = NULL;
|
|
struct pccard_ce_iospace *ios;
|
|
struct pccard_ce_memspace *mems;
|
|
device_t bus;
|
|
rman_res_t 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 = ~0;
|
|
DEVPRINTF((bus, "I/O rid %d start %#jx end %#jx\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 = ~0;
|
|
DEVPRINTF((bus, "Memory rid %d start %#jx end %#jx\ncardaddr %#jx hostaddr %#jx length %#jx\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=%#jx)\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, rman_res_t addr,
|
|
rman_res_t offset, rman_res_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_anywhere(dev, SYS_RES_MEMORY,
|
|
&pf->ccr_rid, PCCARD_MEM_PAGE_SIZE, RF_ACTIVE);
|
|
if (!pf->ccr_res)
|
|
goto bad;
|
|
DEVPRINTF((dev, "ccr_res == %#jx-%#jx, 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,
|
|
rman_res_t start, rman_res_t 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,
|
|
rman_res_t *startp, rman_res_t *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);
|
|
}
|
|
|
|
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];
|
|
|
|
devctl_safe_quote(cis0, sc->card.cis1_info[0], sizeof(cis0));
|
|
devctl_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,
|
|
rman_res_t start, rman_res_t end, rman_res_t count, u_int flags)
|
|
{
|
|
struct pccard_ivar *dinfo;
|
|
struct resource_list_entry *rle = NULL;
|
|
int passthrough = (device_get_parent(child) != dev);
|
|
int isdefault = (RMAN_IS_DEFAULT_RANGE(start, end) && 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 = NULL;
|
|
|
|
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 %#jx %#jx\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);
|