29dcab8107
We can't call KeFlushQueuedDpcs() during bootstrap (cold == 1), since the flush operation sleeps to wait for completion, and we can't sleep here (clowns will eat us). On an i386 SMP system, if we're loaded/probed/attached during bootstrap, smp_rendezvous() won't run us anywhere except CPU 0 (since the other CPUs aren't launched until later), which means we won't be able to set up the GDTs anywhere except CPU 0. To deal with this case, ctxsw_utow() now checks to see if the TID for the current processor has been properly initialized and sets up the GTD for the current CPU if not. Lastly, in if_ndis.c:ndis_shutdown(), do an ndis_stop() to insure we really halt the NIC and stop interrupts from happening. Note that loading a driver during bootstrap is, unfortunately, kind of a hit or miss sort of proposition. In Windows, the expectation is that by the time a given driver's MiniportInitialize() method is called, the system is already in 'multiuser' state, i.e. it's up and running enough to support all the stuff specified in the NDIS API, which includes the underlying OS-supplied facilities it implicitly depends on, such as having all CPUs running, having the DPC queues initialized, WorkItem threads running, etc. But in UNIX, a lot of that stuff won't work during bootstrap. This causes a problem since we need to call MiniportInitialize() at least once during ndis_attach() in order to find out what kind of NIC we have and learn its station address. What this means is that some cards just plain won't work right if you try to pre-load the driver along with the kernel: they'll only be probed/attach correctly if the driver is kldloaded _after_ the system has reached multiuser. I can't really think of a way around this that would still preserve the ability to use an NDIS device for diskless booting.
1497 lines
33 KiB
C
1497 lines
33 KiB
C
/*-
|
|
* Copyright (c) 2003
|
|
* Bill Paul <wpaul@windriver.com>. 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 Bill Paul.
|
|
* 4. Neither the name of the author nor the names of any co-contributors
|
|
* may be used to endorse or promote products derived from this software
|
|
* without specific prior written permission.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY Bill Paul AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL Bill Paul OR THE VOICES IN HIS HEAD
|
|
* 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/unistd.h>
|
|
#include <sys/types.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/callout.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/queue.h>
|
|
#include <sys/sysctl.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/lock.h>
|
|
#include <sys/mutex.h>
|
|
#include <sys/conf.h>
|
|
|
|
#include <sys/kernel.h>
|
|
#include <sys/module.h>
|
|
#include <sys/kthread.h>
|
|
#include <machine/bus.h>
|
|
#include <machine/resource.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/rman.h>
|
|
|
|
#include <net/if.h>
|
|
#include <net/if_arp.h>
|
|
#include <net/ethernet.h>
|
|
#include <net/if_dl.h>
|
|
#include <net/if_media.h>
|
|
|
|
#include <net80211/ieee80211_var.h>
|
|
#include <net80211/ieee80211_ioctl.h>
|
|
|
|
#include <compat/ndis/pe_var.h>
|
|
#include <compat/ndis/cfg_var.h>
|
|
#include <compat/ndis/resource_var.h>
|
|
#include <compat/ndis/ntoskrnl_var.h>
|
|
#include <compat/ndis/ndis_var.h>
|
|
#include <compat/ndis/hal_var.h>
|
|
#include <compat/ndis/usbd_var.h>
|
|
#include <dev/if_ndis/if_ndisvar.h>
|
|
|
|
#define NDIS_DUMMY_PATH "\\\\some\\bogus\\path"
|
|
|
|
static void ndis_status_func(ndis_handle, ndis_status, void *, uint32_t);
|
|
static void ndis_statusdone_func(ndis_handle);
|
|
static void ndis_setdone_func(ndis_handle, ndis_status);
|
|
static void ndis_getdone_func(ndis_handle, ndis_status);
|
|
static void ndis_resetdone_func(ndis_handle, ndis_status, uint8_t);
|
|
static void ndis_sendrsrcavail_func(ndis_handle);
|
|
static void ndis_intrhand(kdpc *, device_object *,
|
|
irp *, struct ndis_softc *);
|
|
static void ndis_return(kdpc *, void *, void *, void *);
|
|
|
|
static image_patch_table kernndis_functbl[] = {
|
|
IMPORT_SFUNC(ndis_status_func, 4),
|
|
IMPORT_SFUNC(ndis_statusdone_func, 1),
|
|
IMPORT_SFUNC(ndis_setdone_func, 2),
|
|
IMPORT_SFUNC(ndis_getdone_func, 2),
|
|
IMPORT_SFUNC(ndis_resetdone_func, 3),
|
|
IMPORT_SFUNC(ndis_sendrsrcavail_func, 1),
|
|
IMPORT_SFUNC(ndis_intrhand, 4),
|
|
IMPORT_SFUNC(ndis_return, 1),
|
|
|
|
{ NULL, NULL, NULL }
|
|
};
|
|
|
|
struct nd_head ndis_devhead;
|
|
|
|
static struct mtx ndis_req_mtx;
|
|
|
|
/*
|
|
* This allows us to export our symbols to other modules.
|
|
* Note that we call ourselves 'ndisapi' to avoid a namespace
|
|
* collision with if_ndis.ko, which internally calls itself
|
|
* 'ndis.'
|
|
*/
|
|
|
|
static int
|
|
ndis_modevent(module_t mod, int cmd, void *arg)
|
|
{
|
|
int error = 0;
|
|
image_patch_table *patch;
|
|
|
|
switch (cmd) {
|
|
case MOD_LOAD:
|
|
/* Initialize subsystems */
|
|
windrv_libinit();
|
|
hal_libinit();
|
|
ndis_libinit();
|
|
ntoskrnl_libinit();
|
|
usbd_libinit();
|
|
|
|
patch = kernndis_functbl;
|
|
while (patch->ipt_func != NULL) {
|
|
windrv_wrap((funcptr)patch->ipt_func,
|
|
(funcptr *)&patch->ipt_wrap,
|
|
patch->ipt_argcnt, patch->ipt_ftype);
|
|
patch++;
|
|
}
|
|
|
|
TAILQ_INIT(&ndis_devhead);
|
|
|
|
mtx_init(&ndis_req_mtx, "NDIS request lock",
|
|
MTX_NDIS_LOCK, MTX_DEF);
|
|
|
|
break;
|
|
case MOD_SHUTDOWN:
|
|
if (TAILQ_FIRST(&ndis_devhead) == NULL) {
|
|
/* Shut down subsystems */
|
|
hal_libfini();
|
|
ndis_libfini();
|
|
ntoskrnl_libfini();
|
|
usbd_libfini();
|
|
windrv_libfini();
|
|
|
|
patch = kernndis_functbl;
|
|
while (patch->ipt_func != NULL) {
|
|
windrv_unwrap(patch->ipt_wrap);
|
|
patch++;
|
|
}
|
|
mtx_destroy(&ndis_req_mtx);
|
|
}
|
|
break;
|
|
case MOD_UNLOAD:
|
|
/* Shut down subsystems */
|
|
hal_libfini();
|
|
ndis_libfini();
|
|
ntoskrnl_libfini();
|
|
usbd_libfini();
|
|
windrv_libfini();
|
|
|
|
patch = kernndis_functbl;
|
|
while (patch->ipt_func != NULL) {
|
|
windrv_unwrap(patch->ipt_wrap);
|
|
patch++;
|
|
}
|
|
|
|
mtx_destroy(&ndis_req_mtx);
|
|
|
|
break;
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
|
|
return(error);
|
|
}
|
|
DEV_MODULE(ndisapi, ndis_modevent, NULL);
|
|
MODULE_VERSION(ndisapi, 1);
|
|
|
|
int
|
|
ndis_thsuspend(p, m, timo)
|
|
struct proc *p;
|
|
struct mtx *m;
|
|
int timo;
|
|
{
|
|
int error;
|
|
|
|
if (m != NULL) {
|
|
error = msleep(&p->p_siglist, m,
|
|
curthread->td_priority, "ndissp", timo);
|
|
} else {
|
|
PROC_LOCK(p);
|
|
error = msleep(&p->p_siglist, &p->p_mtx,
|
|
curthread->td_priority|PDROP, "ndissp", timo);
|
|
}
|
|
|
|
return(error);
|
|
}
|
|
|
|
void
|
|
ndis_thresume(p)
|
|
struct proc *p;
|
|
{
|
|
wakeup(&p->p_siglist);
|
|
return;
|
|
}
|
|
|
|
static void
|
|
ndis_sendrsrcavail_func(adapter)
|
|
ndis_handle adapter;
|
|
{
|
|
return;
|
|
}
|
|
|
|
static void
|
|
ndis_status_func(adapter, status, sbuf, slen)
|
|
ndis_handle adapter;
|
|
ndis_status status;
|
|
void *sbuf;
|
|
uint32_t slen;
|
|
{
|
|
ndis_miniport_block *block;
|
|
struct ndis_softc *sc;
|
|
struct ifnet *ifp;
|
|
|
|
block = adapter;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
ifp = &sc->arpcom.ac_if;
|
|
if (ifp->if_flags & IFF_DEBUG)
|
|
device_printf (sc->ndis_dev, "status: %x\n", status);
|
|
return;
|
|
}
|
|
|
|
static void
|
|
ndis_statusdone_func(adapter)
|
|
ndis_handle adapter;
|
|
{
|
|
ndis_miniport_block *block;
|
|
struct ndis_softc *sc;
|
|
struct ifnet *ifp;
|
|
|
|
block = adapter;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
ifp = &sc->arpcom.ac_if;
|
|
if (ifp->if_flags & IFF_DEBUG)
|
|
device_printf (sc->ndis_dev, "status complete\n");
|
|
return;
|
|
}
|
|
|
|
static void
|
|
ndis_setdone_func(adapter, status)
|
|
ndis_handle adapter;
|
|
ndis_status status;
|
|
{
|
|
ndis_miniport_block *block;
|
|
block = adapter;
|
|
|
|
block->nmb_setstat = status;
|
|
wakeup(&block->nmb_setstat);
|
|
return;
|
|
}
|
|
|
|
static void
|
|
ndis_getdone_func(adapter, status)
|
|
ndis_handle adapter;
|
|
ndis_status status;
|
|
{
|
|
ndis_miniport_block *block;
|
|
block = adapter;
|
|
|
|
block->nmb_getstat = status;
|
|
wakeup(&block->nmb_getstat);
|
|
return;
|
|
}
|
|
|
|
static void
|
|
ndis_resetdone_func(adapter, status, addressingreset)
|
|
ndis_handle adapter;
|
|
ndis_status status;
|
|
uint8_t addressingreset;
|
|
{
|
|
ndis_miniport_block *block;
|
|
struct ndis_softc *sc;
|
|
struct ifnet *ifp;
|
|
|
|
block = adapter;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
ifp = &sc->arpcom.ac_if;
|
|
|
|
if (ifp->if_flags & IFF_DEBUG)
|
|
device_printf (sc->ndis_dev, "reset done...\n");
|
|
wakeup(sc);
|
|
return;
|
|
}
|
|
|
|
int
|
|
ndis_create_sysctls(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_cfg *vals;
|
|
char buf[256];
|
|
struct sysctl_oid *oidp;
|
|
struct sysctl_ctx_entry *e;
|
|
|
|
if (arg == NULL)
|
|
return(EINVAL);
|
|
|
|
sc = arg;
|
|
vals = sc->ndis_regvals;
|
|
|
|
TAILQ_INIT(&sc->ndis_cfglist_head);
|
|
|
|
#if __FreeBSD_version < 502113
|
|
/* Create the sysctl tree. */
|
|
|
|
sc->ndis_tree = SYSCTL_ADD_NODE(&sc->ndis_ctx,
|
|
SYSCTL_STATIC_CHILDREN(_hw), OID_AUTO,
|
|
device_get_nameunit(sc->ndis_dev), CTLFLAG_RD, 0,
|
|
device_get_desc(sc->ndis_dev));
|
|
|
|
#endif
|
|
/* Add the driver-specific registry keys. */
|
|
|
|
vals = sc->ndis_regvals;
|
|
while(1) {
|
|
if (vals->nc_cfgkey == NULL)
|
|
break;
|
|
|
|
if (vals->nc_idx != sc->ndis_devidx) {
|
|
vals++;
|
|
continue;
|
|
}
|
|
|
|
/* See if we already have a sysctl with this name */
|
|
|
|
oidp = NULL;
|
|
#if __FreeBSD_version < 502113
|
|
TAILQ_FOREACH(e, &sc->ndis_ctx, link) {
|
|
#else
|
|
TAILQ_FOREACH(e, device_get_sysctl_ctx(sc->ndis_dev), link) {
|
|
#endif
|
|
oidp = e->entry;
|
|
if (ndis_strcasecmp(oidp->oid_name,
|
|
vals->nc_cfgkey) == 0)
|
|
break;
|
|
oidp = NULL;
|
|
}
|
|
|
|
if (oidp != NULL) {
|
|
vals++;
|
|
continue;
|
|
}
|
|
|
|
#if __FreeBSD_version < 502113
|
|
SYSCTL_ADD_STRING(&sc->ndis_ctx,
|
|
SYSCTL_CHILDREN(sc->ndis_tree),
|
|
#else
|
|
SYSCTL_ADD_STRING(device_get_sysctl_ctx(sc->ndis_dev),
|
|
SYSCTL_CHILDREN(device_get_sysctl_tree(sc->ndis_dev)),
|
|
#endif
|
|
OID_AUTO, vals->nc_cfgkey,
|
|
CTLFLAG_RW, vals->nc_val,
|
|
sizeof(vals->nc_val),
|
|
vals->nc_cfgdesc);
|
|
vals++;
|
|
}
|
|
|
|
/* Now add a couple of builtin keys. */
|
|
|
|
/*
|
|
* Environment can be either Windows (0) or WindowsNT (1).
|
|
* We qualify as the latter.
|
|
*/
|
|
ndis_add_sysctl(sc, "Environment",
|
|
"Windows environment", "1", CTLFLAG_RD);
|
|
|
|
/* NDIS version should be 5.1. */
|
|
ndis_add_sysctl(sc, "NdisVersion",
|
|
"NDIS API Version", "0x00050001", CTLFLAG_RD);
|
|
|
|
/* Bus type (PCI, PCMCIA, etc...) */
|
|
sprintf(buf, "%d", (int)sc->ndis_iftype);
|
|
ndis_add_sysctl(sc, "BusType", "Bus Type", buf, CTLFLAG_RD);
|
|
|
|
if (sc->ndis_res_io != NULL) {
|
|
sprintf(buf, "0x%lx", rman_get_start(sc->ndis_res_io));
|
|
ndis_add_sysctl(sc, "IOBaseAddress",
|
|
"Base I/O Address", buf, CTLFLAG_RD);
|
|
}
|
|
|
|
if (sc->ndis_irq != NULL) {
|
|
sprintf(buf, "%lu", rman_get_start(sc->ndis_irq));
|
|
ndis_add_sysctl(sc, "InterruptNumber",
|
|
"Interrupt Number", buf, CTLFLAG_RD);
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_add_sysctl(arg, key, desc, val, flag)
|
|
void *arg;
|
|
char *key;
|
|
char *desc;
|
|
char *val;
|
|
int flag;
|
|
{
|
|
struct ndis_softc *sc;
|
|
struct ndis_cfglist *cfg;
|
|
char descstr[256];
|
|
|
|
sc = arg;
|
|
|
|
cfg = malloc(sizeof(struct ndis_cfglist), M_DEVBUF, M_NOWAIT|M_ZERO);
|
|
|
|
if (cfg == NULL)
|
|
return(ENOMEM);
|
|
|
|
cfg->ndis_cfg.nc_cfgkey = strdup(key, M_DEVBUF);
|
|
if (desc == NULL) {
|
|
snprintf(descstr, sizeof(descstr), "%s (dynamic)", key);
|
|
cfg->ndis_cfg.nc_cfgdesc = strdup(descstr, M_DEVBUF);
|
|
} else
|
|
cfg->ndis_cfg.nc_cfgdesc = strdup(desc, M_DEVBUF);
|
|
strcpy(cfg->ndis_cfg.nc_val, val);
|
|
|
|
TAILQ_INSERT_TAIL(&sc->ndis_cfglist_head, cfg, link);
|
|
|
|
#if __FreeBSD_version < 502113
|
|
SYSCTL_ADD_STRING(&sc->ndis_ctx, SYSCTL_CHILDREN(sc->ndis_tree),
|
|
#else
|
|
SYSCTL_ADD_STRING(device_get_sysctl_ctx(sc->ndis_dev),
|
|
SYSCTL_CHILDREN(device_get_sysctl_tree(sc->ndis_dev)),
|
|
#endif
|
|
OID_AUTO, cfg->ndis_cfg.nc_cfgkey, flag,
|
|
cfg->ndis_cfg.nc_val, sizeof(cfg->ndis_cfg.nc_val),
|
|
cfg->ndis_cfg.nc_cfgdesc);
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_flush_sysctls(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
struct ndis_cfglist *cfg;
|
|
|
|
sc = arg;
|
|
|
|
while (!TAILQ_EMPTY(&sc->ndis_cfglist_head)) {
|
|
cfg = TAILQ_FIRST(&sc->ndis_cfglist_head);
|
|
TAILQ_REMOVE(&sc->ndis_cfglist_head, cfg, link);
|
|
free(cfg->ndis_cfg.nc_cfgkey, M_DEVBUF);
|
|
free(cfg->ndis_cfg.nc_cfgdesc, M_DEVBUF);
|
|
free(cfg, M_DEVBUF);
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
static void
|
|
ndis_return(dpc, arg, sysarg1, sysarg2)
|
|
kdpc *dpc;
|
|
void *arg;
|
|
void *sysarg1;
|
|
void *sysarg2;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_return_handler returnfunc;
|
|
ndis_handle adapter;
|
|
ndis_packet *p;
|
|
uint8_t irql;
|
|
|
|
p = arg;
|
|
sc = p->np_softc;
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
|
|
if (adapter == NULL)
|
|
return;
|
|
|
|
returnfunc = sc->ndis_chars->nmc_return_packet_func;
|
|
|
|
KeAcquireSpinLock(&sc->ndis_block->nmb_lock, &irql);
|
|
MSCALL2(returnfunc, adapter, p);
|
|
KeReleaseSpinLock(&sc->ndis_block->nmb_lock, irql);
|
|
|
|
return;
|
|
}
|
|
|
|
void
|
|
ndis_return_packet(buf, arg)
|
|
void *buf; /* not used */
|
|
void *arg;
|
|
{
|
|
ndis_packet *p;
|
|
|
|
if (arg == NULL)
|
|
return;
|
|
|
|
p = arg;
|
|
|
|
/* Decrement refcount. */
|
|
p->np_refcnt--;
|
|
|
|
/* Release packet when refcount hits zero, otherwise return. */
|
|
if (p->np_refcnt)
|
|
return;
|
|
|
|
KeInitializeDpc(&p->np_dpc, kernndis_functbl[7].ipt_wrap, p);
|
|
KeInsertQueueDpc(&p->np_dpc, NULL, NULL);
|
|
|
|
return;
|
|
}
|
|
|
|
void
|
|
ndis_free_bufs(b0)
|
|
ndis_buffer *b0;
|
|
{
|
|
ndis_buffer *next;
|
|
|
|
if (b0 == NULL)
|
|
return;
|
|
|
|
while(b0 != NULL) {
|
|
next = b0->mdl_next;
|
|
IoFreeMdl(b0);
|
|
b0 = next;
|
|
}
|
|
|
|
return;
|
|
}
|
|
int in_reset = 0;
|
|
void
|
|
ndis_free_packet(p)
|
|
ndis_packet *p;
|
|
{
|
|
if (p == NULL)
|
|
return;
|
|
|
|
ndis_free_bufs(p->np_private.npp_head);
|
|
NdisFreePacket(p);
|
|
return;
|
|
}
|
|
|
|
int
|
|
ndis_convert_res(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_resource_list *rl = NULL;
|
|
cm_partial_resource_desc *prd = NULL;
|
|
ndis_miniport_block *block;
|
|
device_t dev;
|
|
struct resource_list *brl;
|
|
struct resource_list_entry *brle;
|
|
#if __FreeBSD_version < 600022
|
|
struct resource_list brl_rev;
|
|
struct resource_list_entry *n;
|
|
#endif
|
|
int error = 0;
|
|
|
|
sc = arg;
|
|
block = sc->ndis_block;
|
|
dev = sc->ndis_dev;
|
|
|
|
#if __FreeBSD_version < 600022
|
|
SLIST_INIT(&brl_rev);
|
|
#endif
|
|
|
|
rl = malloc(sizeof(ndis_resource_list) +
|
|
(sizeof(cm_partial_resource_desc) * (sc->ndis_rescnt - 1)),
|
|
M_DEVBUF, M_NOWAIT|M_ZERO);
|
|
|
|
if (rl == NULL)
|
|
return(ENOMEM);
|
|
|
|
rl->cprl_version = 5;
|
|
rl->cprl_version = 1;
|
|
rl->cprl_count = sc->ndis_rescnt;
|
|
prd = rl->cprl_partial_descs;
|
|
|
|
brl = BUS_GET_RESOURCE_LIST(dev, dev);
|
|
|
|
if (brl != NULL) {
|
|
|
|
#if __FreeBSD_version < 600022
|
|
/*
|
|
* We have a small problem. Some PCI devices have
|
|
* multiple I/O ranges. Windows orders them starting
|
|
* from lowest numbered BAR to highest. We discover
|
|
* them in that order too, but insert them into a singly
|
|
* linked list head first, which means when time comes
|
|
* to traverse the list, we enumerate them in reverse
|
|
* order. This screws up some drivers which expect the
|
|
* BARs to be in ascending order so that they can choose
|
|
* the "first" one as their register space. Unfortunately,
|
|
* in order to fix this, we have to create our own
|
|
* temporary list with the entries in reverse order.
|
|
*/
|
|
|
|
SLIST_FOREACH(brle, brl, link) {
|
|
n = malloc(sizeof(struct resource_list_entry),
|
|
M_TEMP, M_NOWAIT);
|
|
if (n == NULL) {
|
|
error = ENOMEM;
|
|
goto bad;
|
|
}
|
|
bcopy((char *)brle, (char *)n,
|
|
sizeof(struct resource_list_entry));
|
|
SLIST_INSERT_HEAD(&brl_rev, n, link);
|
|
}
|
|
|
|
SLIST_FOREACH(brle, &brl_rev, link) {
|
|
#else
|
|
STAILQ_FOREACH(brle, brl, link) {
|
|
#endif
|
|
switch (brle->type) {
|
|
case SYS_RES_IOPORT:
|
|
prd->cprd_type = CmResourceTypePort;
|
|
prd->cprd_flags = CM_RESOURCE_PORT_IO;
|
|
prd->cprd_sharedisp =
|
|
CmResourceShareDeviceExclusive;
|
|
prd->u.cprd_port.cprd_start.np_quad =
|
|
brle->start;
|
|
prd->u.cprd_port.cprd_len = brle->count;
|
|
break;
|
|
case SYS_RES_MEMORY:
|
|
prd->cprd_type = CmResourceTypeMemory;
|
|
prd->cprd_flags =
|
|
CM_RESOURCE_MEMORY_READ_WRITE;
|
|
prd->cprd_sharedisp =
|
|
CmResourceShareDeviceExclusive;
|
|
prd->u.cprd_port.cprd_start.np_quad =
|
|
brle->start;
|
|
prd->u.cprd_port.cprd_len = brle->count;
|
|
break;
|
|
case SYS_RES_IRQ:
|
|
prd->cprd_type = CmResourceTypeInterrupt;
|
|
prd->cprd_flags = 0;
|
|
prd->cprd_sharedisp =
|
|
CmResourceShareDeviceExclusive;
|
|
prd->u.cprd_intr.cprd_level = brle->start;
|
|
prd->u.cprd_intr.cprd_vector = brle->start;
|
|
prd->u.cprd_intr.cprd_affinity = 0;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
prd++;
|
|
}
|
|
}
|
|
|
|
block->nmb_rlist = rl;
|
|
|
|
#if __FreeBSD_version < 600022
|
|
bad:
|
|
|
|
while (!SLIST_EMPTY(&brl_rev)) {
|
|
n = SLIST_FIRST(&brl_rev);
|
|
SLIST_REMOVE_HEAD(&brl_rev, link);
|
|
free (n, M_TEMP);
|
|
}
|
|
#endif
|
|
|
|
return(error);
|
|
}
|
|
|
|
/*
|
|
* Map an NDIS packet to an mbuf list. When an NDIS driver receives a
|
|
* packet, it will hand it to us in the form of an ndis_packet,
|
|
* which we need to convert to an mbuf that is then handed off
|
|
* to the stack. Note: we configure the mbuf list so that it uses
|
|
* the memory regions specified by the ndis_buffer structures in
|
|
* the ndis_packet as external storage. In most cases, this will
|
|
* point to a memory region allocated by the driver (either by
|
|
* ndis_malloc_withtag() or ndis_alloc_sharedmem()). We expect
|
|
* the driver to handle free()ing this region for is, so we set up
|
|
* a dummy no-op free handler for it.
|
|
*/
|
|
|
|
int
|
|
ndis_ptom(m0, p)
|
|
struct mbuf **m0;
|
|
ndis_packet *p;
|
|
{
|
|
struct mbuf *m, *prev = NULL;
|
|
ndis_buffer *buf;
|
|
ndis_packet_private *priv;
|
|
uint32_t totlen = 0;
|
|
|
|
if (p == NULL || m0 == NULL)
|
|
return(EINVAL);
|
|
|
|
priv = &p->np_private;
|
|
buf = priv->npp_head;
|
|
p->np_refcnt = 0;
|
|
|
|
for (buf = priv->npp_head; buf != NULL; buf = buf->mdl_next) {
|
|
if (buf == priv->npp_head)
|
|
MGETHDR(m, M_DONTWAIT, MT_HEADER);
|
|
else
|
|
MGET(m, M_DONTWAIT, MT_DATA);
|
|
if (m == NULL) {
|
|
m_freem(*m0);
|
|
*m0 = NULL;
|
|
return(ENOBUFS);
|
|
}
|
|
m->m_len = MmGetMdlByteCount(buf);
|
|
m->m_data = MmGetMdlVirtualAddress(buf);
|
|
MEXTADD(m, m->m_data, m->m_len, ndis_return_packet,
|
|
p, 0, EXT_NDIS);
|
|
p->np_refcnt++;
|
|
totlen += m->m_len;
|
|
if (m->m_flags & MT_HEADER)
|
|
*m0 = m;
|
|
else
|
|
prev->m_next = m;
|
|
prev = m;
|
|
}
|
|
|
|
(*m0)->m_pkthdr.len = totlen;
|
|
|
|
return(0);
|
|
}
|
|
|
|
/*
|
|
* Create an NDIS packet from an mbuf chain.
|
|
* This is used mainly when transmitting packets, where we need
|
|
* to turn an mbuf off an interface's send queue and transform it
|
|
* into an NDIS packet which will be fed into the NDIS driver's
|
|
* send routine.
|
|
*
|
|
* NDIS packets consist of two parts: an ndis_packet structure,
|
|
* which is vaguely analagous to the pkthdr portion of an mbuf,
|
|
* and one or more ndis_buffer structures, which define the
|
|
* actual memory segments in which the packet data resides.
|
|
* We need to allocate one ndis_buffer for each mbuf in a chain,
|
|
* plus one ndis_packet as the header.
|
|
*/
|
|
|
|
int
|
|
ndis_mtop(m0, p)
|
|
struct mbuf *m0;
|
|
ndis_packet **p;
|
|
{
|
|
struct mbuf *m;
|
|
ndis_buffer *buf = NULL, *prev = NULL;
|
|
ndis_packet_private *priv;
|
|
|
|
if (p == NULL || *p == NULL || m0 == NULL)
|
|
return(EINVAL);
|
|
|
|
priv = &(*p)->np_private;
|
|
priv->npp_totlen = m0->m_pkthdr.len;
|
|
|
|
for (m = m0; m != NULL; m = m->m_next) {
|
|
if (m->m_len == 0)
|
|
continue;
|
|
buf = IoAllocateMdl(m->m_data, m->m_len, FALSE, FALSE, NULL);
|
|
if (buf == NULL) {
|
|
ndis_free_packet(*p);
|
|
*p = NULL;
|
|
return(ENOMEM);
|
|
}
|
|
|
|
if (priv->npp_head == NULL)
|
|
priv->npp_head = buf;
|
|
else
|
|
prev->mdl_next = buf;
|
|
prev = buf;
|
|
}
|
|
|
|
priv->npp_tail = buf;
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_get_supported_oids(arg, oids, oidcnt)
|
|
void *arg;
|
|
ndis_oid **oids;
|
|
int *oidcnt;
|
|
{
|
|
int len, rval;
|
|
ndis_oid *o;
|
|
|
|
if (arg == NULL || oids == NULL || oidcnt == NULL)
|
|
return(EINVAL);
|
|
len = 0;
|
|
ndis_get_info(arg, OID_GEN_SUPPORTED_LIST, NULL, &len);
|
|
|
|
o = malloc(len, M_DEVBUF, M_NOWAIT);
|
|
if (o == NULL)
|
|
return(ENOMEM);
|
|
|
|
rval = ndis_get_info(arg, OID_GEN_SUPPORTED_LIST, o, &len);
|
|
|
|
if (rval) {
|
|
free(o, M_DEVBUF);
|
|
return(rval);
|
|
}
|
|
|
|
*oids = o;
|
|
*oidcnt = len / 4;
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_set_info(arg, oid, buf, buflen)
|
|
void *arg;
|
|
ndis_oid oid;
|
|
void *buf;
|
|
int *buflen;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_status rval;
|
|
ndis_handle adapter;
|
|
ndis_setinfo_handler setfunc;
|
|
uint32_t byteswritten = 0, bytesneeded = 0;
|
|
int error;
|
|
uint8_t irql;
|
|
|
|
/*
|
|
* According to the NDIS spec, MiniportQueryInformation()
|
|
* and MiniportSetInformation() requests are handled serially:
|
|
* once one request has been issued, we must wait for it to
|
|
* finish before allowing another request to proceed.
|
|
*/
|
|
|
|
sc = arg;
|
|
|
|
KeAcquireSpinLock(&sc->ndis_block->nmb_lock, &irql);
|
|
|
|
if (sc->ndis_block->nmb_pendingreq != NULL)
|
|
panic("ndis_set_info() called while other request pending");
|
|
else
|
|
sc->ndis_block->nmb_pendingreq = (ndis_request *)sc;
|
|
|
|
NDIS_LOCK(sc);
|
|
setfunc = sc->ndis_chars->nmc_setinfo_func;
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
|
|
if (adapter == NULL || setfunc == NULL ||
|
|
sc->ndis_block->nmb_devicectx == NULL) {
|
|
sc->ndis_block->nmb_pendingreq = NULL;
|
|
NDIS_UNLOCK(sc);
|
|
KeReleaseSpinLock(&sc->ndis_block->nmb_lock, irql);
|
|
return(ENXIO);
|
|
}
|
|
|
|
NDIS_UNLOCK(sc);
|
|
|
|
rval = MSCALL6(setfunc, adapter, oid, buf, *buflen,
|
|
&byteswritten, &bytesneeded);
|
|
|
|
sc->ndis_block->nmb_pendingreq = NULL;
|
|
|
|
KeReleaseSpinLock(&sc->ndis_block->nmb_lock, irql);
|
|
|
|
if (rval == NDIS_STATUS_PENDING) {
|
|
mtx_lock(&ndis_req_mtx);
|
|
error = msleep(&sc->ndis_block->nmb_setstat,
|
|
&ndis_req_mtx,
|
|
curthread->td_priority|PDROP,
|
|
"ndisset", 5 * hz);
|
|
rval = sc->ndis_block->nmb_setstat;
|
|
}
|
|
|
|
|
|
if (byteswritten)
|
|
*buflen = byteswritten;
|
|
if (bytesneeded)
|
|
*buflen = bytesneeded;
|
|
|
|
if (rval == NDIS_STATUS_INVALID_LENGTH)
|
|
return(ENOSPC);
|
|
|
|
if (rval == NDIS_STATUS_INVALID_OID)
|
|
return(EINVAL);
|
|
|
|
if (rval == NDIS_STATUS_NOT_SUPPORTED ||
|
|
rval == NDIS_STATUS_NOT_ACCEPTED)
|
|
return(ENOTSUP);
|
|
|
|
if (rval != NDIS_STATUS_SUCCESS)
|
|
return(ENODEV);
|
|
|
|
return(0);
|
|
}
|
|
|
|
typedef void (*ndis_senddone_func)(ndis_handle, ndis_packet *, ndis_status);
|
|
|
|
int
|
|
ndis_send_packets(arg, packets, cnt)
|
|
void *arg;
|
|
ndis_packet **packets;
|
|
int cnt;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
ndis_sendmulti_handler sendfunc;
|
|
ndis_senddone_func senddonefunc;
|
|
int i;
|
|
ndis_packet *p;
|
|
uint8_t irql;
|
|
|
|
sc = arg;
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
if (adapter == NULL)
|
|
return(ENXIO);
|
|
sendfunc = sc->ndis_chars->nmc_sendmulti_func;
|
|
senddonefunc = sc->ndis_block->nmb_senddone_func;
|
|
|
|
if (NDIS_SERIALIZED(sc->ndis_block))
|
|
KeAcquireSpinLock(&sc->ndis_block->nmb_lock, &irql);
|
|
|
|
MSCALL3(sendfunc, adapter, packets, cnt);
|
|
|
|
for (i = 0; i < cnt; i++) {
|
|
p = packets[i];
|
|
/*
|
|
* Either the driver already handed the packet to
|
|
* ndis_txeof() due to a failure, or it wants to keep
|
|
* it and release it asynchronously later. Skip to the
|
|
* next one.
|
|
*/
|
|
if (p == NULL || p->np_oob.npo_status == NDIS_STATUS_PENDING)
|
|
continue;
|
|
MSCALL3(senddonefunc, sc->ndis_block, p, p->np_oob.npo_status);
|
|
}
|
|
|
|
if (NDIS_SERIALIZED(sc->ndis_block))
|
|
KeReleaseSpinLock(&sc->ndis_block->nmb_lock, irql);
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_send_packet(arg, packet)
|
|
void *arg;
|
|
ndis_packet *packet;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
ndis_status status;
|
|
ndis_sendsingle_handler sendfunc;
|
|
ndis_senddone_func senddonefunc;
|
|
uint8_t irql;
|
|
|
|
sc = arg;
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
if (adapter == NULL)
|
|
return(ENXIO);
|
|
sendfunc = sc->ndis_chars->nmc_sendsingle_func;
|
|
senddonefunc = sc->ndis_block->nmb_senddone_func;
|
|
|
|
if (NDIS_SERIALIZED(sc->ndis_block))
|
|
KeAcquireSpinLock(&sc->ndis_block->nmb_lock, &irql);
|
|
status = MSCALL3(sendfunc, adapter, packet,
|
|
packet->np_private.npp_flags);
|
|
|
|
if (status == NDIS_STATUS_PENDING) {
|
|
if (NDIS_SERIALIZED(sc->ndis_block))
|
|
KeReleaseSpinLock(&sc->ndis_block->nmb_lock, irql);
|
|
return(0);
|
|
}
|
|
|
|
MSCALL3(senddonefunc, sc->ndis_block, packet, status);
|
|
|
|
if (NDIS_SERIALIZED(sc->ndis_block))
|
|
KeReleaseSpinLock(&sc->ndis_block->nmb_lock, irql);
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_init_dma(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
int i, error;
|
|
|
|
sc = arg;
|
|
|
|
sc->ndis_tmaps = malloc(sizeof(bus_dmamap_t) * sc->ndis_maxpkts,
|
|
M_DEVBUF, M_NOWAIT|M_ZERO);
|
|
|
|
if (sc->ndis_tmaps == NULL)
|
|
return(ENOMEM);
|
|
|
|
for (i = 0; i < sc->ndis_maxpkts; i++) {
|
|
error = bus_dmamap_create(sc->ndis_ttag, 0,
|
|
&sc->ndis_tmaps[i]);
|
|
if (error) {
|
|
free(sc->ndis_tmaps, M_DEVBUF);
|
|
return(ENODEV);
|
|
}
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_destroy_dma(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
struct mbuf *m;
|
|
ndis_packet *p = NULL;
|
|
int i;
|
|
|
|
sc = arg;
|
|
|
|
for (i = 0; i < sc->ndis_maxpkts; i++) {
|
|
if (sc->ndis_txarray[i] != NULL) {
|
|
p = sc->ndis_txarray[i];
|
|
m = (struct mbuf *)p->np_rsvd[1];
|
|
if (m != NULL)
|
|
m_freem(m);
|
|
ndis_free_packet(sc->ndis_txarray[i]);
|
|
}
|
|
bus_dmamap_destroy(sc->ndis_ttag, sc->ndis_tmaps[i]);
|
|
}
|
|
|
|
free(sc->ndis_tmaps, M_DEVBUF);
|
|
|
|
bus_dma_tag_destroy(sc->ndis_ttag);
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_reset_nic(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
ndis_reset_handler resetfunc;
|
|
uint8_t addressing_reset;
|
|
int rval;
|
|
uint8_t irql;
|
|
|
|
sc = arg;
|
|
|
|
NDIS_LOCK(sc);
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
resetfunc = sc->ndis_chars->nmc_reset_func;
|
|
|
|
if (adapter == NULL || resetfunc == NULL ||
|
|
sc->ndis_block->nmb_devicectx == NULL) {
|
|
NDIS_UNLOCK(sc);
|
|
return(EIO);
|
|
}
|
|
|
|
NDIS_UNLOCK(sc);
|
|
|
|
if (NDIS_SERIALIZED(sc->ndis_block))
|
|
KeAcquireSpinLock(&sc->ndis_block->nmb_lock, &irql);
|
|
|
|
rval = MSCALL2(resetfunc, &addressing_reset, adapter);
|
|
|
|
if (NDIS_SERIALIZED(sc->ndis_block))
|
|
KeReleaseSpinLock(&sc->ndis_block->nmb_lock, irql);
|
|
|
|
if (rval == NDIS_STATUS_PENDING) {
|
|
mtx_lock(&ndis_req_mtx);
|
|
msleep(sc, &ndis_req_mtx,
|
|
curthread->td_priority|PDROP, "ndisrst", 0);
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
#define NDIS_REAP_TIMERS
|
|
|
|
int
|
|
ndis_halt_nic(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
ndis_halt_handler haltfunc;
|
|
#ifdef NDIS_REAP_TIMERS
|
|
ndis_miniport_timer *t, *n;
|
|
#endif
|
|
|
|
sc = arg;
|
|
|
|
#ifdef NDIS_REAP_TIMERS
|
|
/*
|
|
* Drivers are sometimes very lax about cancelling all
|
|
* their timers. Cancel them all ourselves, just to be
|
|
* safe. We must do this before invoking MiniportHalt(),
|
|
* since if we wait until after, the memory in which
|
|
* the timers reside will no longer be valid.
|
|
*/
|
|
|
|
t = sc->ndis_block->nmb_timerlist;
|
|
while (t != NULL) {
|
|
KeCancelTimer(&t->nmt_ktimer);
|
|
n = t;
|
|
t = t->nmt_nexttimer;
|
|
n->nmt_nexttimer = NULL;
|
|
}
|
|
sc->ndis_block->nmb_timerlist = NULL;
|
|
if (!cold)
|
|
KeFlushQueuedDpcs();
|
|
#endif
|
|
|
|
NDIS_LOCK(sc);
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
if (adapter == NULL) {
|
|
NDIS_UNLOCK(sc);
|
|
return(EIO);
|
|
}
|
|
|
|
sc->ndis_block->nmb_miniportadapterctx = NULL;
|
|
sc->ndis_block->nmb_devicectx = NULL;
|
|
|
|
/*
|
|
* The adapter context is only valid after the init
|
|
* handler has been called, and is invalid once the
|
|
* halt handler has been called.
|
|
*/
|
|
|
|
haltfunc = sc->ndis_chars->nmc_halt_func;
|
|
NDIS_UNLOCK(sc);
|
|
|
|
MSCALL1(haltfunc, adapter);
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_shutdown_nic(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
ndis_shutdown_handler shutdownfunc;
|
|
|
|
sc = arg;
|
|
NDIS_LOCK(sc);
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
shutdownfunc = sc->ndis_chars->nmc_shutdown_handler;
|
|
NDIS_UNLOCK(sc);
|
|
if (adapter == NULL || shutdownfunc == NULL)
|
|
return(EIO);
|
|
|
|
if (sc->ndis_chars->nmc_rsvd0 == NULL)
|
|
MSCALL1(shutdownfunc, adapter);
|
|
else
|
|
MSCALL1(shutdownfunc, sc->ndis_chars->nmc_rsvd0);
|
|
|
|
TAILQ_REMOVE(&ndis_devhead, sc->ndis_block, link);
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_init_nic(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_miniport_block *block;
|
|
ndis_init_handler initfunc;
|
|
ndis_status status, openstatus = 0;
|
|
ndis_medium mediumarray[NdisMediumMax];
|
|
uint32_t chosenmedium, i;
|
|
|
|
if (arg == NULL)
|
|
return(EINVAL);
|
|
|
|
sc = arg;
|
|
NDIS_LOCK(sc);
|
|
block = sc->ndis_block;
|
|
initfunc = sc->ndis_chars->nmc_init_func;
|
|
NDIS_UNLOCK(sc);
|
|
|
|
sc->ndis_block->nmb_timerlist = NULL;
|
|
|
|
for (i = 0; i < NdisMediumMax; i++)
|
|
mediumarray[i] = i;
|
|
|
|
status = MSCALL6(initfunc, &openstatus, &chosenmedium,
|
|
mediumarray, NdisMediumMax, block, block);
|
|
|
|
/*
|
|
* If the init fails, blow away the other exported routines
|
|
* we obtained from the driver so we can't call them later.
|
|
* If the init failed, none of these will work.
|
|
*/
|
|
if (status != NDIS_STATUS_SUCCESS) {
|
|
NDIS_LOCK(sc);
|
|
sc->ndis_block->nmb_miniportadapterctx = NULL;
|
|
NDIS_UNLOCK(sc);
|
|
return(ENXIO);
|
|
}
|
|
|
|
/*
|
|
* This may look really goofy, but apparently it is possible
|
|
* to halt a miniport too soon after it's been initialized.
|
|
* After MiniportInitialize() finishes, pause for 1 second
|
|
* to give the chip a chance to handle any short-lived timers
|
|
* that were set in motion. If we call MiniportHalt() too soon,
|
|
* some of the timers may not be cancelled, because the driver
|
|
* expects them to fire before the halt is called.
|
|
*/
|
|
|
|
ndis_thsuspend(curthread->td_proc, NULL, hz);
|
|
|
|
NDIS_LOCK(sc);
|
|
sc->ndis_block->nmb_devicectx = sc;
|
|
NDIS_UNLOCK(sc);
|
|
|
|
return(0);
|
|
}
|
|
|
|
void
|
|
ndis_enable_intr(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
ndis_enable_interrupts_handler intrenbfunc;
|
|
|
|
sc = arg;
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
intrenbfunc = sc->ndis_chars->nmc_enable_interrupts_func;
|
|
if (adapter == NULL || intrenbfunc == NULL)
|
|
return;
|
|
MSCALL1(intrenbfunc, adapter);
|
|
|
|
return;
|
|
}
|
|
|
|
void
|
|
ndis_disable_intr(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
ndis_disable_interrupts_handler intrdisfunc;
|
|
|
|
sc = arg;
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
intrdisfunc = sc->ndis_chars->nmc_disable_interrupts_func;
|
|
if (adapter == NULL || intrdisfunc == NULL)
|
|
return;
|
|
|
|
MSCALL1(intrdisfunc, adapter);
|
|
|
|
return;
|
|
}
|
|
|
|
int
|
|
ndis_isr(arg, ourintr, callhandler)
|
|
void *arg;
|
|
int *ourintr;
|
|
int *callhandler;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
ndis_isr_handler isrfunc;
|
|
uint8_t accepted, queue;
|
|
|
|
if (arg == NULL || ourintr == NULL || callhandler == NULL)
|
|
return(EINVAL);
|
|
|
|
sc = arg;
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
isrfunc = sc->ndis_chars->nmc_isr_func;
|
|
|
|
if (adapter == NULL || isrfunc == NULL)
|
|
return(ENXIO);
|
|
|
|
MSCALL3(isrfunc, &accepted, &queue, adapter);
|
|
|
|
*ourintr = accepted;
|
|
*callhandler = queue;
|
|
|
|
return(0);
|
|
}
|
|
|
|
static void
|
|
ndis_intrhand(dpc, dobj, ip, sc)
|
|
kdpc *dpc;
|
|
device_object *dobj;
|
|
irp *ip;
|
|
struct ndis_softc *sc;
|
|
{
|
|
ndis_handle adapter;
|
|
ndis_interrupt_handler intrfunc;
|
|
uint8_t irql;
|
|
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
intrfunc = sc->ndis_chars->nmc_interrupt_func;
|
|
|
|
if (adapter == NULL || intrfunc == NULL)
|
|
return;
|
|
|
|
if (NDIS_SERIALIZED(sc->ndis_block))
|
|
KeAcquireSpinLock(&sc->ndis_block->nmb_lock, &irql);
|
|
|
|
MSCALL1(intrfunc, adapter);
|
|
|
|
/* If there's a MiniportEnableInterrupt() routine, call it. */
|
|
|
|
ndis_enable_intr(sc);
|
|
|
|
if (NDIS_SERIALIZED(sc->ndis_block))
|
|
KeReleaseSpinLock(&sc->ndis_block->nmb_lock, irql);
|
|
|
|
return;
|
|
}
|
|
|
|
int
|
|
ndis_get_info(arg, oid, buf, buflen)
|
|
void *arg;
|
|
ndis_oid oid;
|
|
void *buf;
|
|
int *buflen;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_status rval;
|
|
ndis_handle adapter;
|
|
ndis_queryinfo_handler queryfunc;
|
|
uint32_t byteswritten = 0, bytesneeded = 0;
|
|
int error;
|
|
uint8_t irql;
|
|
|
|
sc = arg;
|
|
|
|
KeAcquireSpinLock(&sc->ndis_block->nmb_lock, &irql);
|
|
|
|
if (sc->ndis_block->nmb_pendingreq != NULL)
|
|
panic("ndis_get_info() called while other request pending");
|
|
else
|
|
sc->ndis_block->nmb_pendingreq = (ndis_request *)sc;
|
|
|
|
NDIS_LOCK(sc);
|
|
queryfunc = sc->ndis_chars->nmc_queryinfo_func;
|
|
adapter = sc->ndis_block->nmb_miniportadapterctx;
|
|
|
|
if (adapter == NULL || queryfunc == NULL ||
|
|
sc->ndis_block->nmb_devicectx == NULL) {
|
|
sc->ndis_block->nmb_pendingreq = NULL;
|
|
NDIS_UNLOCK(sc);
|
|
KeReleaseSpinLock(&sc->ndis_block->nmb_lock, irql);
|
|
return(ENXIO);
|
|
}
|
|
|
|
NDIS_UNLOCK(sc);
|
|
|
|
rval = MSCALL6(queryfunc, adapter, oid, buf, *buflen,
|
|
&byteswritten, &bytesneeded);
|
|
|
|
sc->ndis_block->nmb_pendingreq = NULL;
|
|
|
|
KeReleaseSpinLock(&sc->ndis_block->nmb_lock, irql);
|
|
|
|
/* Wait for requests that block. */
|
|
|
|
if (rval == NDIS_STATUS_PENDING) {
|
|
mtx_lock(&ndis_req_mtx);
|
|
error = msleep(&sc->ndis_block->nmb_getstat,
|
|
&ndis_req_mtx,
|
|
curthread->td_priority|PDROP,
|
|
"ndisget", 5 * hz);
|
|
rval = sc->ndis_block->nmb_getstat;
|
|
}
|
|
|
|
if (byteswritten)
|
|
*buflen = byteswritten;
|
|
if (bytesneeded)
|
|
*buflen = bytesneeded;
|
|
|
|
if (rval == NDIS_STATUS_INVALID_LENGTH ||
|
|
rval == NDIS_STATUS_BUFFER_TOO_SHORT)
|
|
return(ENOSPC);
|
|
|
|
if (rval == NDIS_STATUS_INVALID_OID)
|
|
return(EINVAL);
|
|
|
|
if (rval == NDIS_STATUS_NOT_SUPPORTED ||
|
|
rval == NDIS_STATUS_NOT_ACCEPTED)
|
|
return(ENOTSUP);
|
|
|
|
if (rval != NDIS_STATUS_SUCCESS)
|
|
return(ENODEV);
|
|
|
|
return(0);
|
|
}
|
|
|
|
uint32_t
|
|
NdisAddDevice(drv, pdo)
|
|
driver_object *drv;
|
|
device_object *pdo;
|
|
{
|
|
device_object *fdo;
|
|
ndis_miniport_block *block;
|
|
struct ndis_softc *sc;
|
|
uint32_t status;
|
|
|
|
status = IoCreateDevice(drv, sizeof(ndis_miniport_block), NULL,
|
|
FILE_DEVICE_UNKNOWN, 0, FALSE, &fdo);
|
|
|
|
if (status != STATUS_SUCCESS)
|
|
return(status);
|
|
|
|
block = fdo->do_devext;
|
|
|
|
block->nmb_filterdbs.nf_ethdb = block;
|
|
block->nmb_deviceobj = fdo;
|
|
block->nmb_physdeviceobj = pdo;
|
|
block->nmb_nextdeviceobj = IoAttachDeviceToDeviceStack(fdo, pdo);
|
|
KeInitializeSpinLock(&block->nmb_lock);
|
|
|
|
/*
|
|
* Stash pointers to the miniport block and miniport
|
|
* characteristics info in the if_ndis softc so the
|
|
* UNIX wrapper driver can get to them later.
|
|
*/
|
|
sc = device_get_softc(pdo->do_devext);
|
|
sc->ndis_block = block;
|
|
sc->ndis_chars = IoGetDriverObjectExtension(drv, (void *)1);
|
|
|
|
/*
|
|
* If the driver has a MiniportTransferData() function,
|
|
* we should allocate a private RX packet pool.
|
|
*/
|
|
|
|
if (sc->ndis_chars->nmc_transferdata_func != NULL) {
|
|
NdisAllocatePacketPool(&status, &block->nmb_rxpool,
|
|
32, PROTOCOL_RESERVED_SIZE_IN_PACKET);
|
|
if (status != NDIS_STATUS_SUCCESS) {
|
|
IoDetachDevice(block->nmb_nextdeviceobj);
|
|
IoDeleteDevice(fdo);
|
|
return(status);
|
|
}
|
|
INIT_LIST_HEAD((&block->nmb_packetlist));
|
|
}
|
|
|
|
/* Give interrupt handling priority over timers. */
|
|
IoInitializeDpcRequest(fdo, kernndis_functbl[6].ipt_wrap);
|
|
KeSetImportanceDpc(&fdo->do_dpc, KDPC_IMPORTANCE_HIGH);
|
|
|
|
/* Finish up BSD-specific setup. */
|
|
|
|
block->nmb_signature = (void *)0xcafebabe;
|
|
block->nmb_status_func = kernndis_functbl[0].ipt_wrap;
|
|
block->nmb_statusdone_func = kernndis_functbl[1].ipt_wrap;
|
|
block->nmb_setdone_func = kernndis_functbl[2].ipt_wrap;
|
|
block->nmb_querydone_func = kernndis_functbl[3].ipt_wrap;
|
|
block->nmb_resetdone_func = kernndis_functbl[4].ipt_wrap;
|
|
block->nmb_sendrsrc_func = kernndis_functbl[5].ipt_wrap;
|
|
block->nmb_pendingreq = NULL;
|
|
|
|
TAILQ_INSERT_TAIL(&ndis_devhead, block, link);
|
|
|
|
return (STATUS_SUCCESS);
|
|
}
|
|
|
|
int
|
|
ndis_unload_driver(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
device_object *fdo;
|
|
|
|
sc = arg;
|
|
|
|
if (sc->ndis_block->nmb_rlist != NULL)
|
|
free(sc->ndis_block->nmb_rlist, M_DEVBUF);
|
|
|
|
ndis_flush_sysctls(sc);
|
|
|
|
TAILQ_REMOVE(&ndis_devhead, sc->ndis_block, link);
|
|
|
|
if (sc->ndis_chars->nmc_transferdata_func != NULL)
|
|
NdisFreePacketPool(sc->ndis_block->nmb_rxpool);
|
|
fdo = sc->ndis_block->nmb_deviceobj;
|
|
IoDetachDevice(sc->ndis_block->nmb_nextdeviceobj);
|
|
IoDeleteDevice(fdo);
|
|
|
|
return(0);
|
|
}
|