d/freebsd-dev
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity
295964d6a9
freebsd-dev/sys/compat/ndis/subr_ndis.c
Bill Paul 1e35c8564a Fix the problem with the Cisco Aironet 340 PCMCIA card. Most newer drivers 
for Windows are deserialized miniports. Such drivers maintain their own
queues and do their own locking. This particular driver is not deserialized
though, and we need special support to handle it correctly.

Typically, in the ndis_rxeof() handler, we pass all incoming packets
directly to (*ifp->if_input)(). This in turn may cause another thread
to run and preempt us, and the packet may actually be processed and
then released before we even exit the ndis_rxeof() routine. The
problem with this is that releasing a packet calls the ndis_return_packet()
function, which hands the packet and its buffers back to the driver.
Calling ndis_return_packet() before ndis_rxeof() returns will screw
up the driver's internal queues since, not being deserialized,
it does no locking.

To avoid this problem, if we detect a serialized driver (by checking
the attribute flags passed to NdisSetAttributesEx(), we use an alternate
ndis_rxeof() handler, ndis_rxeof_serial(), which puts the call to
(*ifp->if_input)() on the NDIS SWI work queue. This guarantees the
packet won't be processed until after ndis_rxeof_serial() returns.

Note that another approach is to always copy the packet data into
another mbuf and just let the driver retain ownership of the ndis_packet
structure (ndis_return_packet() never needs to be called in this
case). I'm not sure which method is faster.
2004-03-11 09:40:00 +00:00

3058 lines
73 KiB
C
Raw Blame History

/*
* 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$");
/*
* This file implements a translation layer between the BSD networking
* infrasturcture and Windows(R) NDIS network driver modules. A Windows
* NDIS driver calls into several functions in the NDIS.SYS Windows
* kernel module and exports a table of functions designed to be called
* by the NDIS subsystem. Using the PE loader, we can patch our own
* versions of the NDIS routines into a given Windows driver module and
* convince the driver that it is in fact running on Windows.
*
* We provide a table of all our implemented NDIS routines which is patched
* into the driver object code. All our exported routines must use the
* _stdcall calling convention, since that's what the Windows object code
* expects.
*/
#include <sys/param.h>
#include <sys/types.h>
#include <sys/errno.h>
#include <sys/callout.h>
#include <sys/kernel.h>
#include <sys/systm.h>
#include <sys/malloc.h>
#include <sys/lock.h>
#include <sys/mutex.h>
#include <sys/socket.h>
#include <sys/sysctl.h>
#include <sys/timespec.h>
#include <sys/smp.h>
#include <sys/queue.h>
#include <sys/proc.h>
#include <sys/filedesc.h>
#include <sys/namei.h>
#include <sys/fcntl.h>
#include <sys/vnode.h>
#include <sys/kthread.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 <machine/atomic.h>
#include <machine/bus_memio.h>
#include <machine/bus_pio.h>
#include <machine/bus.h>
#include <machine/resource.h>
#include <sys/bus.h>
#include <sys/rman.h>
#include <machine/stdarg.h>
#include <net80211/ieee80211_var.h>
#include <net80211/ieee80211_ioctl.h>
#include <dev/pci/pcireg.h>
#include <dev/pci/pcivar.h>
#include <compat/ndis/pe_var.h>
#include <compat/ndis/resource_var.h>
#include <compat/ndis/ntoskrnl_var.h>
#include <compat/ndis/ndis_var.h>
#include <compat/ndis/cfg_var.h>
#include <dev/if_ndis/if_ndisvar.h>
#define FUNC void(*)(void)
static struct mtx *ndis_interlock;
static char ndis_filepath[MAXPATHLEN];
struct mtx_pool *ndis_mtxpool;
extern struct nd_head ndis_devhead;
SYSCTL_STRING(_hw, OID_AUTO, ndis_filepath, CTLFLAG_RW, ndis_filepath,
MAXPATHLEN, "Path used by NdisOpenFile() to search for files");
__stdcall static void ndis_initwrap(ndis_handle *,
device_object *, void *, void *);
__stdcall static ndis_status ndis_register_miniport(ndis_handle,
ndis_miniport_characteristics *, int);
__stdcall static ndis_status ndis_malloc_withtag(void **, uint32_t, uint32_t);
__stdcall static ndis_status ndis_malloc(void **,
uint32_t, uint32_t, ndis_physaddr);
__stdcall static void ndis_free(void *, uint32_t, uint32_t);
__stdcall static ndis_status ndis_setattr_ex(ndis_handle, ndis_handle,
uint32_t, uint32_t, ndis_interface_type);
__stdcall static void ndis_open_cfg(ndis_status *, ndis_handle *, ndis_handle);
__stdcall static void ndis_open_cfgbyidx(ndis_status *, ndis_handle,
uint32_t, ndis_unicode_string *, ndis_handle *);
__stdcall static void ndis_open_cfgbyname(ndis_status *, ndis_handle,
ndis_unicode_string *, ndis_handle *);
static ndis_status ndis_encode_parm(ndis_miniport_block *,
struct sysctl_oid *, ndis_parm_type, ndis_config_parm **);
static ndis_status ndis_decode_parm(ndis_miniport_block *,
ndis_config_parm *, char *);
__stdcall static void ndis_read_cfg(ndis_status *, ndis_config_parm **,
ndis_handle, ndis_unicode_string *, ndis_parm_type);
__stdcall static void ndis_write_cfg(ndis_status *, ndis_handle,
ndis_unicode_string *, ndis_config_parm *);
__stdcall static void ndis_close_cfg(ndis_handle);
__stdcall static void ndis_create_lock(ndis_spin_lock *);
__stdcall static void ndis_destroy_lock(ndis_spin_lock *);
__stdcall static void ndis_lock(ndis_spin_lock *);
__stdcall static void ndis_unlock(ndis_spin_lock *);
__stdcall static uint32_t ndis_read_pci(ndis_handle, uint32_t,
uint32_t, void *, uint32_t);
__stdcall static uint32_t ndis_write_pci(ndis_handle, uint32_t,
uint32_t, void *, uint32_t);
static void ndis_syslog(ndis_handle, ndis_error_code, uint32_t, ...);
static void ndis_map_cb(void *, bus_dma_segment_t *, int, int);
__stdcall static void ndis_vtophys_load(ndis_handle, ndis_buffer *,
uint32_t, uint8_t, ndis_paddr_unit *, uint32_t *);
__stdcall static void ndis_vtophys_unload(ndis_handle, ndis_buffer *, uint32_t);
__stdcall static void ndis_create_timer(ndis_miniport_timer *, ndis_handle *,
ndis_timer_function, void *);
__stdcall static void ndis_init_timer(ndis_timer *,
ndis_timer_function, void *);
static void ndis_timercall(void *);
__stdcall static void ndis_set_timer(ndis_miniport_timer *, uint32_t);
static void ndis_tick(void *);
__stdcall static void ndis_set_periodic_timer(ndis_miniport_timer *, uint32_t);
__stdcall static void ndis_cancel_timer(ndis_miniport_timer *, uint8_t *);
__stdcall static void ndis_query_resources(ndis_status *, ndis_handle,
ndis_resource_list *, uint32_t *);
__stdcall static ndis_status ndis_register_ioport(void **,
ndis_handle, uint32_t, uint32_t);
__stdcall static void ndis_deregister_ioport(ndis_handle,
uint32_t, uint32_t, void *);
__stdcall static void ndis_read_netaddr(ndis_status *, void **,
uint32_t *, ndis_handle);
__stdcall static ndis_status ndis_mapreg_cnt(uint32_t, uint32_t *);
__stdcall static ndis_status ndis_alloc_mapreg(ndis_handle,
uint32_t, uint8_t, uint32_t, uint32_t);
__stdcall static void ndis_free_mapreg(ndis_handle);
static void ndis_mapshared_cb(void *, bus_dma_segment_t *, int, int);
__stdcall static void ndis_alloc_sharedmem(ndis_handle, uint32_t,
uint8_t, void **, ndis_physaddr *);
static void ndis_asyncmem_complete(void *);
__stdcall static ndis_status ndis_alloc_sharedmem_async(ndis_handle,
uint32_t, uint8_t, void *);
__stdcall static void ndis_free_sharedmem(ndis_handle, uint32_t,
uint8_t, void *, ndis_physaddr);
__stdcall static ndis_status ndis_map_iospace(void **, ndis_handle,
ndis_physaddr, uint32_t);
__stdcall static void ndis_unmap_iospace(ndis_handle, void *, uint32_t);
__stdcall static uint32_t ndis_cachefill(void);
__stdcall static uint32_t ndis_dma_align(ndis_handle);
__stdcall static ndis_status ndis_init_sc_dma(ndis_handle,
uint8_t, uint32_t);
__stdcall static void ndis_alloc_packetpool(ndis_status *,
ndis_handle *, uint32_t, uint32_t);
__stdcall static void ndis_ex_alloc_packetpool(ndis_status *,
ndis_handle *, uint32_t, uint32_t, uint32_t);
__stdcall static uint32_t ndis_packetpool_use(ndis_handle);
__stdcall static void ndis_free_packetpool(ndis_handle);
__stdcall static void ndis_alloc_packet(ndis_status *,
ndis_packet **, ndis_handle);
__stdcall static void ndis_release_packet(ndis_packet *);
__stdcall static void ndis_unchain_headbuf(ndis_packet *, ndis_buffer **);
__stdcall static void ndis_unchain_tailbuf(ndis_packet *, ndis_buffer **);
__stdcall static void ndis_alloc_bufpool(ndis_status *,
ndis_handle *, uint32_t);
__stdcall static void ndis_free_bufpool(ndis_handle);
__stdcall static void ndis_alloc_buf(ndis_status *, ndis_buffer **,
ndis_handle, void *, uint32_t);
__stdcall static void ndis_release_buf(ndis_buffer *);
__stdcall static uint32_t ndis_buflen(ndis_buffer *);
__stdcall static void ndis_query_buf(ndis_buffer *, void **, uint32_t *);
__stdcall static void ndis_query_buf_safe(ndis_buffer *, void **,
uint32_t *, uint32_t);
__stdcall static void *ndis_buf_vaddr(ndis_buffer *);
__stdcall static void *ndis_buf_vaddr_safe(ndis_buffer *, uint32_t);
__stdcall static void ndis_adjust_buflen(ndis_buffer *, int);
__stdcall static uint32_t ndis_interlock_inc(uint32_t *);
__stdcall static uint32_t ndis_interlock_dec(uint32_t *);
__stdcall static void ndis_init_event(ndis_event *);
__stdcall static void ndis_set_event(ndis_event *);
__stdcall static void ndis_reset_event(ndis_event *);
__stdcall static uint8_t ndis_wait_event(ndis_event *, uint32_t);
__stdcall static ndis_status ndis_unicode2ansi(ndis_ansi_string *,
ndis_unicode_string *);
__stdcall static ndis_status ndis_ansi2unicode(ndis_unicode_string *,
ndis_ansi_string *);
__stdcall static ndis_status ndis_assign_pcirsrc(ndis_handle,
uint32_t, ndis_resource_list **);
__stdcall static ndis_status ndis_register_intr(ndis_miniport_interrupt *,
ndis_handle, uint32_t, uint32_t, uint8_t,
uint8_t, ndis_interrupt_mode);
__stdcall static void ndis_deregister_intr(ndis_miniport_interrupt *);
__stdcall static void ndis_register_shutdown(ndis_handle, void *,
ndis_shutdown_handler);
__stdcall static void ndis_deregister_shutdown(ndis_handle);
__stdcall static uint32_t ndis_numpages(ndis_buffer *);
__stdcall static void ndis_buf_physpages(ndis_buffer *, uint32_t *);
__stdcall static void ndis_query_bufoffset(ndis_buffer *,
uint32_t *, uint32_t *);
__stdcall static void ndis_sleep(uint32_t);
__stdcall static uint32_t ndis_read_pccard_amem(ndis_handle,
uint32_t, void *, uint32_t);
__stdcall static uint32_t ndis_write_pccard_amem(ndis_handle,
uint32_t, void *, uint32_t);
__stdcall static list_entry *ndis_insert_head(list_entry *,
list_entry *, ndis_spin_lock *);
__stdcall static list_entry *ndis_remove_head(list_entry *,
ndis_spin_lock *);
__stdcall static list_entry *ndis_insert_tail(list_entry *,
list_entry *, ndis_spin_lock *);
__stdcall static uint8_t ndis_sync_with_intr(ndis_miniport_interrupt *,
void *, void *);
__stdcall static void ndis_time(uint64_t *);
__stdcall static void ndis_uptime(uint32_t *);
__stdcall static void ndis_init_string(ndis_unicode_string *, char *);
__stdcall static void ndis_init_ansi_string(ndis_ansi_string *, char *);
__stdcall static void ndis_init_unicode_string(ndis_unicode_string *,
uint16_t *);
__stdcall static void ndis_free_string(ndis_unicode_string *);
__stdcall static ndis_status ndis_remove_miniport(ndis_handle *);
__stdcall static void ndis_termwrap(ndis_handle, void *);
__stdcall static void ndis_get_devprop(ndis_handle, device_object **,
device_object **, device_object **, cm_resource_list *,
cm_resource_list *);
__stdcall static void ndis_firstbuf(ndis_packet *, ndis_buffer **,
void **, uint32_t *, uint32_t *);
__stdcall static void ndis_firstbuf_safe(ndis_packet *, ndis_buffer **,
void **, uint32_t *, uint32_t *, uint32_t);
__stdcall static void ndis_open_file(ndis_status *, ndis_handle *, uint32_t *,
ndis_unicode_string *, ndis_physaddr);
__stdcall static void ndis_map_file(ndis_status *, void **, ndis_handle);
__stdcall static void ndis_unmap_file(ndis_handle);
__stdcall static void ndis_close_file(ndis_handle);
__stdcall static u_int8_t ndis_cpu_cnt(void);
__stdcall static void ndis_ind_statusdone(ndis_handle);
__stdcall static void ndis_ind_status(ndis_handle, ndis_status,
void *, uint32_t);
static void ndis_workfunc(void *);
__stdcall static ndis_status ndis_sched_workitem(ndis_work_item *);
__stdcall static void ndis_pkt_to_pkt(ndis_packet *, uint32_t, uint32_t,
ndis_packet *, uint32_t, uint32_t *);
__stdcall static void ndis_pkt_to_pkt_safe(ndis_packet *, uint32_t, uint32_t,
ndis_packet *, uint32_t, uint32_t *, uint32_t);
__stdcall static ndis_status ndis_register_dev(ndis_handle,
ndis_unicode_string *, ndis_unicode_string *, driver_dispatch **,
void **, ndis_handle *);
__stdcall static ndis_status ndis_deregister_dev(ndis_handle);
__stdcall static ndis_status ndis_query_name(ndis_unicode_string *,
ndis_handle);
__stdcall static void ndis_register_unload(ndis_handle, void *);
__stdcall static void dummy(void);
/*
* Some really old drivers do not properly check the return value
* from NdisAllocatePacket() and NdisAllocateBuffer() and will
* sometimes allocate few more buffers/packets that they originally
* requested when they created the pool. To prevent this from being
* a problem, we allocate a few extra buffers/packets beyond what
* the driver asks for. This #define controls how many.
*/
#define NDIS_POOL_EXTRA 16
int
ndis_libinit()
{
strcpy(ndis_filepath, "/compat/ndis");
ndis_mtxpool = mtx_pool_create("ndis mutex pool",
1024, MTX_DEF | MTX_RECURSE | MTX_DUPOK);;
ndis_interlock = mtx_pool_alloc(ndis_mtxpool);
return(0);
}
int
ndis_libfini()
{
mtx_pool_destroy(&ndis_mtxpool);
return(0);
}
/*
* NDIS deals with strings in unicode format, so we have
* do deal with them that way too. For now, we only handle
* conversion between unicode and ASCII since that's all
* that device drivers care about.
*/
int
ndis_ascii_to_unicode(ascii, unicode)
char *ascii;
uint16_t **unicode;
{
uint16_t *ustr;
int i;
if (*unicode == NULL)
*unicode = malloc(strlen(ascii) * 2, M_DEVBUF, M_WAITOK);
if (*unicode == NULL)
return(ENOMEM);
ustr = *unicode;
for (i = 0; i < strlen(ascii); i++) {
*ustr = (uint16_t)ascii[i];
ustr++;
}
return(0);
}
int
ndis_unicode_to_ascii(unicode, ulen, ascii)
uint16_t *unicode;
int ulen;
char **ascii;
{
uint8_t *astr;
int i;
if (*ascii == NULL)
*ascii = malloc((ulen / 2) + 1, M_DEVBUF, M_WAITOK|M_ZERO);
if (*ascii == NULL)
return(ENOMEM);
astr = *ascii;
for (i = 0; i < ulen / 2; i++) {
*astr = (uint8_t)unicode[i];
astr++;
}
return(0);
}
__stdcall static void
ndis_initwrap(wrapper, drv_obj, path, unused)
ndis_handle *wrapper;
device_object *drv_obj;
void *path;
void *unused;
{
ndis_miniport_block *block;
block = drv_obj->do_rsvd;
*wrapper = block;
return;
}
__stdcall static void
ndis_termwrap(handle, syspec)
ndis_handle handle;
void *syspec;
{
return;
}
__stdcall static ndis_status
ndis_register_miniport(handle, characteristics, len)
ndis_handle handle;
ndis_miniport_characteristics *characteristics;
int len;
{
ndis_miniport_block *block;
struct ndis_softc *sc;
block = (ndis_miniport_block *)handle;
sc = (struct ndis_softc *)block->nmb_ifp;
bcopy((char *)characteristics, (char *)&sc->ndis_chars,
sizeof(ndis_miniport_characteristics));
if (sc->ndis_chars.nmc_version_major < 5 ||
sc->ndis_chars.nmc_version_minor < 1) {
sc->ndis_chars.nmc_shutdown_handler = NULL;
sc->ndis_chars.nmc_canceltxpkts_handler = NULL;
sc->ndis_chars.nmc_pnpevent_handler = NULL;
}
return(NDIS_STATUS_SUCCESS);
}
__stdcall static ndis_status
ndis_malloc_withtag(vaddr, len, tag)
void **vaddr;
uint32_t len;
uint32_t tag;
{
void *mem;
mem = malloc(len, M_DEVBUF, M_NOWAIT);
if (mem == NULL)
return(NDIS_STATUS_RESOURCES);
*vaddr = mem;
return(NDIS_STATUS_SUCCESS);
}
__stdcall static ndis_status
ndis_malloc(vaddr, len, flags, highaddr)
void **vaddr;
uint32_t len;
uint32_t flags;
ndis_physaddr highaddr;
{
void *mem;
mem = malloc(len, M_DEVBUF, M_NOWAIT);
if (mem == NULL)
return(NDIS_STATUS_RESOURCES);
*vaddr = mem;
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_free(vaddr, len, flags)
void *vaddr;
uint32_t len;
uint32_t flags;
{
if (len == 0)
return;
free(vaddr, M_DEVBUF);
return;
}
__stdcall static ndis_status
ndis_setattr_ex(adapter_handle, adapter_ctx, hangsecs,
flags, iftype)
ndis_handle adapter_handle;
ndis_handle adapter_ctx;
uint32_t hangsecs;
uint32_t flags;
ndis_interface_type iftype;
{
ndis_miniport_block *block;
/*
* Save the adapter context, we need it for calling
* the driver's internal functions.
*/
block = (ndis_miniport_block *)adapter_handle;
block->nmb_miniportadapterctx = adapter_ctx;
block->nmb_checkforhangsecs = hangsecs;
block->nmb_flags = flags;
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_open_cfg(status, cfg, wrapctx)
ndis_status *status;
ndis_handle *cfg;
ndis_handle wrapctx;
{
*cfg = wrapctx;
*status = NDIS_STATUS_SUCCESS;
return;
}
__stdcall static void
ndis_open_cfgbyname(status, cfg, subkey, subhandle)
ndis_status *status;
ndis_handle cfg;
ndis_unicode_string *subkey;
ndis_handle *subhandle;
{
*subhandle = cfg;
*status = NDIS_STATUS_SUCCESS;
return;
}
__stdcall static void
ndis_open_cfgbyidx(status, cfg, idx, subkey, subhandle)
ndis_status *status;
ndis_handle cfg;
uint32_t idx;
ndis_unicode_string *subkey;
ndis_handle *subhandle;
{
*status = NDIS_STATUS_FAILURE;
return;
}
static ndis_status
ndis_encode_parm(block, oid, type, parm)
ndis_miniport_block *block;
struct sysctl_oid *oid;
ndis_parm_type type;
ndis_config_parm **parm;
{
uint16_t *unicode;
ndis_unicode_string *ustr;
unicode = (uint16_t *)&block->nmb_dummybuf;
switch(type) {
case ndis_parm_string:
ndis_ascii_to_unicode((char *)oid->oid_arg1, &unicode);
(*parm)->ncp_type = ndis_parm_string;
ustr = &(*parm)->ncp_parmdata.ncp_stringdata;
ustr->nus_len = strlen((char *)oid->oid_arg1) * 2;
ustr->nus_buf = unicode;
break;
case ndis_parm_int:
(*parm)->ncp_type = ndis_parm_int;
(*parm)->ncp_parmdata.ncp_intdata =
strtol((char *)oid->oid_arg1, NULL, 10);
break;
case ndis_parm_hexint:
(*parm)->ncp_type = ndis_parm_hexint;
(*parm)->ncp_parmdata.ncp_intdata =
strtoul((char *)oid->oid_arg1, NULL, 16);
break;
default:
return(NDIS_STATUS_FAILURE);
break;
}
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_read_cfg(status, parm, cfg, key, type)
ndis_status *status;
ndis_config_parm **parm;
ndis_handle cfg;
ndis_unicode_string *key;
ndis_parm_type type;
{
char *keystr = NULL;
uint16_t *unicode;
ndis_miniport_block *block;
struct ndis_softc *sc;
struct sysctl_oid *oidp;
struct sysctl_ctx_entry *e;
block = (ndis_miniport_block *)cfg;
sc = (struct ndis_softc *)block->nmb_ifp;
if (key->nus_len == 0 || key->nus_buf == NULL) {
*status = NDIS_STATUS_FAILURE;
return;
}
ndis_unicode_to_ascii(key->nus_buf, key->nus_len, &keystr);
*parm = &block->nmb_replyparm;
bzero((char *)&block->nmb_replyparm, sizeof(ndis_config_parm));
unicode = (uint16_t *)&block->nmb_dummybuf;
/*
* See if registry key is already in a list of known keys
* included with the driver.
*/
TAILQ_FOREACH(e, &sc->ndis_ctx, link) {
oidp = e->entry;
if (strcmp(oidp->oid_name, keystr) == 0) {
if (strcmp((char *)oidp->oid_arg1, "UNSET") == 0) {
free(keystr, M_DEVBUF);
*status = NDIS_STATUS_FAILURE;
return;
}
*status = ndis_encode_parm(block, oidp, type, parm);
free(keystr, M_DEVBUF);
return;
}
}
/*
* If the key didn't match, add it to the list of dynamically
* created ones. Sometimes, drivers refer to registry keys
* that aren't documented in their .INF files. These keys
* are supposed to be created by some sort of utility or
* control panel snap-in that comes with the driver software.
* Sometimes it's useful to be able to manipulate these.
* If the driver requests the key in the form of a string,
* make its default value an empty string, otherwise default
* it to "0".
*/
if (type == ndis_parm_int || type == ndis_parm_hexint)
ndis_add_sysctl(sc, keystr, "(dynamic integer key)",
"UNSET", CTLFLAG_RW);
else
ndis_add_sysctl(sc, keystr, "(dynamic string key)",
"UNSET", CTLFLAG_RW);
free(keystr, M_DEVBUF);
*status = NDIS_STATUS_FAILURE;
return;
}
static ndis_status
ndis_decode_parm(block, parm, val)
ndis_miniport_block *block;
ndis_config_parm *parm;
char *val;
{
ndis_unicode_string *ustr;
char *astr = NULL;
switch(parm->ncp_type) {
case ndis_parm_string:
ustr = &parm->ncp_parmdata.ncp_stringdata;
ndis_unicode_to_ascii(ustr->nus_buf, ustr->nus_len, &astr);
bcopy(astr, val, 254);
free(astr, M_DEVBUF);
break;
case ndis_parm_int:
sprintf(val, "%d", parm->ncp_parmdata.ncp_intdata);
break;
case ndis_parm_hexint:
sprintf(val, "%xu", parm->ncp_parmdata.ncp_intdata);
break;
default:
return(NDIS_STATUS_FAILURE);
break;
}
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_write_cfg(status, cfg, key, parm)
ndis_status *status;
ndis_handle cfg;
ndis_unicode_string *key;
ndis_config_parm *parm;
{
char *keystr = NULL;
ndis_miniport_block *block;
struct ndis_softc *sc;
struct sysctl_oid *oidp;
struct sysctl_ctx_entry *e;
char val[256];
block = (ndis_miniport_block *)cfg;
sc = (struct ndis_softc *)block->nmb_ifp;
ndis_unicode_to_ascii(key->nus_buf, key->nus_len, &keystr);
/* Decode the parameter into a string. */
bzero(val, sizeof(val));
*status = ndis_decode_parm(block, parm, val);
if (*status != NDIS_STATUS_SUCCESS) {
free(keystr, M_DEVBUF);
return;
}
/* See if the key already exists. */
TAILQ_FOREACH(e, &sc->ndis_ctx, link) {
oidp = e->entry;
if (strcmp(oidp->oid_name, keystr) == 0) {
/* Found it, set the value. */
strcpy((char *)oidp->oid_arg1, val);
free(keystr, M_DEVBUF);
return;
}
}
/* Not found, add a new key with the specified value. */
ndis_add_sysctl(sc, keystr, "(dynamically set key)",
val, CTLFLAG_RW);
free(keystr, M_DEVBUF);
*status = NDIS_STATUS_SUCCESS;
return;
}
__stdcall static void
ndis_close_cfg(cfg)
ndis_handle cfg;
{
return;
}
__stdcall static void
ndis_create_lock(lock)
ndis_spin_lock *lock;
{
lock->nsl_spinlock = (ndis_kspin_lock)mtx_pool_alloc(ndis_mtxpool);
return;
}
__stdcall static void
ndis_destroy_lock(lock)
ndis_spin_lock *lock;
{
/* We use a mutex pool, so this is a no-op. */
return;
}
__stdcall static void
ndis_lock(lock)
ndis_spin_lock *lock;
{
mtx_pool_lock(ndis_mtxpool, (struct mtx *)lock->nsl_spinlock);
return;
}
__stdcall static void
ndis_unlock(lock)
ndis_spin_lock *lock;
{
mtx_pool_unlock(ndis_mtxpool, (struct mtx *)lock->nsl_spinlock);
return;
}
__stdcall static uint32_t
ndis_read_pci(adapter, slot, offset, buf, len)
ndis_handle adapter;
uint32_t slot;
uint32_t offset;
void *buf;
uint32_t len;
{
ndis_miniport_block *block;
int i;
char *dest;
block = (ndis_miniport_block *)adapter;
dest = buf;
if (block == NULL || block->nmb_dev == NULL)
return(0);
for (i = 0; i < len; i++)
dest[i] = pci_read_config(block->nmb_dev, i + offset, 1);
return(len);
}
__stdcall static uint32_t
ndis_write_pci(adapter, slot, offset, buf, len)
ndis_handle adapter;
uint32_t slot;
uint32_t offset;
void *buf;
uint32_t len;
{
ndis_miniport_block *block;
int i;
char *dest;
block = (ndis_miniport_block *)adapter;
dest = buf;
if (block == NULL || block->nmb_dev == NULL)
return(0);
for (i = 0; i < len; i++)
pci_write_config(block->nmb_dev, i + offset, dest[i], 1);
return(len);
}
/*
* The errorlog routine uses a variable argument list, so we
* have to declare it this way.
*/
#define ERRMSGLEN 512
static void
ndis_syslog(ndis_handle adapter, ndis_error_code code,
uint32_t numerrors, ...)
{
ndis_miniport_block *block;
va_list ap;
int i, error;
char *str = NULL, *ustr = NULL;
uint16_t flags;
char msgbuf[ERRMSGLEN];
block = (ndis_miniport_block *)adapter;
error = pe_get_message(block->nmb_img, code, &str, &i, &flags);
if (error == 0 && flags & MESSAGE_RESOURCE_UNICODE) {
ustr = msgbuf;
ndis_unicode_to_ascii((uint16_t *)str,
((i / 2)) > (ERRMSGLEN - 1) ? ERRMSGLEN : i, &ustr);
str = ustr;
}
device_printf (block->nmb_dev, "NDIS ERROR: %x (%s)\n", code,
str == NULL ? "unknown error" : str);
device_printf (block->nmb_dev, "NDIS NUMERRORS: %x\n", numerrors);
va_start(ap, numerrors);
for (i = 0; i < numerrors; i++)
device_printf (block->nmb_dev, "argptr: %p\n",
va_arg(ap, void *));
va_end(ap);
return;
}
static void
ndis_map_cb(arg, segs, nseg, error)
void *arg;
bus_dma_segment_t *segs;
int nseg;
int error;
{
struct ndis_map_arg *ctx;
int i;
if (error)
return;
ctx = arg;
for (i = 0; i < nseg; i++) {
ctx->nma_fraglist[i].npu_physaddr.np_quad = segs[i].ds_addr;
ctx->nma_fraglist[i].npu_len = segs[i].ds_len;
}
ctx->nma_cnt = nseg;
return;
}
__stdcall static void
ndis_vtophys_load(adapter, buf, mapreg, writedev, addrarray, arraysize)
ndis_handle adapter;
ndis_buffer *buf;
uint32_t mapreg;
uint8_t writedev;
ndis_paddr_unit *addrarray;
uint32_t *arraysize;
{
ndis_miniport_block *block;
struct ndis_softc *sc;
struct ndis_map_arg nma;
bus_dmamap_t map;
int error;
if (adapter == NULL)
return;
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)(block->nmb_ifp);
if (mapreg > sc->ndis_mmapcnt)
return;
map = sc->ndis_mmaps[mapreg];
nma.nma_fraglist = addrarray;
error = bus_dmamap_load(sc->ndis_mtag, map,
MDL_VA(buf), buf->nb_bytecount, ndis_map_cb,
(void *)&nma, BUS_DMA_NOWAIT);
if (error)
return;
bus_dmamap_sync(sc->ndis_mtag, map,
writedev ? BUS_DMASYNC_PREWRITE : BUS_DMASYNC_PREREAD);
*arraysize = nma.nma_cnt;
return;
}
__stdcall static void
ndis_vtophys_unload(adapter, buf, mapreg)
ndis_handle adapter;
ndis_buffer *buf;
uint32_t mapreg;
{
ndis_miniport_block *block;
struct ndis_softc *sc;
bus_dmamap_t map;
if (adapter == NULL)
return;
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)(block->nmb_ifp);
if (mapreg > sc->ndis_mmapcnt)
return;
map = sc->ndis_mmaps[mapreg];
bus_dmamap_sync(sc->ndis_mtag, map,
BUS_DMASYNC_POSTREAD|BUS_DMASYNC_POSTWRITE);
bus_dmamap_unload(sc->ndis_mtag, map);
return;
}
/*
* This is an older pre-miniport timer init routine which doesn't
* accept a miniport context handle. The function context (ctx)
* is supposed to be a pointer to the adapter handle, which should
* have been handed to us via NdisSetAttributesEx(). We use this
* function context to track down the corresponding ndis_miniport_block
* structure. It's vital that we track down the miniport block structure,
* so if we can't do it, we panic. Note that we also play some games
* here by treating ndis_timer and ndis_miniport_timer as the same
* thing.
*/
__stdcall static void
ndis_init_timer(timer, func, ctx)
ndis_timer *timer;
ndis_timer_function func;
void *ctx;
{
struct ndis_timer_entry *ne = NULL;
ndis_miniport_block *block = NULL;
TAILQ_FOREACH(block, &ndis_devhead, link) {
if (block->nmb_miniportadapterctx == ctx)
break;
}
if (block->nmb_miniportadapterctx != ctx)
panic("NDIS driver timer context didn't "
"match any adapter contexts");
ne = malloc(sizeof(struct ndis_timer_entry), M_DEVBUF, M_NOWAIT);
callout_init(&ne->nte_ch, CALLOUT_MPSAFE);
TAILQ_INSERT_TAIL(&block->nmb_timerlist, ne, link);
ne->nte_timer = (ndis_miniport_timer *)timer;
INIT_LIST_HEAD((&timer->nt_timer.nk_header.dh_waitlisthead));
timer->nt_timer.nk_header.dh_sigstate = FALSE;
timer->nt_timer.nk_header.dh_type = EVENT_TYPE_NOTIFY;
timer->nt_timer.nk_header.dh_size = OTYPE_TIMER;
timer->nt_dpc.nk_sysarg1 = &ne->nte_ch;
timer->nt_dpc.nk_deferedfunc = (ndis_kdpc_func)func;
timer->nt_dpc.nk_deferredctx = ctx;
return;
}
__stdcall static void
ndis_create_timer(timer, handle, func, ctx)
ndis_miniport_timer *timer;
ndis_handle *handle;
ndis_timer_function func;
void *ctx;
{
struct ndis_timer_entry *ne = NULL;
ndis_miniport_block *block;
block = (ndis_miniport_block *)handle;
ne = malloc(sizeof(struct ndis_timer_entry), M_DEVBUF, M_NOWAIT);
callout_init(&ne->nte_ch, CALLOUT_MPSAFE);
TAILQ_INSERT_TAIL(&block->nmb_timerlist, ne, link);
ne->nte_timer = timer;
INIT_LIST_HEAD((&timer->nmt_ktimer.nk_header.dh_waitlisthead));
timer->nmt_ktimer.nk_header.dh_sigstate = FALSE;
timer->nmt_ktimer.nk_header.dh_type = EVENT_TYPE_NOTIFY;
timer->nmt_ktimer.nk_header.dh_size = OTYPE_TIMER;
timer->nmt_dpc.nk_sysarg1 = &ne->nte_ch;
timer->nmt_dpc.nk_deferedfunc = (ndis_kdpc_func)func;
timer->nmt_dpc.nk_deferredctx = ctx;
return;
}
/*
* The driver's timer callout is __stdcall function, so we need this
* intermediate step.
*/
static void
ndis_timercall(arg)
void *arg;
{
ndis_miniport_timer *timer;
__stdcall ndis_timer_function timerfunc;
timer = arg;
timerfunc = (ndis_timer_function)timer->nmt_dpc.nk_deferedfunc;
timerfunc(NULL, timer->nmt_dpc.nk_deferredctx, NULL, NULL);
ntoskrnl_wakeup(&timer->nmt_ktimer.nk_header);
return;
}
/*
* Windows specifies timeouts in milliseconds. We specify timeouts
* in hz, so some conversion is required.
*/
__stdcall static void
ndis_set_timer(timer, msecs)
ndis_miniport_timer *timer;
uint32_t msecs;
{
struct callout *ch;
struct timeval tv;
tv.tv_sec = 0;
tv.tv_usec = msecs * 1000;
ch = timer->nmt_dpc.nk_sysarg1;
timer->nmt_dpc.nk_sysarg2 = ndis_timercall;
timer->nmt_ktimer.nk_header.dh_sigstate = FALSE;
callout_reset(ch, tvtohz(&tv), timer->nmt_dpc.nk_sysarg2, timer);
return;
}
static void
ndis_tick(arg)
void *arg;
{
ndis_miniport_timer *timer;
struct callout *ch;
__stdcall ndis_timer_function timerfunc;
struct timeval tv;
timer = arg;
/* Automatically reload timer. */
tv.tv_sec = 0;
tv.tv_usec = timer->nmt_ktimer.nk_period * 1000;
ch = timer->nmt_dpc.nk_sysarg1;
timer->nmt_ktimer.nk_header.dh_sigstate = FALSE;
timer->nmt_dpc.nk_sysarg2 = ndis_tick;
callout_reset(ch, tvtohz(&tv), timer->nmt_dpc.nk_sysarg2, timer);
timerfunc = (ndis_timer_function)timer->nmt_dpc.nk_deferedfunc;
timerfunc(NULL, timer->nmt_dpc.nk_deferredctx, NULL, NULL);
ntoskrnl_wakeup(&timer->nmt_ktimer.nk_header);
return;
}
__stdcall static void
ndis_set_periodic_timer(timer, msecs)
ndis_miniport_timer *timer;
uint32_t msecs;
{
struct callout *ch;
struct timeval tv;
tv.tv_sec = 0;
tv.tv_usec = msecs * 1000;
timer->nmt_ktimer.nk_period = msecs;
ch = timer->nmt_dpc.nk_sysarg1;
timer->nmt_dpc.nk_sysarg2 = ndis_tick;
timer->nmt_ktimer.nk_header.dh_sigstate = FALSE;
callout_reset(ch, tvtohz(&tv), timer->nmt_dpc.nk_sysarg2, timer);
return;
}
__stdcall static void
ndis_cancel_timer(timer, cancelled)
ndis_miniport_timer *timer;
uint8_t *cancelled;
{
struct callout *ch;
if (timer == NULL)
return;
ch = timer->nmt_dpc.nk_sysarg1;
if (ch == NULL)
return;
callout_stop(ch);
*cancelled = timer->nmt_ktimer.nk_header.dh_sigstate;
return;
}
__stdcall static void
ndis_query_resources(status, adapter, list, buflen)
ndis_status *status;
ndis_handle adapter;
ndis_resource_list *list;
uint32_t *buflen;
{
ndis_miniport_block *block;
struct ndis_softc *sc;
int rsclen;
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)block->nmb_ifp;
rsclen = sizeof(ndis_resource_list) +
(sizeof(cm_partial_resource_desc) * (sc->ndis_rescnt - 1));
if (*buflen < rsclen) {
*buflen = rsclen;
*status = NDIS_STATUS_INVALID_LENGTH;
return;
}
bcopy((char *)block->nmb_rlist, (char *)list, *buflen);
*status = NDIS_STATUS_SUCCESS;
return;
}
__stdcall static ndis_status
ndis_register_ioport(offset, adapter, port, numports)
void **offset;
ndis_handle adapter;
uint32_t port;
uint32_t numports;
{
struct ndis_miniport_block *block;
struct ndis_softc *sc;
if (adapter == NULL)
return(NDIS_STATUS_FAILURE);
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)(block->nmb_ifp);
if (sc->ndis_res_io == NULL)
return(NDIS_STATUS_FAILURE);
/* Don't let the device map more ports than we have. */
if (rman_get_size(sc->ndis_res_io) < numports)
return(NDIS_STATUS_INVALID_LENGTH);
*offset = (void *)rman_get_start(sc->ndis_res_io);
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_deregister_ioport(adapter, port, numports, offset)
ndis_handle adapter;
uint32_t port;
uint32_t numports;
void *offset;
{
return;
}
__stdcall static void
ndis_read_netaddr(status, addr, addrlen, adapter)
ndis_status *status;
void **addr;
uint32_t *addrlen;
ndis_handle adapter;
{
struct ndis_softc *sc;
ndis_miniport_block *block;
uint8_t empty[] = { 0, 0, 0, 0, 0, 0 };
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)block->nmb_ifp;
if (bcmp(sc->arpcom.ac_enaddr, empty, ETHER_ADDR_LEN) == 0)
*status = NDIS_STATUS_FAILURE;
else {
*addr = sc->arpcom.ac_enaddr;
*addrlen = ETHER_ADDR_LEN;
*status = NDIS_STATUS_SUCCESS;
}
return;
}
__stdcall static ndis_status
ndis_mapreg_cnt(bustype, cnt)
uint32_t bustype;
uint32_t *cnt;
{
*cnt = 8192;
return(NDIS_STATUS_SUCCESS);
}
__stdcall static ndis_status
ndis_alloc_mapreg(adapter, dmachannel, dmasize, physmapneeded, maxmap)
ndis_handle adapter;
uint32_t dmachannel;
uint8_t dmasize;
uint32_t physmapneeded;
uint32_t maxmap;
{
struct ndis_softc *sc;
ndis_miniport_block *block;
int error, i, nseg = NDIS_MAXSEG;
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)block->nmb_ifp;
sc->ndis_mmaps = malloc(sizeof(bus_dmamap_t) * physmapneeded,
M_DEVBUF, M_NOWAIT|M_ZERO);
if (sc->ndis_mmaps == NULL)
return(NDIS_STATUS_RESOURCES);
error = bus_dma_tag_create(sc->ndis_parent_tag, ETHER_ALIGN, 0,
BUS_SPACE_MAXADDR_32BIT, BUS_SPACE_MAXADDR, NULL,
NULL, maxmap * nseg, nseg, maxmap, BUS_DMA_ALLOCNOW,
NULL, NULL, &sc->ndis_mtag);
if (error) {
free(sc->ndis_mmaps, M_DEVBUF);
return(NDIS_STATUS_RESOURCES);
}
for (i = 0; i < physmapneeded; i++)
bus_dmamap_create(sc->ndis_mtag, 0, &sc->ndis_mmaps[i]);
sc->ndis_mmapcnt = physmapneeded;
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_free_mapreg(adapter)
ndis_handle adapter;
{
struct ndis_softc *sc;
ndis_miniport_block *block;
int i;
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)block->nmb_ifp;
for (i = 0; i < sc->ndis_mmapcnt; i++)
bus_dmamap_destroy(sc->ndis_mtag, sc->ndis_mmaps[i]);
free(sc->ndis_mmaps, M_DEVBUF);
bus_dma_tag_destroy(sc->ndis_mtag);
return;
}
static void
ndis_mapshared_cb(arg, segs, nseg, error)
void *arg;
bus_dma_segment_t *segs;
int nseg;
int error;
{
ndis_physaddr *p;
if (error || nseg > 1)
return;
p = arg;
p->np_quad = segs[0].ds_addr;
return;
}
/*
* This maps to bus_dmamem_alloc().
*/
__stdcall static void
ndis_alloc_sharedmem(adapter, len, cached, vaddr, paddr)
ndis_handle adapter;
uint32_t len;
uint8_t cached;
void **vaddr;
ndis_physaddr *paddr;
{
ndis_miniport_block *block;
struct ndis_softc *sc;
struct ndis_shmem *sh;
int error;
if (adapter == NULL)
return;
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)(block->nmb_ifp);
sh = malloc(sizeof(struct ndis_shmem), M_DEVBUF, M_NOWAIT|M_ZERO);
if (sh == NULL)
return;
error = bus_dma_tag_create(sc->ndis_parent_tag, 64,
0, BUS_SPACE_MAXADDR_32BIT, BUS_SPACE_MAXADDR, NULL,
NULL, len, 1, len, BUS_DMA_ALLOCNOW, NULL, NULL,
&sh->ndis_stag);
if (error) {
free(sh, M_DEVBUF);
return;
}
error = bus_dmamem_alloc(sh->ndis_stag, vaddr,
BUS_DMA_NOWAIT | BUS_DMA_ZERO, &sh->ndis_smap);
if (error) {
bus_dma_tag_destroy(sh->ndis_stag);
free(sh, M_DEVBUF);
return;
}
error = bus_dmamap_load(sh->ndis_stag, sh->ndis_smap, *vaddr,
len, ndis_mapshared_cb, (void *)paddr, BUS_DMA_NOWAIT);
if (error) {
bus_dmamem_free(sh->ndis_stag, *vaddr, sh->ndis_smap);
bus_dma_tag_destroy(sh->ndis_stag);
free(sh, M_DEVBUF);
return;
}
sh->ndis_saddr = *vaddr;
sh->ndis_next = sc->ndis_shlist;
sc->ndis_shlist = sh;
return;
}
struct ndis_allocwork {
ndis_handle na_adapter;
uint32_t na_len;
uint8_t na_cached;
void *na_ctx;
};
static void
ndis_asyncmem_complete(arg)
void *arg;
{
ndis_miniport_block *block;
struct ndis_softc *sc;
struct ndis_allocwork *w;
void *vaddr;
ndis_physaddr paddr;
__stdcall ndis_allocdone_handler donefunc;
w = arg;
block = (ndis_miniport_block *)w->na_adapter;
sc = (struct ndis_softc *)(block->nmb_ifp);
vaddr = NULL;
paddr.np_quad = 0;
donefunc = sc->ndis_chars.nmc_allocate_complete_func;
ndis_alloc_sharedmem(w->na_adapter, w->na_len,
w->na_cached, &vaddr, &paddr);
donefunc(w->na_adapter, vaddr, &paddr, w->na_len, w->na_ctx);
free(arg, M_DEVBUF);
return;
}
__stdcall static ndis_status
ndis_alloc_sharedmem_async(adapter, len, cached, ctx)
ndis_handle adapter;
uint32_t len;
uint8_t cached;
void *ctx;
{
struct ndis_allocwork *w;
if (adapter == NULL)
return(NDIS_STATUS_FAILURE);
w = malloc(sizeof(struct ndis_allocwork), M_TEMP, M_NOWAIT);
if (w == NULL)
return(NDIS_STATUS_FAILURE);
w->na_adapter = adapter;
w->na_cached = cached;
w->na_len = len;
w->na_ctx = ctx;
/*
* Pawn this work off on the SWI thread instead of the
* taskqueue thread, because sometimes drivers will queue
* up work items on the taskqueue thread that will block,
* which would prevent the memory allocation from completing
* when we need it.
*/
ndis_sched(ndis_asyncmem_complete, w, NDIS_SWI);
return(NDIS_STATUS_PENDING);
}
__stdcall static void
ndis_free_sharedmem(adapter, len, cached, vaddr, paddr)
ndis_handle adapter;
uint32_t len;
uint8_t cached;
void *vaddr;
ndis_physaddr paddr;
{
ndis_miniport_block *block;
struct ndis_softc *sc;
struct ndis_shmem *sh, *prev;
if (vaddr == NULL || adapter == NULL)
return;
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)(block->nmb_ifp);
sh = prev = sc->ndis_shlist;
while (sh) {
if (sh->ndis_saddr == vaddr)
break;
prev = sh;
sh = sh->ndis_next;
}
bus_dmamap_unload(sh->ndis_stag, sh->ndis_smap);
bus_dmamem_free(sh->ndis_stag, vaddr, sh->ndis_smap);
bus_dma_tag_destroy(sh->ndis_stag);
if (sh == sc->ndis_shlist)
sc->ndis_shlist = sh->ndis_next;
else
prev->ndis_next = sh->ndis_next;
free(sh, M_DEVBUF);
return;
}
__stdcall static ndis_status
ndis_map_iospace(vaddr, adapter, paddr, len)
void **vaddr;
ndis_handle adapter;
ndis_physaddr paddr;
uint32_t len;
{
ndis_miniport_block *block;
struct ndis_softc *sc;
if (adapter == NULL)
return(NDIS_STATUS_FAILURE);
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)(block->nmb_ifp);
if (sc->ndis_res_mem != NULL &&
paddr.np_quad == rman_get_start(sc->ndis_res_mem))
*vaddr = (void *)rman_get_virtual(sc->ndis_res_mem);
else if (sc->ndis_res_altmem != NULL &&
paddr.np_quad == rman_get_start(sc->ndis_res_altmem))
*vaddr = (void *)rman_get_virtual(sc->ndis_res_altmem);
else
return(NDIS_STATUS_FAILURE);
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_unmap_iospace(adapter, vaddr, len)
ndis_handle adapter;
void *vaddr;
uint32_t len;
{
return;
}
__stdcall static uint32_t
ndis_cachefill(void)
{
return(128);
}
__stdcall static uint32_t
ndis_dma_align(handle)
ndis_handle handle;
{
return(128);
}
/*
* NDIS has two methods for dealing with NICs that support DMA.
* One is to just pass packets to the driver and let it call
* NdisMStartBufferPhysicalMapping() to map each buffer in the packet
* all by itself, and the other is to let the NDIS library handle the
* buffer mapping internally, and hand the driver an already populated
* scatter/gather fragment list. If the driver calls
* NdisMInitializeScatterGatherDma(), it wants to use the latter
* method.
*/
__stdcall static ndis_status
ndis_init_sc_dma(adapter, is64, maxphysmap)
ndis_handle adapter;
uint8_t is64;
uint32_t maxphysmap;
{
struct ndis_softc *sc;
ndis_miniport_block *block;
int error;
if (adapter == NULL)
return(NDIS_STATUS_FAILURE);
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)block->nmb_ifp;
/* Don't do this twice. */
if (sc->ndis_sc == 1)
return(NDIS_STATUS_SUCCESS);
error = bus_dma_tag_create(sc->ndis_parent_tag, ETHER_ALIGN, 0,
BUS_SPACE_MAXADDR_32BIT, BUS_SPACE_MAXADDR, NULL, NULL,
MCLBYTES * NDIS_MAXSEG, NDIS_MAXSEG, MCLBYTES, BUS_DMA_ALLOCNOW,
NULL, NULL, &sc->ndis_ttag);
sc->ndis_sc = 1;
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_alloc_packetpool(status, pool, descnum, protrsvdlen)
ndis_status *status;
ndis_handle *pool;
uint32_t descnum;
uint32_t protrsvdlen;
{
ndis_packet *cur;
int i;
*pool = malloc(sizeof(ndis_packet) *
((descnum + NDIS_POOL_EXTRA) + 1),
M_DEVBUF, M_NOWAIT|M_ZERO);
if (pool == NULL) {
*status = NDIS_STATUS_RESOURCES;
return;
}
cur = (ndis_packet *)*pool;
cur->np_private.npp_flags = 0x1; /* mark the head of the list */
cur->np_private.npp_totlen = 0; /* init deletetion flag */
for (i = 0; i < (descnum + NDIS_POOL_EXTRA); i++) {
cur->np_private.npp_head = (ndis_handle)(cur + 1);
cur++;
}
*status = NDIS_STATUS_SUCCESS;
return;
}
__stdcall static void
ndis_ex_alloc_packetpool(status, pool, descnum, oflowdescnum, protrsvdlen)
ndis_status *status;
ndis_handle *pool;
uint32_t descnum;
uint32_t oflowdescnum;
uint32_t protrsvdlen;
{
return(ndis_alloc_packetpool(status, pool,
descnum + oflowdescnum, protrsvdlen));
}
__stdcall static uint32_t
ndis_packetpool_use(pool)
ndis_handle pool;
{
ndis_packet *head;
head = (ndis_packet *)pool;
return(head->np_private.npp_count);
}
__stdcall static void
ndis_free_packetpool(pool)
ndis_handle pool;
{
ndis_packet *head;
head = pool;
/* Mark this pool as 'going away.' */
head->np_private.npp_totlen = 1;
/* If there are no buffers loaned out, destroy the pool. */
if (head->np_private.npp_count == 0)
free(pool, M_DEVBUF);
else
printf("NDIS: buggy driver deleting active packet pool!\n");
return;
}
__stdcall static void
ndis_alloc_packet(status, packet, pool)
ndis_status *status;
ndis_packet **packet;
ndis_handle pool;
{
ndis_packet *head, *pkt;
head = (ndis_packet *)pool;
if (head->np_private.npp_flags != 0x1) {
*status = NDIS_STATUS_FAILURE;
return;
}
/*
* If this pool is marked as 'going away' don't allocate any
* more packets out of it.
*/
if (head->np_private.npp_totlen) {
*status = NDIS_STATUS_FAILURE;
return;
}
pkt = (ndis_packet *)head->np_private.npp_head;
if (pkt == NULL) {
*status = NDIS_STATUS_RESOURCES;
return;
}
head->np_private.npp_head = pkt->np_private.npp_head;
pkt->np_private.npp_head = pkt->np_private.npp_tail = NULL;
/* Save pointer to the pool. */
pkt->np_private.npp_pool = head;
/* Set the oob offset pointer. Lots of things expect this. */
pkt->np_private.npp_packetooboffset =
offsetof(ndis_packet, np_oob);
/*
* We must initialize the packet flags correctly in order
* for the NDIS_SET_PACKET_MEDIA_SPECIFIC_INFO() and
* NDIS_GET_PACKET_MEDIA_SPECIFIC_INFO() to work correctly.
*/
pkt->np_private.npp_ndispktflags = NDIS_PACKET_ALLOCATED_BY_NDIS;
*packet = pkt;
head->np_private.npp_count++;
*status = NDIS_STATUS_SUCCESS;
return;
}
__stdcall static void
ndis_release_packet(packet)
ndis_packet *packet;
{
ndis_packet *head;
if (packet == NULL || packet->np_private.npp_pool == NULL)
return;
head = packet->np_private.npp_pool;
if (head->np_private.npp_flags != 0x1)
return;
packet->np_private.npp_head = head->np_private.npp_head;
head->np_private.npp_head = (ndis_buffer *)packet;
head->np_private.npp_count--;
/*
* If the pool has been marked for deletion and there are
* no more packets outstanding, nuke the pool.
*/
if (head->np_private.npp_totlen && head->np_private.npp_count == 0)
free(head, M_DEVBUF);
return;
}
__stdcall static void
ndis_unchain_headbuf(packet, buf)
ndis_packet *packet;
ndis_buffer **buf;
{
ndis_packet_private *priv;
if (packet == NULL || buf == NULL)
return;
priv = &packet->np_private;
priv->npp_validcounts = FALSE;
if (priv->npp_head == priv->npp_tail) {
*buf = priv->npp_head;
priv->npp_head = priv->npp_tail = NULL;
} else {
*buf = priv->npp_head;
priv->npp_head = (*buf)->nb_next;
}
return;
}
__stdcall static void
ndis_unchain_tailbuf(packet, buf)
ndis_packet *packet;
ndis_buffer **buf;
{
ndis_packet_private *priv;
ndis_buffer *tmp;
if (packet == NULL || buf == NULL)
return;
priv = &packet->np_private;
priv->npp_validcounts = FALSE;
if (priv->npp_head == priv->npp_tail) {
*buf = priv->npp_head;
priv->npp_head = priv->npp_tail = NULL;
} else {
*buf = priv->npp_tail;
tmp = priv->npp_head;
while (tmp->nb_next != priv->npp_tail)
tmp = tmp->nb_next;
priv->npp_tail = tmp;
tmp->nb_next = NULL;
}
return;
}
/*
* The NDIS "buffer" manipulation functions are somewhat misnamed.
* They don't really allocate buffers: they allocate buffer mappings.
* The idea is you reserve a chunk of DMA-able memory using
* NdisMAllocateSharedMemory() and then use NdisAllocateBuffer()
* to obtain the virtual address of the DMA-able region.
* ndis_alloc_bufpool() is analagous to bus_dma_tag_create().
*/
__stdcall static void
ndis_alloc_bufpool(status, pool, descnum)
ndis_status *status;
ndis_handle *pool;
uint32_t descnum;
{
ndis_buffer *cur;
int i;
*pool = malloc(sizeof(ndis_buffer) *
((descnum + NDIS_POOL_EXTRA) + 1),
M_DEVBUF, M_NOWAIT|M_ZERO);
if (pool == NULL) {
*status = NDIS_STATUS_RESOURCES;
return;
}
cur = (ndis_buffer *)*pool;
cur->nb_flags = 0x1; /* mark the head of the list */
cur->nb_bytecount = 0; /* init usage count */
cur->nb_byteoffset = 0; /* init deletetion flag */
for (i = 0; i < (descnum + NDIS_POOL_EXTRA); i++) {
cur->nb_next = cur + 1;
cur++;
}
*status = NDIS_STATUS_SUCCESS;
return;
}
__stdcall static void
ndis_free_bufpool(pool)
ndis_handle pool;
{
ndis_buffer *head;
head = pool;
/* Mark this pool as 'going away.' */
head->nb_byteoffset = 1;
/* If there are no buffers loaned out, destroy the pool. */
if (head->nb_bytecount == 0)
free(pool, M_DEVBUF);
else
printf("NDIS: buggy driver deleting active buffer pool!\n");
return;
}
/*
* This maps to a bus_dmamap_create() and bus_dmamap_load().
*/
__stdcall static void
ndis_alloc_buf(status, buffer, pool, vaddr, len)
ndis_status *status;
ndis_buffer **buffer;
ndis_handle pool;
void *vaddr;
uint32_t len;
{
ndis_buffer *head, *buf;
head = (ndis_buffer *)pool;
if (head->nb_flags != 0x1) {
*status = NDIS_STATUS_FAILURE;
return;
}
/*
* If this pool is marked as 'going away' don't allocate any
* more buffers out of it.
*/
if (head->nb_byteoffset) {
*status = NDIS_STATUS_FAILURE;
return;
}
buf = head->nb_next;
if (buf == NULL) {
*status = NDIS_STATUS_RESOURCES;
return;
}
head->nb_next = buf->nb_next;
/* Save pointer to the pool. */
buf->nb_process = head;
MDL_INIT(buf, vaddr, len);
*buffer = buf;
/* Increment count of busy buffers. */
head->nb_bytecount++;
*status = NDIS_STATUS_SUCCESS;
return;
}
__stdcall static void
ndis_release_buf(buf)
ndis_buffer *buf;
{
ndis_buffer *head;
if (buf == NULL || buf->nb_process == NULL)
return;
head = buf->nb_process;
if (head->nb_flags != 0x1)
return;
buf->nb_next = head->nb_next;
head->nb_next = buf;
/* Decrement count of busy buffers. */
head->nb_bytecount--;
/*
* If the pool has been marked for deletion and there are
* no more buffers outstanding, nuke the pool.
*/
if (head->nb_byteoffset && head->nb_bytecount == 0)
free(head, M_DEVBUF);
return;
}
/* Aw c'mon. */
__stdcall static uint32_t
ndis_buflen(buf)
ndis_buffer *buf;
{
return(buf->nb_bytecount);
}
/*
* Get the virtual address and length of a buffer.
* Note: the vaddr argument is optional.
*/
__stdcall static void
ndis_query_buf(buf, vaddr, len)
ndis_buffer *buf;
void **vaddr;
uint32_t *len;
{
if (vaddr != NULL)
*vaddr = MDL_VA(buf);
*len = buf->nb_bytecount;
return;
}
/* Same as above -- we don't care about the priority. */
__stdcall static void
ndis_query_buf_safe(buf, vaddr, len, prio)
ndis_buffer *buf;
void **vaddr;
uint32_t *len;
uint32_t prio;
{
if (vaddr != NULL)
*vaddr = MDL_VA(buf);
*len = buf->nb_bytecount;
return;
}
/* Damnit Microsoft!! How many ways can you do the same thing?! */
__stdcall static void *
ndis_buf_vaddr(buf)
ndis_buffer *buf;
{
return(MDL_VA(buf));
}
__stdcall static void *
ndis_buf_vaddr_safe(buf, prio)
ndis_buffer *buf;
uint32_t prio;
{
return(MDL_VA(buf));
}
__stdcall static void
ndis_adjust_buflen(buf, len)
ndis_buffer *buf;
int len;
{
buf->nb_bytecount = len;
return;
}
__stdcall static uint32_t
ndis_interlock_inc(addend)
uint32_t *addend;
{
atomic_add_long((u_long *)addend, 1);
return(*addend);
}
__stdcall static uint32_t
ndis_interlock_dec(addend)
uint32_t *addend;
{
atomic_subtract_long((u_long *)addend, 1);
return(*addend);
}
__stdcall static void
ndis_init_event(event)
ndis_event *event;
{
event->ne_event.nk_header.dh_sigstate = FALSE;
event->ne_event.nk_header.dh_size = OTYPE_EVENT;
event->ne_event.nk_header.dh_type = EVENT_TYPE_NOTIFY;
INIT_LIST_HEAD((&event->ne_event.nk_header.dh_waitlisthead));
return;
}
__stdcall static void
ndis_set_event(event)
ndis_event *event;
{
ntoskrnl_wakeup(event);
return;
}
__stdcall static void
ndis_reset_event(event)
ndis_event *event;
{
event->ne_event.nk_header.dh_sigstate = FALSE;
return;
}
/*
* This is a stripped-down version of KeWaitForSingleObject().
* Maybe it ought to just call ntoskrnl_waitforobj() to reduce
* code duplication.
*/
__stdcall static uint8_t
ndis_wait_event(event, msecs)
ndis_event *event;
uint32_t msecs;
{
int error;
struct timeval tv;
wait_block w;
struct thread *td = curthread;
mtx_pool_lock(ndis_mtxpool, ntoskrnl_dispatchlock);
if (event->ne_event.nk_header.dh_sigstate == TRUE) {
mtx_pool_unlock(ndis_mtxpool, ntoskrnl_dispatchlock);
return(TRUE);
}
INSERT_LIST_TAIL((&event->ne_event.nk_header.dh_waitlisthead),
(&w.wb_waitlist));
tv.tv_sec = 0;
tv.tv_usec = msecs * 1000;
w.wb_kthread = td;
w.wb_object = &event->ne_event.nk_header;
mtx_pool_unlock(ndis_mtxpool, ntoskrnl_dispatchlock);
if (td->td_proc->p_flag & P_KTHREAD)
error = kthread_suspend(td->td_proc, tvtohz(&tv));
else
error = tsleep(td, PPAUSE|PCATCH, "ndiswe", tvtohz(&tv));
mtx_pool_lock(ndis_mtxpool, ntoskrnl_dispatchlock);
REMOVE_LIST_ENTRY((&w.wb_waitlist));
mtx_pool_unlock(ndis_mtxpool, ntoskrnl_dispatchlock);
return(event->ne_event.nk_header.dh_sigstate);
}
__stdcall static ndis_status
ndis_unicode2ansi(dstr, sstr)
ndis_ansi_string *dstr;
ndis_unicode_string *sstr;
{
if (dstr == NULL || sstr == NULL)
return(NDIS_STATUS_FAILURE);
if (ndis_unicode_to_ascii(sstr->nus_buf,
sstr->nus_len, &dstr->nas_buf))
return(NDIS_STATUS_FAILURE);
dstr->nas_len = dstr->nas_maxlen = strlen(dstr->nas_buf);
return (NDIS_STATUS_SUCCESS);
}
__stdcall static ndis_status
ndis_ansi2unicode(dstr, sstr)
ndis_unicode_string *dstr;
ndis_ansi_string *sstr;
{
char *str;
if (dstr == NULL || sstr == NULL)
return(NDIS_STATUS_FAILURE);
str = malloc(sstr->nas_len + 1, M_DEVBUF, M_NOWAIT);
if (str == NULL)
return(NDIS_STATUS_FAILURE);
strncpy(str, sstr->nas_buf, sstr->nas_len);
*(str + sstr->nas_len) = '\0';
if (ndis_ascii_to_unicode(str, &dstr->nus_buf)) {
free(str, M_DEVBUF);
return(NDIS_STATUS_FAILURE);
}
dstr->nus_len = dstr->nus_maxlen = sstr->nas_len * 2;
free(str, M_DEVBUF);
return (NDIS_STATUS_SUCCESS);
}
__stdcall static ndis_status
ndis_assign_pcirsrc(adapter, slot, list)
ndis_handle adapter;
uint32_t slot;
ndis_resource_list **list;
{
ndis_miniport_block *block;
if (adapter == NULL || list == NULL)
return (NDIS_STATUS_FAILURE);
block = (ndis_miniport_block *)adapter;
*list = block->nmb_rlist;
return (NDIS_STATUS_SUCCESS);
}
__stdcall static ndis_status
ndis_register_intr(intr, adapter, ivec, ilevel, reqisr, shared, imode)
ndis_miniport_interrupt *intr;
ndis_handle adapter;
uint32_t ivec;
uint32_t ilevel;
uint8_t reqisr;
uint8_t shared;
ndis_interrupt_mode imode;
{
ndis_miniport_block *block;
block = adapter;
intr->ni_block = adapter;
intr->ni_isrreq = reqisr;
intr->ni_shared = shared;
block->nmb_interrupt = intr;
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_deregister_intr(intr)
ndis_miniport_interrupt *intr;
{
return;
}
__stdcall static void
ndis_register_shutdown(adapter, shutdownctx, shutdownfunc)
ndis_handle adapter;
void *shutdownctx;
ndis_shutdown_handler shutdownfunc;
{
ndis_miniport_block *block;
ndis_miniport_characteristics *chars;
struct ndis_softc *sc;
if (adapter == NULL)
return;
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)block->nmb_ifp;
chars = &sc->ndis_chars;
chars->nmc_shutdown_handler = shutdownfunc;
chars->nmc_rsvd0 = shutdownctx;
return;
}
__stdcall static void
ndis_deregister_shutdown(adapter)
ndis_handle adapter;
{
ndis_miniport_block *block;
ndis_miniport_characteristics *chars;
struct ndis_softc *sc;
if (adapter == NULL)
return;
block = (ndis_miniport_block *)adapter;
sc = (struct ndis_softc *)block->nmb_ifp;
chars = &sc->ndis_chars;
chars->nmc_shutdown_handler = NULL;
chars->nmc_rsvd0 = NULL;
return;
}
__stdcall static uint32_t
ndis_numpages(buf)
ndis_buffer *buf;
{
if (buf == NULL)
return(0);
if (buf->nb_bytecount == 0)
return(1);
return(SPAN_PAGES(MDL_VA(buf), buf->nb_bytecount));
}
__stdcall static void
ndis_buf_physpages(buf, pages)
ndis_buffer *buf;
uint32_t *pages;
{
if (buf == NULL)
return;
*pages = ndis_numpages(buf);
return;
}
__stdcall static void
ndis_query_bufoffset(buf, off, len)
ndis_buffer *buf;
uint32_t *off;
uint32_t *len;
{
if (buf == NULL)
return;
*off = buf->nb_byteoffset;
*len = buf->nb_bytecount;
return;
}
__stdcall static void
ndis_sleep(usecs)
uint32_t usecs;
{
struct timeval tv;
uint32_t dummy;
tv.tv_sec = 0;
tv.tv_usec = usecs;
tsleep(&dummy, PPAUSE|PCATCH, "ndis", tvtohz(&tv));
return;
}
__stdcall static uint32_t
ndis_read_pccard_amem(handle, offset, buf, len)
ndis_handle handle;
uint32_t offset;
void *buf;
uint32_t len;
{
struct ndis_softc *sc;
ndis_miniport_block *block;
bus_space_handle_t bh;
bus_space_tag_t bt;
char *dest;
int i;
if (handle == NULL)
return(0);
block = (ndis_miniport_block *)handle;
sc = (struct ndis_softc *)block->nmb_ifp;
dest = buf;
bh = rman_get_bushandle(sc->ndis_res_am);
bt = rman_get_bustag(sc->ndis_res_am);
for (i = 0; i < len; i++)
dest[i] = bus_space_read_1(bt, bh, (offset * 2) + (i * 2));
return(i);
}
__stdcall static uint32_t
ndis_write_pccard_amem(handle, offset, buf, len)
ndis_handle handle;
uint32_t offset;
void *buf;
uint32_t len;
{
struct ndis_softc *sc;
ndis_miniport_block *block;
bus_space_handle_t bh;
bus_space_tag_t bt;
char *src;
int i;
if (handle == NULL)
return(0);
block = (ndis_miniport_block *)handle;
sc = (struct ndis_softc *)block->nmb_ifp;
src = buf;
bh = rman_get_bushandle(sc->ndis_res_am);
bt = rman_get_bustag(sc->ndis_res_am);
for (i = 0; i < len; i++)
bus_space_write_1(bt, bh, (offset * 2) + (i * 2), src[i]);
return(i);
}
__stdcall static list_entry *
ndis_insert_head(head, entry, lock)
list_entry *head;
list_entry *entry;
ndis_spin_lock *lock;
{
list_entry *flink;
mtx_pool_lock(ndis_mtxpool, (struct mtx *)lock->nsl_spinlock);
flink = head->nle_flink;
entry->nle_flink = flink;
entry->nle_blink = head;
flink->nle_blink = entry;
head->nle_flink = entry;
mtx_pool_unlock(ndis_mtxpool, (struct mtx *)lock->nsl_spinlock);
return(flink);
}
__stdcall static list_entry *
ndis_remove_head(head, lock)
list_entry *head;
ndis_spin_lock *lock;
{
list_entry *flink;
list_entry *entry;
mtx_pool_lock(ndis_mtxpool, (struct mtx *)lock->nsl_spinlock);
entry = head->nle_flink;
flink = entry->nle_flink;
head->nle_flink = flink;
flink->nle_blink = head;
mtx_pool_unlock(ndis_mtxpool, (struct mtx *)lock->nsl_spinlock);
return(entry);
}
__stdcall static list_entry *
ndis_insert_tail(head, entry, lock)
list_entry *head;
list_entry *entry;
ndis_spin_lock *lock;
{
list_entry *blink;
mtx_pool_lock(ndis_mtxpool, (struct mtx *)lock->nsl_spinlock);
blink = head->nle_blink;
entry->nle_flink = head;
entry->nle_blink = blink;
blink->nle_flink = entry;
head->nle_blink = entry;
mtx_pool_unlock(ndis_mtxpool, (struct mtx *)lock->nsl_spinlock);
return(blink);
}
__stdcall static uint8_t
ndis_sync_with_intr(intr, syncfunc, syncctx)
ndis_miniport_interrupt *intr;
void *syncfunc;
void *syncctx;
{
struct ndis_softc *sc;
__stdcall uint8_t (*sync)(void *);
uint8_t rval;
if (syncfunc == NULL || syncctx == NULL)
return(0);
sc = (struct ndis_softc *)intr->ni_block->nmb_ifp;
sync = syncfunc;
mtx_pool_lock(ndis_mtxpool, sc->ndis_intrmtx);
rval = sync(syncctx);
mtx_pool_unlock(ndis_mtxpool, sc->ndis_intrmtx);
return(rval);
}
/*
* Return the number of 100 nanosecond intervals since
* January 1, 1601. (?!?!)
*/
__stdcall static void
ndis_time(tval)
uint64_t *tval;
{
struct timespec ts;
nanotime(&ts);
*tval = (uint64_t)ts.tv_nsec / 100 + (uint64_t)ts.tv_sec * 10000000 +
11644473600;
return;
}
/*
* Return the number of milliseconds since the system booted.
*/
__stdcall static void
ndis_uptime(tval)
uint32_t *tval;
{
struct timespec ts;
nanouptime(&ts);
*tval = ts.tv_nsec / 1000000 + ts.tv_sec * 1000;
return;
}
__stdcall static void
ndis_init_string(dst, src)
ndis_unicode_string *dst;
char *src;
{
ndis_unicode_string *u;
u = dst;
u->nus_buf = NULL;
if (ndis_ascii_to_unicode(src, &u->nus_buf))
return;
u->nus_len = u->nus_maxlen = strlen(src) * 2;
return;
}
__stdcall static void
ndis_free_string(str)
ndis_unicode_string *str;
{
if (str == NULL)
return;
if (str->nus_buf != NULL)
free(str->nus_buf, M_DEVBUF);
free(str, M_DEVBUF);
return;
}
__stdcall static ndis_status
ndis_remove_miniport(adapter)
ndis_handle *adapter;
{
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_init_ansi_string(dst, src)
ndis_ansi_string *dst;
char *src;
{
ndis_ansi_string *a;
a = dst;
if (a == NULL)
return;
if (src == NULL) {
a->nas_len = a->nas_maxlen = 0;
a->nas_buf = NULL;
} else {
a->nas_buf = src;
a->nas_len = a->nas_maxlen = strlen(src);
}
return;
}
__stdcall static void
ndis_init_unicode_string(dst, src)
ndis_unicode_string *dst;
uint16_t *src;
{
ndis_unicode_string *u;
int i;
u = dst;
if (u == NULL)
return;
if (src == NULL) {
u->nus_len = u->nus_maxlen = 0;
u->nus_buf = NULL;
} else {
i = 0;
while(src[i] != 0)
i++;
u->nus_buf = src;
u->nus_len = u->nus_maxlen = i * 2;
}
return;
}
__stdcall static void ndis_get_devprop(adapter, phydevobj,
funcdevobj, nextdevobj, resources, transresources)
ndis_handle adapter;
device_object **phydevobj;
device_object **funcdevobj;
device_object **nextdevobj;
cm_resource_list *resources;
cm_resource_list *transresources;
{
ndis_miniport_block *block;
block = (ndis_miniport_block *)adapter;
if (phydevobj != NULL)
*phydevobj = &block->nmb_devobj;
if (funcdevobj != NULL)
*funcdevobj = &block->nmb_devobj;
return;
}
__stdcall static void
ndis_firstbuf(packet, buf, firstva, firstlen, totlen)
ndis_packet *packet;
ndis_buffer **buf;
void **firstva;
uint32_t *firstlen;
uint32_t *totlen;
{
ndis_buffer *tmp;
tmp = packet->np_private.npp_head;
*buf = tmp;
if (tmp == NULL) {
*firstva = NULL;
*firstlen = *totlen = 0;
} else {
*firstva = MDL_VA(tmp);
*firstlen = *totlen = tmp->nb_bytecount;
for (tmp = tmp->nb_next; tmp != NULL; tmp = tmp->nb_next)
*totlen += tmp->nb_bytecount;
}
return;
}
__stdcall static void
ndis_firstbuf_safe(packet, buf, firstva, firstlen, totlen, prio)
ndis_packet *packet;
ndis_buffer **buf;
void **firstva;
uint32_t *firstlen;
uint32_t *totlen;
uint32_t prio;
{
ndis_firstbuf(packet, buf, firstva, firstlen, totlen);
}
/* can also return NDIS_STATUS_RESOURCES/NDIS_STATUS_ERROR_READING_FILE */
__stdcall static void
ndis_open_file(status, filehandle, filelength, filename, highestaddr)
ndis_status *status;
ndis_handle *filehandle;
uint32_t *filelength;
ndis_unicode_string *filename;
ndis_physaddr highestaddr;
{
char *afilename = NULL;
struct thread *td = curthread;
struct nameidata nd;
int flags, error;
struct vattr vat;
struct vattr *vap = &vat;
ndis_fh *fh;
char path[MAXPATHLEN];
ndis_unicode_to_ascii(filename->nus_buf,
filename->nus_len, &afilename);
sprintf(path, "%s/%s", ndis_filepath, afilename);
free(afilename, M_DEVBUF);
fh = malloc(sizeof(ndis_fh), M_TEMP, M_NOWAIT);
if (fh == NULL) {
*status = NDIS_STATUS_RESOURCES;
return;
}
mtx_lock(&Giant);
/* Some threads don't have a current working directory. */
if (td->td_proc->p_fd->fd_rdir == NULL)
td->td_proc->p_fd->fd_rdir = rootvnode;
if (td->td_proc->p_fd->fd_cdir == NULL)
td->td_proc->p_fd->fd_cdir = rootvnode;
NDINIT(&nd, LOOKUP, FOLLOW, UIO_SYSSPACE, path, td);
flags = FREAD;
error = vn_open(&nd, &flags, 0, -1);
if (error) {
mtx_unlock(&Giant);
*status = NDIS_STATUS_FILE_NOT_FOUND;
free(fh, M_TEMP);
return;
}
NDFREE(&nd, NDF_ONLY_PNBUF);
/* Get the file size. */
VOP_GETATTR(nd.ni_vp, vap, NOCRED, td);
VOP_UNLOCK(nd.ni_vp, 0, td);
mtx_unlock(&Giant);
fh->nf_vp = nd.ni_vp;
fh->nf_map = NULL;
*filehandle = fh;
*filelength = fh->nf_maplen = vap->va_size & 0xFFFFFFFF;
*status = NDIS_STATUS_SUCCESS;
return;
}
__stdcall static void
ndis_map_file(status, mappedbuffer, filehandle)
ndis_status *status;
void **mappedbuffer;
ndis_handle filehandle;
{
ndis_fh *fh;
struct thread *td = curthread;
int error, resid;
if (filehandle == NULL) {
*status = NDIS_STATUS_FAILURE;
return;
}
fh = (ndis_fh *)filehandle;
if (fh->nf_vp == NULL) {
*status = NDIS_STATUS_FAILURE;
return;
}
if (fh->nf_map != NULL) {
*status = NDIS_STATUS_ALREADY_MAPPED;
return;
}
fh->nf_map = malloc(fh->nf_maplen, M_DEVBUF, M_NOWAIT);
if (fh->nf_map == NULL) {
*status = NDIS_STATUS_RESOURCES;
return;
}
mtx_lock(&Giant);
error = vn_rdwr(UIO_READ, fh->nf_vp, fh->nf_map, fh->nf_maplen, 0,
UIO_SYSSPACE, 0, td->td_ucred, NOCRED, &resid, td);
mtx_unlock(&Giant);
if (error)
*status = NDIS_STATUS_FAILURE;
else {
*status = NDIS_STATUS_SUCCESS;
*mappedbuffer = fh->nf_map;
}
return;
}
__stdcall static void
ndis_unmap_file(filehandle)
ndis_handle filehandle;
{
ndis_fh *fh;
fh = (ndis_fh *)filehandle;
if (fh->nf_map == NULL)
return;
free(fh->nf_map, M_DEVBUF);
fh->nf_map = NULL;
return;
}
__stdcall static void
ndis_close_file(filehandle)
ndis_handle filehandle;
{
struct thread *td = curthread;
ndis_fh *fh;
if (filehandle == NULL)
return;
fh = (ndis_fh *)filehandle;
if (fh->nf_map != NULL) {
free(fh->nf_map, M_DEVBUF);
fh->nf_map = NULL;
}
if (fh->nf_vp == NULL)
return;
mtx_lock(&Giant);
vn_close(fh->nf_vp, FREAD, td->td_ucred, td);
mtx_unlock(&Giant);
fh->nf_vp = NULL;
free(fh, M_DEVBUF);
return;
}
__stdcall static uint8_t
ndis_cpu_cnt()
{
return(mp_ncpus);
}
typedef void (*ndis_statusdone_handler)(ndis_handle);
typedef void (*ndis_status_handler)(ndis_handle, ndis_status,
void *, uint32_t);
__stdcall static void
ndis_ind_statusdone(adapter)
ndis_handle adapter;
{
ndis_miniport_block *block;
__stdcall ndis_statusdone_handler statusdonefunc;
block = (ndis_miniport_block *)adapter;
statusdonefunc = block->nmb_statusdone_func;
statusdonefunc(adapter);
return;
}
__stdcall static void
ndis_ind_status(adapter, status, sbuf, slen)
ndis_handle adapter;
ndis_status status;
void *sbuf;
uint32_t slen;
{
ndis_miniport_block *block;
__stdcall ndis_status_handler statusfunc;
block = (ndis_miniport_block *)adapter;
statusfunc = block->nmb_status_func;
statusfunc(adapter, status, sbuf, slen);
return;
}
static void
ndis_workfunc(ctx)
void *ctx;
{
ndis_work_item *work;
__stdcall ndis_proc workfunc;
work = ctx;
workfunc = work->nwi_func;
workfunc(work, work->nwi_ctx);
return;
}
__stdcall static ndis_status
ndis_sched_workitem(work)
ndis_work_item *work;
{
ndis_sched(ndis_workfunc, work, NDIS_TASKQUEUE);
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_pkt_to_pkt(dpkt, doff, reqlen, spkt, soff, cpylen)
ndis_packet *dpkt;
uint32_t doff;
uint32_t reqlen;
ndis_packet *spkt;
uint32_t soff;
uint32_t *cpylen;
{
ndis_buffer *src, *dst;
char *sptr, *dptr;
int resid, copied, len, scnt, dcnt;
*cpylen = 0;
src = spkt->np_private.npp_head;
dst = dpkt->np_private.npp_head;
sptr = MDL_VA(src);
dptr = MDL_VA(dst);
scnt = src->nb_bytecount;
dcnt = dst->nb_bytecount;
while (soff) {
if (src->nb_bytecount > soff) {
sptr += soff;
scnt = src->nb_bytecount - soff;
break;
}
soff -= src->nb_bytecount;
src = src->nb_next;
if (src == NULL)
return;
sptr = MDL_VA(src);
}
while (doff) {
if (dst->nb_bytecount > doff) {
dptr += doff;
dcnt = dst->nb_bytecount - doff;
break;
}
doff -= dst->nb_bytecount;
dst = dst->nb_next;
if (dst == NULL)
return;
dptr = MDL_VA(dst);
}
resid = reqlen;
copied = 0;
while(1) {
if (resid < scnt)
len = resid;
else
len = scnt;
if (dcnt < len)
len = dcnt;
bcopy(sptr, dptr, len);
copied += len;
resid -= len;
if (resid == 0)
break;
dcnt -= len;
if (dcnt == 0) {
dst = dst->nb_next;
if (dst == NULL)
break;
dptr = MDL_VA(dst);
dcnt = dst->nb_bytecount;
}
scnt -= len;
if (scnt == 0) {
src = src->nb_next;
if (src == NULL)
break;
sptr = MDL_VA(src);
scnt = src->nb_bytecount;
}
}
*cpylen = copied;
return;
}
__stdcall static void
ndis_pkt_to_pkt_safe(dpkt, doff, reqlen, spkt, soff, cpylen, prio)
ndis_packet *dpkt;
uint32_t doff;
uint32_t reqlen;
ndis_packet *spkt;
uint32_t soff;
uint32_t *cpylen;
uint32_t prio;
{
ndis_pkt_to_pkt(dpkt, doff, reqlen, spkt, soff, cpylen);
return;
}
__stdcall static ndis_status
ndis_register_dev(handle, devname, symname, majorfuncs, devobj, devhandle)
ndis_handle handle;
ndis_unicode_string *devname;
ndis_unicode_string *symname;
driver_dispatch *majorfuncs[];
void **devobj;
ndis_handle *devhandle;
{
ndis_miniport_block *block;
block = (ndis_miniport_block *)handle;
*devobj = &block->nmb_devobj;
*devhandle = handle;
return(NDIS_STATUS_SUCCESS);
}
__stdcall static ndis_status
ndis_deregister_dev(handle)
ndis_handle handle;
{
return(NDIS_STATUS_SUCCESS);
}
__stdcall static ndis_status
ndis_query_name(name, handle)
ndis_unicode_string *name;
ndis_handle handle;
{
ndis_miniport_block *block;
block = (ndis_miniport_block *)handle;
ndis_ascii_to_unicode(__DECONST(char *,
device_get_nameunit(block->nmb_dev)), &name->nus_buf);
name->nus_len = strlen(device_get_nameunit(block->nmb_dev)) * 2;
return(NDIS_STATUS_SUCCESS);
}
__stdcall static void
ndis_register_unload(handle, func)
ndis_handle handle;
void *func;
{
return;
}
__stdcall static void
dummy()
{
printf ("NDIS dummy called...\n");
return;
}
image_patch_table ndis_functbl[] = {
{ "NdisCopyFromPacketToPacket", (FUNC)ndis_pkt_to_pkt },
{ "NdisCopyFromPacketToPacketSafe", (FUNC)ndis_pkt_to_pkt_safe },
{ "NdisScheduleWorkItem", (FUNC)ndis_sched_workitem },
{ "NdisMIndicateStatusComplete", (FUNC)ndis_ind_statusdone },
{ "NdisMIndicateStatus", (FUNC)ndis_ind_status },
{ "NdisSystemProcessorCount", (FUNC)ndis_cpu_cnt },
{ "NdisUnchainBufferAtBack", (FUNC)ndis_unchain_tailbuf, },
{ "NdisGetFirstBufferFromPacket", (FUNC)ndis_firstbuf },
{ "NdisGetFirstBufferFromPacketSafe", (FUNC)ndis_firstbuf_safe },
{ "NdisGetBufferPhysicalArraySize", (FUNC)ndis_buf_physpages },
{ "NdisMGetDeviceProperty", (FUNC)ndis_get_devprop },
{ "NdisInitAnsiString", (FUNC)ndis_init_ansi_string },
{ "NdisInitUnicodeString", (FUNC)ndis_init_unicode_string },
{ "NdisWriteConfiguration", (FUNC)ndis_write_cfg },
{ "NdisAnsiStringToUnicodeString", (FUNC)ndis_ansi2unicode },
{ "NdisTerminateWrapper", (FUNC)ndis_termwrap },
{ "NdisOpenConfigurationKeyByName", (FUNC)ndis_open_cfgbyname },
{ "NdisOpenConfigurationKeyByIndex", (FUNC)ndis_open_cfgbyidx },
{ "NdisMRemoveMiniport", (FUNC)ndis_remove_miniport },
{ "NdisInitializeString", (FUNC)ndis_init_string },
{ "NdisFreeString", (FUNC)ndis_free_string },
{ "NdisGetCurrentSystemTime", (FUNC)ndis_time },
{ "NdisGetSystemUpTime", (FUNC)ndis_uptime },
{ "NdisMSynchronizeWithInterrupt", (FUNC)ndis_sync_with_intr },
{ "NdisMAllocateSharedMemoryAsync", (FUNC)ndis_alloc_sharedmem_async },
{ "NdisInterlockedInsertHeadList", (FUNC)ndis_insert_head },
{ "NdisInterlockedInsertTailList", (FUNC)ndis_insert_tail },
{ "NdisInterlockedRemoveHeadList", (FUNC)ndis_remove_head },
{ "NdisInitializeWrapper", (FUNC)ndis_initwrap },
{ "NdisMRegisterMiniport", (FUNC)ndis_register_miniport },
{ "NdisAllocateMemoryWithTag", (FUNC)ndis_malloc_withtag },
{ "NdisAllocateMemory", (FUNC)ndis_malloc },
{ "NdisMSetAttributesEx", (FUNC)ndis_setattr_ex },
{ "NdisCloseConfiguration", (FUNC)ndis_close_cfg },
{ "NdisReadConfiguration", (FUNC)ndis_read_cfg },
{ "NdisOpenConfiguration", (FUNC)ndis_open_cfg },
{ "NdisReleaseSpinLock", (FUNC)ndis_unlock },
{ "NdisDprAcquireSpinLock", (FUNC)ndis_lock },
{ "NdisDprReleaseSpinLock", (FUNC)ndis_unlock },
{ "NdisAcquireSpinLock", (FUNC)ndis_lock },
{ "NdisAllocateSpinLock", (FUNC)ndis_create_lock },
{ "NdisFreeSpinLock", (FUNC)ndis_destroy_lock },
{ "NdisFreeMemory", (FUNC)ndis_free },
{ "NdisReadPciSlotInformation", (FUNC)ndis_read_pci },
{ "NdisWritePciSlotInformation",(FUNC)ndis_write_pci },
{ "NdisImmediateReadPciSlotInformation", (FUNC)ndis_read_pci },
{ "NdisImmediateWritePciSlotInformation", (FUNC)ndis_write_pci },
{ "NdisWriteErrorLogEntry", (FUNC)ndis_syslog },
{ "NdisMStartBufferPhysicalMapping", (FUNC)ndis_vtophys_load },
{ "NdisMCompleteBufferPhysicalMapping", (FUNC)ndis_vtophys_unload },
{ "NdisMInitializeTimer", (FUNC)ndis_create_timer },
{ "NdisInitializeTimer", (FUNC)ndis_init_timer },
{ "NdisSetTimer", (FUNC)ndis_set_timer },
{ "NdisMCancelTimer", (FUNC)ndis_cancel_timer },
{ "NdisCancelTimer", (FUNC)ndis_cancel_timer },
{ "NdisMSetPeriodicTimer", (FUNC)ndis_set_periodic_timer },
{ "NdisMQueryAdapterResources", (FUNC)ndis_query_resources },
{ "NdisMRegisterIoPortRange", (FUNC)ndis_register_ioport },
{ "NdisMDeregisterIoPortRange", (FUNC)ndis_deregister_ioport },
{ "NdisReadNetworkAddress", (FUNC)ndis_read_netaddr },
{ "NdisQueryMapRegisterCount", (FUNC)ndis_mapreg_cnt },
{ "NdisMAllocateMapRegisters", (FUNC)ndis_alloc_mapreg },
{ "NdisMFreeMapRegisters", (FUNC)ndis_free_mapreg },
{ "NdisMAllocateSharedMemory", (FUNC)ndis_alloc_sharedmem },
{ "NdisMMapIoSpace", (FUNC)ndis_map_iospace },
{ "NdisMUnmapIoSpace", (FUNC)ndis_unmap_iospace },
{ "NdisGetCacheFillSize", (FUNC)ndis_cachefill },
{ "NdisMGetDmaAlignment", (FUNC)ndis_dma_align },
{ "NdisMInitializeScatterGatherDma", (FUNC)ndis_init_sc_dma },
{ "NdisAllocatePacketPool", (FUNC)ndis_alloc_packetpool },
{ "NdisAllocatePacketPoolEx", (FUNC)ndis_ex_alloc_packetpool },
{ "NdisAllocatePacket", (FUNC)ndis_alloc_packet },
{ "NdisFreePacket", (FUNC)ndis_release_packet },
{ "NdisFreePacketPool", (FUNC)ndis_free_packetpool },
{ "NdisDprAllocatePacket", (FUNC)ndis_alloc_packet },
{ "NdisDprFreePacket", (FUNC)ndis_release_packet },
{ "NdisAllocateBufferPool", (FUNC)ndis_alloc_bufpool },
{ "NdisAllocateBuffer", (FUNC)ndis_alloc_buf },
{ "NdisQueryBuffer", (FUNC)ndis_query_buf },
{ "NdisQueryBufferSafe", (FUNC)ndis_query_buf_safe },
{ "NdisBufferVirtualAddress", (FUNC)ndis_buf_vaddr },
{ "NdisBufferVirtualAddressSafe", (FUNC)ndis_buf_vaddr_safe },
{ "NdisBufferLength", (FUNC)ndis_buflen },
{ "NdisFreeBuffer", (FUNC)ndis_release_buf },
{ "NdisFreeBufferPool", (FUNC)ndis_free_bufpool },
{ "NdisInterlockedIncrement", (FUNC)ndis_interlock_inc },
{ "NdisInterlockedDecrement", (FUNC)ndis_interlock_dec },
{ "NdisInitializeEvent", (FUNC)ndis_init_event },
{ "NdisSetEvent", (FUNC)ndis_set_event },
{ "NdisResetEvent", (FUNC)ndis_reset_event },
{ "NdisWaitEvent", (FUNC)ndis_wait_event },
{ "NdisUnicodeStringToAnsiString", (FUNC)ndis_unicode2ansi },
{ "NdisMPciAssignResources", (FUNC)ndis_assign_pcirsrc },
{ "NdisMFreeSharedMemory", (FUNC)ndis_free_sharedmem },
{ "NdisMRegisterInterrupt", (FUNC)ndis_register_intr },
{ "NdisMDeregisterInterrupt", (FUNC)ndis_deregister_intr },
{ "NdisMRegisterAdapterShutdownHandler", (FUNC)ndis_register_shutdown },
{ "NdisMDeregisterAdapterShutdownHandler", (FUNC)ndis_deregister_shutdown },
{ "NDIS_BUFFER_TO_SPAN_PAGES", (FUNC)ndis_numpages },
{ "NdisQueryBufferOffset", (FUNC)ndis_query_bufoffset },
{ "NdisAdjustBufferLength", (FUNC)ndis_adjust_buflen },
{ "NdisPacketPoolUsage", (FUNC)ndis_packetpool_use },
{ "NdisMSleep", (FUNC)ndis_sleep },
{ "NdisUnchainBufferAtFront", (FUNC)ndis_unchain_headbuf },
{ "NdisReadPcmciaAttributeMemory", (FUNC)ndis_read_pccard_amem },
{ "NdisWritePcmciaAttributeMemory", (FUNC)ndis_write_pccard_amem },
{ "NdisOpenFile", (FUNC)ndis_open_file },
{ "NdisMapFile", (FUNC)ndis_map_file },
{ "NdisUnmapFile", (FUNC)ndis_unmap_file },
{ "NdisCloseFile", (FUNC)ndis_close_file },
{ "NdisMRegisterDevice", (FUNC)ndis_register_dev },
{ "NdisMDeregisterDevice", (FUNC)ndis_deregister_dev },
{ "NdisMQueryAdapterInstanceName", (FUNC)ndis_query_name },
{ "NdisMRegisterUnloadHandler", (FUNC)ndis_register_unload },
/*
* This last entry is a catch-all for any function we haven't
* implemented yet. The PE import list patching routine will
* use it for any function that doesn't have an explicit match
* in this table.
*/
{ NULL, (FUNC)dummy },
/* End of list. */
{ NULL, NULL },
};
Reference in New Issue View Git Blame Copy Permalink