#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 <sys/rman.h>
#include <net/ethernet.h>
#include <bus/pccard/pccardreg.h>
#include <bus/pccard/pccardvar.h>
#include <bus/pccard/pccard_cis.h>
#include "power_if.h"
#include "card_if.h"
#define PCCARDDEBUG
SYSCTL_NODE(_hw, OID_AUTO, pccard, CTLFLAG_RD, 0, "PCCARD parameters");
int pccard_debug = 0;
TUNABLE_INT("hw.pccard.debug", &pccard_debug);
SYSCTL_INT(_hw_pccard, OID_AUTO, debug, CTLFLAG_RW,
&pccard_debug, 0,
"pccard debug");
int pccard_cis_debug = 0;
TUNABLE_INT("hw.pccard.cis_debug", &pccard_cis_debug);
SYSCTL_INT(_hw_pccard, OID_AUTO, cis_debug, CTLFLAG_RW,
&pccard_cis_debug, 0, "pccard CIS debug");
#ifdef PCCARDDEBUG
#define DPRINTF(arg) if (pccard_debug) kprintf arg
#define DEVPRINTF(arg) if (pccard_debug) device_printf arg
#define PRVERBOSE(arg) kprintf arg
#define DEVPRVERBOSE(arg) device_printf arg
#else
#define DPRINTF(arg)
#define DEVPRINTF(arg)
#define PRVERBOSE(arg) if (bootverbose) kprintf 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);
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_compat_do_probe(device_t bus, device_t dev);
static int pccard_compat_do_attach(device_t bus, device_t dev);
static int pccard_add_children(device_t dev, int busno);
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, int cpuid);
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, uint32_t flags);
static int pccard_set_memory_offset(device_t dev, device_t child, int rid,
uint32_t offset, uint32_t *deltap);
static void pccard_probe_nomatch(device_t cbdev, device_t child);
static int pccard_read_ivar(device_t bus, device_t child, int which,
u_char *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, int cpuid);
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 void pccard_intr(void *arg);
static int pccard_setup_intr(device_t dev, device_t child,
struct resource *irq, int flags, driver_intr_t *intr,
void *arg, void **cookiep, lwkt_serialize_t serializer,
const char *desc);
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;
vendorstr = pccard_get_vendor_str(dev);
prodstr = pccard_get_product_str(dev);
if (vendorstr != NULL && prodstr != NULL) {
str = kmalloc(strlen(vendorstr) + strlen(prodstr) + 2, M_DEVBUF,
M_WAITOK);
ksprintf(str, "%s %s", vendorstr, prodstr);
device_set_desc_copy(dev, str);
kfree(str, M_DEVBUF);
} else {
vendor = pccard_get_vendor(dev);
prod = pccard_get_product(dev);
str = kmalloc(100, M_DEVBUF, M_WAITOK);
ksnprintf(str, 100, "vendor=0x%x product=0x%x", vendor, prod);
device_set_desc_copy(dev, str);
kfree(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;
STAILQ_INIT(&sc->card.pf_head);
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);
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 = kmalloc(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_function_init(pf);
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_probe_and_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)));
} else {
if (pf->cfe != NULL)
pccard_function_disable(pf);
}
}
return (0);
}
static int
pccard_detach_card(device_t dev)
{
struct pccard_softc *sc = PCCARD_SOFTC(dev);
struct pccard_function *pf;
struct pccard_config_entry *cfe;
int state;
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);
device_delete_child(dev, pf->dev);
}
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);
kfree(cfe, M_DEVBUF);
}
STAILQ_REMOVE_HEAD(&sc->card.pf_head, pf_list);
kfree(pf, M_DEVBUF);
}
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
vendor = pccard_get_vendor(dev);
prod = pccard_get_product(dev);
vendorstr = pccard_get_vendor_str(dev);
prodstr = pccard_get_product_str(dev);
cis3str = pccard_get_cis3_str(dev);
cis4str = pccard_get_cis4_str(dev);
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);
}
static void
pccard_function_init(struct pccard_function *pf)
{
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;
device_t bus;
u_long start, end, len;
int i, rid, spaces;
if (pf->pf_flags & PFF_ENABLED) {
kprintf("pccard_function_init: function is enabled");
return;
}
bus = device_get_parent(pf->dev);
STAILQ_FOREACH(cfe, &pf->cfe_head, cfe_list) {
if (cfe->iftype != PCCARD_IFTYPE_IO)
continue;
spaces = 0;
for (i = 0; i < cfe->num_iospace; i++) {
start = cfe->iospace[i].start;
if (start)
end = start + cfe->iospace[i].length - 1;
else
end = ~0UL;
DEVPRINTF((bus, "I/O rid %d start %lx end %lx\n",
i, start, end));
rid = i;
len = cfe->iospace[i].length;
r = bus_alloc_resource(bus, SYS_RES_IOPORT, &rid,
start, end, len, rman_make_alignment_flags(len));
if (r == NULL)
goto not_this_one;
resource_list_add(rl, SYS_RES_IOPORT,
rid, rman_get_start(r), rman_get_end(r),
cfe->iospace[i].length, -1);
rle = resource_list_find(rl, SYS_RES_IOPORT, rid);
if (rle == NULL)
panic("Cannot add resource rid %d IOPORT", rid);
rle->res = r;
spaces++;
}
for (i = 0; i < cfe->num_memspace; i++) {
start = cfe->memspace[i].hostaddr;
if (start)
end = start + cfe->memspace[i].length - 1;
else
end = ~0UL;
DEVPRINTF((bus, "Memory rid %d start %lx end %lx\n",
i, start, end));
rid = i;
len = cfe->memspace[i].length;
r = bus_alloc_resource(bus, SYS_RES_MEMORY, &rid,
start, end, len, rman_make_alignment_flags(len));
if (r == NULL)
goto not_this_one;
resource_list_add(rl, SYS_RES_MEMORY,
rid, rman_get_start(r), rman_get_end(r),
cfe->memspace[i].length, -1);
rle = resource_list_find(rl, SYS_RES_MEMORY, rid);
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)
goto not_this_one;
resource_list_add(rl, SYS_RES_IRQ, rid,
rman_get_start(r), rman_get_end(r), 1,
rman_get_cpuid(r));
rle = resource_list_find(rl, SYS_RES_IRQ, rid);
if (rle == NULL)
panic("Cannot add resource rid %d IRQ", rid);
rle->res = r;
}
pf->cfe = cfe;
break;
not_this_one:;
DEVPRVERBOSE((bus, "Allocation failed for cfe %d\n",
cfe->number));
#if 0
resource_list_purge(rl);
#endif
}
}
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) {
kprintf("pccard_function_init: function is enabled");
return;
}
SLIST_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 {
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;
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);
}
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);
}
pf->sc->sc_enabled_count++;
if (pf->pf_flags & PFF_ENABLED) {
return (0);
}
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_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, 1 << 10, 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_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:
pf->sc->sc_enabled_count--;
DEVPRINTF((dev, "bad --enabled_count = %d\n", pf->sc->sc_enabled_count));
return (1);
}
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");
BUS_TEARDOWN_INTR(dev, pf->dev, rle->res,
pf->intr_handler_cookie);
}
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;
}
if (tmp == NULL) {
bus_release_resource(dev, SYS_RES_MEMORY, pf->ccr_rid,
pf->ccr_res);
pf->ccr_res = NULL;
}
pf->sc->sc_enabled_count--;
}
static int
pccard_compat_do_probe(device_t bus, device_t dev)
{
return (CARD_COMPAT_MATCH(dev));
}
static int
pccard_compat_do_attach(device_t bus, device_t dev)
{
int err;
err = CARD_COMPAT_PROBE(dev);
if (err <= 0)
err = CARD_COMPAT_ATTACH(dev);
return (err);
}
#define PCCARD_NPORT 2
#define PCCARD_NMEM 5
#define PCCARD_NIRQ 1
#define PCCARD_NDRQ 0
static int
pccard_add_children(device_t dev, int busno)
{
return (0);
}
static int
pccard_probe(device_t dev)
{
device_set_desc(dev, "16-bit PCCard bus");
return (pccard_add_children(dev, device_get_unit(dev)));
}
static int
pccard_attach(device_t dev)
{
struct pccard_softc *sc = PCCARD_SOFTC(dev);
sc->dev = dev;
sc->sc_enabled_count = 0;
return (bus_generic_attach(dev));
}
static int
pccard_detach(device_t dev)
{
pccard_detach_card(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)
kprintf(" %s ", name);
else if (printed > 0)
kprintf(",");
printed++;
kprintf(format, rle->start);
if (rle->count > 1) {
kprintf("-");
kprintf(format, rle->start + rle->count - 1);
}
} else if (i > 3) {
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 += kprintf(" 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 += kprintf(" 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, int cpuid)
{
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,
cpuid);
if (NULL != resource_list_alloc(rl, device_get_parent(dev), dev,
type, &rid, start, start + count - 1, count, 0, -1))
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,
uint32_t 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>");
kprintf(" (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; i < 4 && sc->card.cis1_info[i] != NULL; i++)
kprintf("%s%s", i > 0 ? ", " : "", sc->card.cis1_info[i]);
kprintf("\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;
ksnprintf(buf, buflen, "function=%d", pf->number);
return (0);
}
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 (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));
ksnprintf(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, u_char *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_ETHADDR:
*(const uint8_t **)result = pf->pf_funce_lan_nid;
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;
if (pccard_function_enable(pf) == 0 &&
device_probe_and_attach(child) == 0) {
DEVPRINTF((sc->dev, "function %d CCR at %d "
"offset %x: %x %x %x %x, %x %x %x %x, %x\n",
pf->number, pf->pf_ccr_window, pf->pf_ccr_offset,
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)));
} else {
if (pf->cfe != NULL)
pccard_function_disable(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, int cpuid)
{
struct pccard_ivar *dinfo;
struct resource_list_entry *rle = NULL;
int passthrough = (device_get_parent(child) != dev);
int isdefault = (start == 0 && end == ~0UL && count == 1);
struct resource *r = NULL;
if (passthrough) {
return (BUS_ALLOC_RESOURCE(device_get_parent(dev), child,
type, rid, start, end, count, flags, cpuid));
}
dinfo = device_get_ivars(child);
rle = resource_list_find(&dinfo->resources, type, *rid);
if (rle == NULL && isdefault)
return (NULL);
if (rle == NULL || rle->res == NULL) {
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,
rman_get_cpuid(r));
rle = resource_list_find(&dinfo->resources, type, *rid);
if (!rle)
goto bad;
rle->res = r;
}
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 %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;
}
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 void
pccard_intr(void *arg)
{
struct pccard_function *pf = (struct pccard_function*) arg;
int reg;
int doisr = 1;
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 (pf->intr_handler != NULL && doisr)
pf->intr_handler(pf->intr_handler_arg);
}
static int
pccard_setup_intr(device_t dev, device_t child, struct resource *irq,
int flags, driver_intr_t *intr, void *arg,
void **cookiep, lwkt_serialize_t serializer, const char *desc)
{
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_handler != NULL)
panic("Only one interrupt handler per function allowed");
err = bus_generic_setup_intr(dev, child, irq, flags, pccard_intr,
pf, cookiep, serializer, desc);
if (err != 0)
return (err);
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:
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)
{
return (bus_generic_deactivate_resource(brdev, child, type, rid, r));
}
static device_method_t pccard_methods[] = {
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),
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),
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_compat_do_probe, pccard_compat_do_probe),
DEVMETHOD(card_compat_do_attach, pccard_compat_do_attach),
DEVMETHOD(card_do_product_lookup, pccard_do_product_lookup),
DEVMETHOD(card_cis_scan, pccard_scan_cis),
DEVMETHOD_END
};
static driver_t pccard_driver = {
"pccard",
pccard_methods,
sizeof(struct pccard_softc)
};
devclass_t pccard_devclass;
DRIVER_MODULE(pccard, pcic, pccard_driver, pccard_devclass, NULL, NULL);
DRIVER_MODULE(pccard, cbb, pccard_driver, pccard_devclass, NULL, NULL);
MODULE_VERSION(pccard, 1);