freebsd-nq/sys/dev/proto/proto_bus_pci.c
Marcel Moolenaar 67fb10f30c Add proto(4): A driver for prototyping and diagnostics.
It exposes I/O resources to user space, so that programs can peek
and poke at the hardware. It does not itself have knowledge about
the hardware device it attaches to.

Sponsored by:	Juniper Networks, Inc.
2014-04-28 17:58:40 +00:00

113 lines
3.3 KiB
C

/*-
* Copyright (c) 2014 Marcel Moolenaar
* 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.
*
* 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/bus.h>
#include <sys/conf.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <machine/bus.h>
#include <sys/rman.h>
#include <machine/resource.h>
#include <sys/sbuf.h>
#include <dev/pci/pcireg.h>
#include <dev/pci/pcivar.h>
#include <dev/proto/proto.h>
static int proto_pci_probe(device_t dev);
static int proto_pci_attach(device_t dev);
static device_method_t proto_pci_methods[] = {
/* Device interface */
DEVMETHOD(device_probe, proto_pci_probe),
DEVMETHOD(device_attach, proto_pci_attach),
DEVMETHOD(device_detach, proto_detach),
DEVMETHOD_END
};
static driver_t proto_pci_driver = {
proto_driver_name,
proto_pci_methods,
sizeof(struct proto_softc),
};
static int
proto_pci_probe(device_t dev)
{
struct sbuf *sb;
/* For now we only attach to function 0 devices. */
if (pci_get_function(dev) != 0)
return (ENXIO);
sb = sbuf_new_auto();
sbuf_printf(sb, "pci%d:%d:%d:%d", pci_get_domain(dev),
pci_get_bus(dev), pci_get_slot(dev), pci_get_function(dev));
sbuf_finish(sb);
device_set_desc_copy(dev, sbuf_data(sb));
sbuf_delete(sb);
return (BUS_PROBE_HOOVER);
}
static int
proto_pci_attach(device_t dev)
{
struct proto_softc *sc;
struct resource *res;
int bar, rid, type;
sc = device_get_softc(dev);
proto_add_resource(sc, PROTO_RES_PCICFG, 0, NULL);
for (bar = 0; bar < PCIR_MAX_BAR_0; bar++) {
rid = PCIR_BAR(bar);
type = SYS_RES_MEMORY;
res = bus_alloc_resource_any(dev, type, &rid, RF_ACTIVE);
if (res == NULL) {
type = SYS_RES_IOPORT;
res = bus_alloc_resource_any(dev, type, &rid,
RF_ACTIVE);
}
if (res != NULL)
proto_add_resource(sc, type, rid, res);
}
rid = 0;
type = SYS_RES_IRQ;
res = bus_alloc_resource_any(dev, type, &rid, RF_ACTIVE | RF_SHAREABLE);
if (res != NULL)
proto_add_resource(sc, type, rid, res);
return (proto_attach(dev));
}
DRIVER_MODULE(proto, pci, proto_pci_driver, proto_devclass, NULL, NULL);