79a95fe15c
calling the haltfunc. If an interrupt is triggered by the init or halt func, the IFF_UP flag must be set in order for us to be able to service it. In kern_ndis.c: implement a handler for NdisMSendResourcesAvailable() (currently does nothing since we don't really need it). In subr_ndis.c: - Correct ndis_init_string() and ndis_unicode_to_ansi(), which were both horribly broken. - Implement NdisImmediateReadPciSlotInformation() and NdisImmediateWritePciSlotInformation(). - Implement NdisBufferLength(). - Work around my first confirmed NDIS driver bug. The SMC 9462 gigE driver (natsemi 83820-based copper) incorrectly creates a spinlock in its DriverEntry() routine and then destroys it in its MiniportHalt() handler. This is wrong: spinlocks should be created in MiniportInit(). In a Windows environment, this is often not a problem because DriverEntry()/MiniportInit() are called once when the system boots and MiniportHalt() or the shutdown handler is called when the system halts. With this stuff in place, this driver now seems to work: ndis0: <SMC EZ Card 1000> port 0xe000-0xe0ff mem 0xda000000-0xda000fff irq 10 at device 9.0 on pci0 ndis0: assign PCI resources... ndis_open_file("FLASH9.hex", 18446744073709551615) ndis0: Ethernet address: 00:04:e2:0e:d3:f0
1180 lines
26 KiB
C
1180 lines
26 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/types.h>
|
|
#include <sys/errno.h>
|
|
#include <sys/callout.h>
|
|
#include <sys/socket.h>
|
|
#include <sys/queue.h>
|
|
#include <sys/sysctl.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/lock.h>
|
|
#include <sys/mutex.h>
|
|
#include <sys/conf.h>
|
|
|
|
#include <sys/kernel.h>
|
|
#include <machine/bus.h>
|
|
#include <machine/resource.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/rman.h>
|
|
|
|
#include <vm/uma.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 <dev/pccard/pccardvar.h>
|
|
#include "card_if.h"
|
|
|
|
#include <compat/ndis/pe_var.h>
|
|
#include <compat/ndis/resource_var.h>
|
|
#include <compat/ndis/ndis_var.h>
|
|
#include <compat/ndis/hal_var.h>
|
|
#include <compat/ndis/ntoskrnl_var.h>
|
|
#include <compat/ndis/cfg_var.h>
|
|
#include <dev/if_ndis/if_ndisvar.h>
|
|
|
|
#define __stdcall __attribute__((__stdcall__))
|
|
#define NDIS_DUMMY_PATH "\\\\some\\bogus\\path"
|
|
|
|
__stdcall static void ndis_status_func(ndis_handle, ndis_status,
|
|
void *, uint32_t);
|
|
__stdcall static void ndis_statusdone_func(ndis_handle);
|
|
__stdcall static void ndis_setdone_func(ndis_handle, ndis_status);
|
|
__stdcall static void ndis_getdone_func(ndis_handle, ndis_status);
|
|
__stdcall static void ndis_resetdone_func(ndis_handle, ndis_status, uint8_t);
|
|
__stdcall static void ndis_sendrsrcavail_func(ndis_handle);
|
|
|
|
static uma_zone_t ndis_packet_zone, ndis_buffer_zone;
|
|
|
|
/*
|
|
* 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;
|
|
|
|
switch (cmd) {
|
|
case MOD_LOAD:
|
|
ndis_packet_zone = uma_zcreate("NDIS packet",
|
|
sizeof(ndis_packet), NULL, NULL, NULL,
|
|
NULL, UMA_ALIGN_PTR, 0);
|
|
ndis_buffer_zone = uma_zcreate("NDIS buffer",
|
|
sizeof(ndis_buffer), NULL, NULL, NULL,
|
|
NULL, UMA_ALIGN_PTR, 0);
|
|
break;
|
|
case MOD_UNLOAD:
|
|
case MOD_SHUTDOWN:
|
|
uma_zdestroy(ndis_packet_zone);
|
|
uma_zdestroy(ndis_buffer_zone);
|
|
break;
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
|
|
return(error);
|
|
}
|
|
DEV_MODULE(ndisapi, ndis_modevent, NULL);
|
|
MODULE_VERSION(ndisapi, 1);
|
|
|
|
|
|
__stdcall static void
|
|
ndis_sendrsrcavail_func(adapter)
|
|
ndis_handle adapter;
|
|
{
|
|
return;
|
|
}
|
|
|
|
__stdcall static void
|
|
ndis_status_func(adapter, status, sbuf, slen)
|
|
ndis_handle adapter;
|
|
ndis_status status;
|
|
void *sbuf;
|
|
uint32_t slen;
|
|
{
|
|
ndis_miniport_block *block;
|
|
block = adapter;
|
|
|
|
device_printf (block->nmb_dev, "status: %x\n", status);
|
|
return;
|
|
}
|
|
|
|
__stdcall static void
|
|
ndis_statusdone_func(adapter)
|
|
ndis_handle adapter;
|
|
{
|
|
ndis_miniport_block *block;
|
|
block = adapter;
|
|
|
|
device_printf (block->nmb_dev, "status complete\n");
|
|
return;
|
|
}
|
|
|
|
__stdcall 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_wkupdpctimer);
|
|
return;
|
|
}
|
|
|
|
__stdcall 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_wkupdpctimer);
|
|
return;
|
|
}
|
|
|
|
__stdcall static void
|
|
ndis_resetdone_func(adapter, status, addressingreset)
|
|
ndis_handle adapter;
|
|
ndis_status status;
|
|
uint8_t addressingreset;
|
|
{
|
|
ndis_miniport_block *block;
|
|
block = adapter;
|
|
|
|
device_printf (block->nmb_dev, "reset done...\n");
|
|
return;
|
|
}
|
|
|
|
#define NDIS_AM_RID 3
|
|
|
|
int
|
|
ndis_alloc_amem(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
int error, rid;
|
|
|
|
if (arg == NULL)
|
|
return(EINVAL);
|
|
|
|
sc = arg;
|
|
rid = NDIS_AM_RID;
|
|
sc->ndis_res_am = bus_alloc_resource(sc->ndis_dev, SYS_RES_MEMORY,
|
|
&rid, 0UL, ~0UL, 0x1000, RF_ACTIVE);
|
|
|
|
if (sc->ndis_res_am == NULL) {
|
|
device_printf(sc->ndis_dev,
|
|
"failed to allocate attribute memory\n");
|
|
return(ENXIO);
|
|
}
|
|
|
|
error = CARD_SET_MEMORY_OFFSET(device_get_parent(sc->ndis_dev),
|
|
sc->ndis_dev, rid, 0, NULL);
|
|
|
|
if (error) {
|
|
device_printf(sc->ndis_dev,
|
|
"CARD_SET_MEMORY_OFFSET() returned 0x%x\n", error);
|
|
return(error);
|
|
}
|
|
|
|
error = CARD_SET_RES_FLAGS(device_get_parent(sc->ndis_dev),
|
|
sc->ndis_dev, SYS_RES_MEMORY, rid, PCCARD_A_MEM_ATTR);
|
|
|
|
if (error) {
|
|
device_printf(sc->ndis_dev,
|
|
"CARD_SET_RES_FLAGS() returned 0x%x\n", error);
|
|
return(error);
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_create_sysctls(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_cfg *vals;
|
|
char buf[256];
|
|
|
|
if (arg == NULL)
|
|
return(EINVAL);
|
|
|
|
sc = arg;
|
|
vals = sc->ndis_regvals;
|
|
|
|
TAILQ_INIT(&sc->ndis_cfglist_head);
|
|
|
|
/* 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));
|
|
|
|
/* 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;
|
|
}
|
|
SYSCTL_ADD_STRING(&sc->ndis_ctx,
|
|
SYSCTL_CHILDREN(sc->ndis_tree),
|
|
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\n", (int)sc->ndis_iftype);
|
|
ndis_add_sysctl(sc, "BusType", "Bus Type", buf, CTLFLAG_RD);
|
|
|
|
if (sc->ndis_res_io != NULL) {
|
|
sprintf(buf, "0x%lx\n", 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\n", 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);
|
|
|
|
SYSCTL_ADD_STRING(&sc->ndis_ctx, SYSCTL_CHILDREN(sc->ndis_tree),
|
|
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);
|
|
}
|
|
|
|
void
|
|
ndis_return_packet(buf, arg)
|
|
void *buf; /* not used */
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
ndis_packet *p;
|
|
__stdcall ndis_return_handler returnfunc;
|
|
|
|
if (arg == NULL)
|
|
return;
|
|
|
|
p = arg;
|
|
|
|
/* Decrement refcount. */
|
|
p->np_refcnt--;
|
|
|
|
/* Release packet when refcount hits zero, otherwise return. */
|
|
if (p->np_refcnt)
|
|
return;
|
|
|
|
sc = p->np_softc;
|
|
returnfunc = sc->ndis_chars.nmc_return_packet_func;
|
|
adapter = sc->ndis_block.nmb_miniportadapterctx;
|
|
if (returnfunc != NULL)
|
|
returnfunc(adapter, p);
|
|
|
|
return;
|
|
}
|
|
|
|
void
|
|
ndis_free_bufs(b0)
|
|
ndis_buffer *b0;
|
|
{
|
|
ndis_buffer *next;
|
|
|
|
if (b0 == NULL)
|
|
return;
|
|
|
|
while(b0 != NULL) {
|
|
next = b0->nb_next;
|
|
uma_zfree (ndis_buffer_zone, b0);
|
|
b0 = next;
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
void
|
|
ndis_free_packet(p)
|
|
ndis_packet *p;
|
|
{
|
|
if (p == NULL)
|
|
return;
|
|
|
|
ndis_free_bufs(p->np_private.npp_head);
|
|
uma_zfree(ndis_packet_zone, 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;
|
|
|
|
sc = arg;
|
|
block = &sc->ndis_block;
|
|
dev = sc->ndis_dev;
|
|
|
|
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(device_get_parent(dev), dev);
|
|
if (brl != NULL) {
|
|
SLIST_FOREACH(brle, brl, link) {
|
|
switch (brle->type) {
|
|
case SYS_RES_IOPORT:
|
|
prd->cprd_type = CmResourceTypePort;
|
|
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->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->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;
|
|
|
|
return(0);
|
|
}
|
|
|
|
/*
|
|
* 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->nb_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 = buf->nb_bytecount;
|
|
m->m_data = MDL_VA(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 mbuf chain from an NDIS packet 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 || m0 == NULL)
|
|
return(EINVAL);
|
|
|
|
/* If caller didn't supply a packet, make one. */
|
|
if (*p == NULL) {
|
|
*p = uma_zalloc(ndis_packet_zone, M_NOWAIT|M_ZERO);
|
|
|
|
if (*p == NULL)
|
|
return(ENOMEM);
|
|
}
|
|
|
|
priv = &(*p)->np_private;
|
|
priv->npp_totlen = m0->m_pkthdr.len;
|
|
priv->npp_packetooboffset = offsetof(ndis_packet, np_oob);
|
|
|
|
for (m = m0; m != NULL; m = m->m_next) {
|
|
if (m->m_len == 0)
|
|
continue;
|
|
buf = uma_zalloc(ndis_buffer_zone, M_NOWAIT | M_ZERO);
|
|
if (buf == NULL) {
|
|
ndis_free_packet(*p);
|
|
*p = NULL;
|
|
return(ENOMEM);
|
|
}
|
|
|
|
MDL_INIT(buf, m->m_data, m->m_len);
|
|
if (priv->npp_head == NULL)
|
|
priv->npp_head = buf;
|
|
else
|
|
prev->nb_next = buf;
|
|
prev = buf;
|
|
}
|
|
|
|
priv->npp_tail = buf;
|
|
priv->npp_totlen = m0->m_pkthdr.len;
|
|
|
|
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;
|
|
__stdcall ndis_setinfo_handler setfunc;
|
|
uint32_t byteswritten = 0, bytesneeded = 0;
|
|
struct timeval tv;
|
|
int error;
|
|
|
|
sc = arg;
|
|
setfunc = sc->ndis_chars.nmc_setinfo_func;
|
|
adapter = sc->ndis_block.nmb_miniportadapterctx;
|
|
|
|
rval = setfunc(adapter, oid, buf, *buflen,
|
|
&byteswritten, &bytesneeded);
|
|
|
|
if (rval == NDIS_STATUS_PENDING) {
|
|
tv.tv_sec = 60;
|
|
tv.tv_usec = 0;
|
|
error = tsleep(&sc->ndis_block.nmb_wkupdpctimer,
|
|
PPAUSE|PCATCH, "ndisset", tvtohz(&tv));
|
|
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);
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_send_packets(arg, packets, cnt)
|
|
void *arg;
|
|
ndis_packet **packets;
|
|
int cnt;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
__stdcall ndis_sendmulti_handler sendfunc;
|
|
int i, idx;
|
|
struct ifnet *ifp;
|
|
struct mbuf *m;
|
|
ndis_packet *p;
|
|
|
|
sc = arg;
|
|
adapter = sc->ndis_block.nmb_miniportadapterctx;
|
|
sendfunc = sc->ndis_chars.nmc_sendmulti_func;
|
|
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;
|
|
idx = p->np_txidx;
|
|
m = p->np_m0;
|
|
ifp = &sc->arpcom.ac_if;
|
|
if (sc->ndis_sc)
|
|
bus_dmamap_unload(sc->ndis_ttag, sc->ndis_tmaps[idx]);
|
|
sc->ndis_txarray[idx] = NULL;
|
|
sc->ndis_txpending++;
|
|
m_freem(m);
|
|
ndis_free_packet(p);
|
|
if (p->np_oob.npo_status == NDIS_STATUS_SUCCESS)
|
|
ifp->if_opackets++;
|
|
else
|
|
ifp->if_oerrors++;
|
|
ifp->if_timer = 0;
|
|
ifp->if_flags &= ~IFF_OACTIVE;
|
|
}
|
|
|
|
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;
|
|
__stdcall ndis_reset_handler resetfunc;
|
|
uint8_t addressing_reset;
|
|
struct ifnet *ifp;
|
|
|
|
sc = arg;
|
|
ifp = &sc->arpcom.ac_if;
|
|
adapter = sc->ndis_block.nmb_miniportadapterctx;
|
|
if (adapter == NULL)
|
|
return(EIO);
|
|
resetfunc = sc->ndis_chars.nmc_reset_func;
|
|
|
|
if (resetfunc == NULL)
|
|
return(EINVAL);
|
|
|
|
resetfunc(&addressing_reset, adapter);
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_halt_nic(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
__stdcall ndis_halt_handler haltfunc;
|
|
struct ifnet *ifp;
|
|
struct ndis_timer_entry *ne;
|
|
|
|
sc = arg;
|
|
ifp = &sc->arpcom.ac_if;
|
|
adapter = sc->ndis_block.nmb_miniportadapterctx;
|
|
if (adapter == NULL)
|
|
return(EIO);
|
|
|
|
haltfunc = sc->ndis_chars.nmc_halt_func;
|
|
|
|
if (haltfunc == NULL)
|
|
return(EINVAL);
|
|
|
|
haltfunc(adapter);
|
|
|
|
/*
|
|
* The adapter context is only valid after the init
|
|
* handler has been called, and is invalid once the
|
|
* halt handler has been called.
|
|
*/
|
|
|
|
sc->ndis_block.nmb_miniportadapterctx = NULL;
|
|
|
|
/* Clobber all the timers in case the driver left one running. */
|
|
|
|
while (!TAILQ_EMPTY(&sc->ndis_block.nmb_timerlist)) {
|
|
ne = TAILQ_FIRST(&sc->ndis_block.nmb_timerlist);
|
|
TAILQ_REMOVE(&sc->ndis_block.nmb_timerlist, ne, link);
|
|
callout_stop(&ne->nte_ch);
|
|
free(ne, M_DEVBUF);
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_shutdown_nic(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
__stdcall ndis_shutdown_handler shutdownfunc;
|
|
|
|
|
|
sc = arg;
|
|
adapter = sc->ndis_block.nmb_miniportadapterctx;
|
|
if (adapter == NULL)
|
|
return(EIO);
|
|
shutdownfunc = sc->ndis_chars.nmc_shutdown_handler;
|
|
|
|
if (shutdownfunc == NULL)
|
|
return(EINVAL);
|
|
|
|
if (sc->ndis_chars.nmc_rsvd0 == NULL)
|
|
shutdownfunc(adapter);
|
|
else
|
|
shutdownfunc(sc->ndis_chars.nmc_rsvd0);
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_init_nic(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_miniport_block *block;
|
|
__stdcall ndis_init_handler initfunc;
|
|
ndis_status status, openstatus = 0;
|
|
ndis_medium mediumarray[NdisMediumMax];
|
|
uint32_t chosenmedium, i;
|
|
|
|
if (arg == NULL)
|
|
return(EINVAL);
|
|
|
|
sc = arg;
|
|
block = &sc->ndis_block;
|
|
initfunc = sc->ndis_chars.nmc_init_func;
|
|
|
|
TAILQ_INIT(&block->nmb_timerlist);
|
|
|
|
for (i = 0; i < NdisMediumMax; i++)
|
|
mediumarray[i] = i;
|
|
|
|
status = 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) {
|
|
bzero((char *)&sc->ndis_chars,
|
|
sizeof(ndis_miniport_characteristics));
|
|
return(ENXIO);
|
|
}
|
|
|
|
return(0);
|
|
}
|
|
|
|
void
|
|
ndis_enable_intr(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
__stdcall ndis_enable_interrupts_handler intrenbfunc;
|
|
|
|
sc = arg;
|
|
adapter = sc->ndis_block.nmb_miniportadapterctx;
|
|
if (adapter == NULL)
|
|
return;
|
|
intrenbfunc = sc->ndis_chars.nmc_enable_interrupts_func;
|
|
if (intrenbfunc == NULL)
|
|
return;
|
|
intrenbfunc(adapter);
|
|
|
|
return;
|
|
}
|
|
|
|
void
|
|
ndis_disable_intr(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
__stdcall ndis_disable_interrupts_handler intrdisfunc;
|
|
|
|
sc = arg;
|
|
adapter = sc->ndis_block.nmb_miniportadapterctx;
|
|
if (adapter == NULL)
|
|
return;
|
|
intrdisfunc = sc->ndis_chars.nmc_disable_interrupts_func;
|
|
if (intrdisfunc == NULL)
|
|
return;
|
|
intrdisfunc(adapter);
|
|
|
|
return;
|
|
}
|
|
|
|
int
|
|
ndis_isr(arg, ourintr, callhandler)
|
|
void *arg;
|
|
int *ourintr;
|
|
int *callhandler;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
__stdcall 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;
|
|
isrfunc(&accepted, &queue, adapter);
|
|
*ourintr = accepted;
|
|
*callhandler = queue;
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_intrhand(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_handle adapter;
|
|
__stdcall ndis_interrupt_handler intrfunc;
|
|
|
|
if (arg == NULL)
|
|
return(EINVAL);
|
|
|
|
sc = arg;
|
|
adapter = sc->ndis_block.nmb_miniportadapterctx;
|
|
intrfunc = sc->ndis_chars.nmc_interrupt_func;
|
|
intrfunc(adapter);
|
|
|
|
return(0);
|
|
}
|
|
|
|
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;
|
|
__stdcall ndis_queryinfo_handler queryfunc;
|
|
uint32_t byteswritten = 0, bytesneeded = 0;
|
|
struct timeval tv;
|
|
int error;
|
|
|
|
sc = arg;
|
|
queryfunc = sc->ndis_chars.nmc_queryinfo_func;
|
|
adapter = sc->ndis_block.nmb_miniportadapterctx;
|
|
|
|
rval = queryfunc(adapter, oid, buf, *buflen,
|
|
&byteswritten, &bytesneeded);
|
|
|
|
/* Wait for requests that block. */
|
|
|
|
if (rval == NDIS_STATUS_PENDING) {
|
|
tv.tv_sec = 60;
|
|
tv.tv_usec = 0;
|
|
error = tsleep(&sc->ndis_block.nmb_wkupdpctimer,
|
|
PPAUSE|PCATCH, "ndisget", tvtohz(&tv));
|
|
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);
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_unload_driver(arg)
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
|
|
sc = arg;
|
|
|
|
free(sc->ndis_block.nmb_rlist, M_DEVBUF);
|
|
|
|
ndis_flush_sysctls(sc);
|
|
ndis_libfini();
|
|
ntoskrnl_libfini();
|
|
|
|
return(0);
|
|
}
|
|
|
|
int
|
|
ndis_load_driver(img, arg)
|
|
vm_offset_t img;
|
|
void *arg;
|
|
{
|
|
__stdcall driver_entry entry;
|
|
image_optional_header opt_hdr;
|
|
image_import_descriptor imp_desc;
|
|
ndis_unicode_string dummystr;
|
|
ndis_driver_object drv;
|
|
ndis_miniport_block *block;
|
|
ndis_status status;
|
|
int idx;
|
|
uint32_t *ptr;
|
|
struct ndis_softc *sc;
|
|
|
|
sc = arg;
|
|
|
|
/* Perform text relocation */
|
|
if (pe_relocate(img))
|
|
return(ENOEXEC);
|
|
|
|
/* Dynamically link the NDIS.SYS routines -- required. */
|
|
if (pe_patch_imports(img, "NDIS", ndis_functbl))
|
|
return(ENOEXEC);
|
|
|
|
/* Dynamically link the HAL.dll routines -- also required. */
|
|
if (pe_patch_imports(img, "HAL", hal_functbl))
|
|
return(ENOEXEC);
|
|
|
|
/* Dynamically link ntoskrnl.exe -- optional. */
|
|
if (pe_get_import_descriptor(img, &imp_desc, "ntoskrnl") == 0) {
|
|
if (pe_patch_imports(img, "ntoskrnl", ntoskrnl_functbl))
|
|
return(ENOEXEC);
|
|
}
|
|
|
|
/* Initialize subsystems */
|
|
ndis_libinit();
|
|
ntoskrnl_libinit();
|
|
|
|
/* Locate the driver entry point */
|
|
pe_get_optional_header(img, &opt_hdr);
|
|
entry = (driver_entry)pe_translate_addr(img, opt_hdr.ioh_entryaddr);
|
|
|
|
/*
|
|
* Now call the DriverEntry() routine. This will cause
|
|
* a callout to the NdisInitializeWrapper() and
|
|
* NdisMRegisterMiniport() routines.
|
|
*/
|
|
dummystr.nus_len = strlen(NDIS_DUMMY_PATH);
|
|
dummystr.nus_maxlen = strlen(NDIS_DUMMY_PATH);
|
|
dummystr.nus_buf = NULL;
|
|
ndis_ascii_to_unicode(NDIS_DUMMY_PATH, &dummystr.nus_buf);
|
|
drv.ndo_ifname = "ndis0";
|
|
|
|
status = entry(&drv, &dummystr);
|
|
|
|
free (dummystr.nus_buf, M_DEVBUF);
|
|
|
|
if (status != NDIS_STATUS_SUCCESS)
|
|
return(ENODEV);
|
|
|
|
/*
|
|
* Now that we have the miniport driver characteristics,
|
|
* create an NDIS block and call the init handler.
|
|
* This will cause the driver to try to probe for
|
|
* a device.
|
|
*/
|
|
|
|
block = &sc->ndis_block;
|
|
bcopy((char *)&drv.ndo_chars, (char *)&sc->ndis_chars,
|
|
sizeof(ndis_miniport_characteristics));
|
|
|
|
/*block->nmb_signature = 0xcafebabe;*/
|
|
|
|
ptr = (uint32_t *)block;
|
|
for (idx = 0; idx < sizeof(ndis_miniport_block) / 4; idx++) {
|
|
*ptr = idx | 0xdead0000;
|
|
ptr++;
|
|
}
|
|
|
|
block->nmb_signature = (void *)0xcafebabe;
|
|
block->nmb_setdone_func = ndis_setdone_func;
|
|
block->nmb_querydone_func = ndis_getdone_func;
|
|
block->nmb_status_func = ndis_status_func;
|
|
block->nmb_statusdone_func = ndis_statusdone_func;
|
|
block->nmb_resetdone_func = ndis_resetdone_func;
|
|
block->nmb_sendrsrc_func = ndis_sendrsrcavail_func;
|
|
|
|
block->nmb_ifp = &sc->arpcom.ac_if;
|
|
block->nmb_dev = sc->ndis_dev;
|
|
|
|
return(0);
|
|
}
|