5494dcfa1c
Casting from rman_res_t to a pointer results in "cast to pointer from integer of different size" warnings with base gcc on i386, so use an intermediate cast to uintptr_t to suppress it. In this case, the I/O port range is effectively limited to the range of 0..65535. Reviewed by: imp MFC after: 3 days Differential Revision: https://reviews.freebsd.org/D15746
3377 lines
83 KiB
C
3377 lines
83 KiB
C
/*-
|
|
* SPDX-License-Identifier: BSD-4-Clause
|
|
*
|
|
* 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/ctype.h>
|
|
#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 <sys/linker.h>
|
|
#include <sys/mount.h>
|
|
#include <sys/sysproto.h>
|
|
|
|
#include <net/if.h>
|
|
#include <net/if_var.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.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 <dev/usb/usb.h>
|
|
#include <dev/usb/usbdi.h>
|
|
|
|
#include <compat/ndis/pe_var.h>
|
|
#include <compat/ndis/cfg_var.h>
|
|
#include <compat/ndis/resource_var.h>
|
|
#include <compat/ndis/ntoskrnl_var.h>
|
|
#include <compat/ndis/hal_var.h>
|
|
#include <compat/ndis/ndis_var.h>
|
|
#include <dev/if_ndis/if_ndisvar.h>
|
|
|
|
#include <vm/vm.h>
|
|
#include <vm/vm_param.h>
|
|
#include <vm/pmap.h>
|
|
#include <vm/uma.h>
|
|
#include <vm/vm_kern.h>
|
|
#include <vm/vm_map.h>
|
|
|
|
static char ndis_filepath[MAXPATHLEN];
|
|
|
|
SYSCTL_STRING(_hw, OID_AUTO, ndis_filepath, CTLFLAG_RW, ndis_filepath,
|
|
MAXPATHLEN, "Path used by NdisOpenFile() to search for files");
|
|
|
|
static void NdisInitializeWrapper(ndis_handle *,
|
|
driver_object *, void *, void *);
|
|
static ndis_status NdisMRegisterMiniport(ndis_handle,
|
|
ndis_miniport_characteristics *, int);
|
|
static ndis_status NdisAllocateMemoryWithTag(void **,
|
|
uint32_t, uint32_t);
|
|
static ndis_status NdisAllocateMemory(void **,
|
|
uint32_t, uint32_t, ndis_physaddr);
|
|
static void NdisFreeMemory(void *, uint32_t, uint32_t);
|
|
static ndis_status NdisMSetAttributesEx(ndis_handle, ndis_handle,
|
|
uint32_t, uint32_t, ndis_interface_type);
|
|
static void NdisOpenConfiguration(ndis_status *,
|
|
ndis_handle *, ndis_handle);
|
|
static void NdisOpenConfigurationKeyByIndex(ndis_status *,
|
|
ndis_handle, uint32_t, unicode_string *, ndis_handle *);
|
|
static void NdisOpenConfigurationKeyByName(ndis_status *,
|
|
ndis_handle, 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 *);
|
|
static void NdisReadConfiguration(ndis_status *, ndis_config_parm **,
|
|
ndis_handle, unicode_string *, ndis_parm_type);
|
|
static void NdisWriteConfiguration(ndis_status *, ndis_handle,
|
|
unicode_string *, ndis_config_parm *);
|
|
static void NdisCloseConfiguration(ndis_handle);
|
|
static void NdisAllocateSpinLock(ndis_spin_lock *);
|
|
static void NdisFreeSpinLock(ndis_spin_lock *);
|
|
static void NdisAcquireSpinLock(ndis_spin_lock *);
|
|
static void NdisReleaseSpinLock(ndis_spin_lock *);
|
|
static void NdisDprAcquireSpinLock(ndis_spin_lock *);
|
|
static void NdisDprReleaseSpinLock(ndis_spin_lock *);
|
|
static void NdisInitializeReadWriteLock(ndis_rw_lock *);
|
|
static void NdisAcquireReadWriteLock(ndis_rw_lock *,
|
|
uint8_t, ndis_lock_state *);
|
|
static void NdisReleaseReadWriteLock(ndis_rw_lock *, ndis_lock_state *);
|
|
static uint32_t NdisReadPciSlotInformation(ndis_handle, uint32_t,
|
|
uint32_t, void *, uint32_t);
|
|
static uint32_t NdisWritePciSlotInformation(ndis_handle, uint32_t,
|
|
uint32_t, void *, uint32_t);
|
|
static void NdisWriteErrorLogEntry(ndis_handle, ndis_error_code, uint32_t, ...);
|
|
static void ndis_map_cb(void *, bus_dma_segment_t *, int, int);
|
|
static void NdisMStartBufferPhysicalMapping(ndis_handle,
|
|
ndis_buffer *, uint32_t, uint8_t, ndis_paddr_unit *, uint32_t *);
|
|
static void NdisMCompleteBufferPhysicalMapping(ndis_handle,
|
|
ndis_buffer *, uint32_t);
|
|
static void NdisMInitializeTimer(ndis_miniport_timer *, ndis_handle,
|
|
ndis_timer_function, void *);
|
|
static void NdisInitializeTimer(ndis_timer *,
|
|
ndis_timer_function, void *);
|
|
static void NdisSetTimer(ndis_timer *, uint32_t);
|
|
static void NdisMSetPeriodicTimer(ndis_miniport_timer *, uint32_t);
|
|
static void NdisMCancelTimer(ndis_timer *, uint8_t *);
|
|
static void ndis_timercall(kdpc *, ndis_miniport_timer *,
|
|
void *, void *);
|
|
static void NdisMQueryAdapterResources(ndis_status *, ndis_handle,
|
|
ndis_resource_list *, uint32_t *);
|
|
static ndis_status NdisMRegisterIoPortRange(void **,
|
|
ndis_handle, uint32_t, uint32_t);
|
|
static void NdisMDeregisterIoPortRange(ndis_handle,
|
|
uint32_t, uint32_t, void *);
|
|
static void NdisReadNetworkAddress(ndis_status *, void **,
|
|
uint32_t *, ndis_handle);
|
|
static ndis_status NdisQueryMapRegisterCount(uint32_t, uint32_t *);
|
|
static ndis_status NdisMAllocateMapRegisters(ndis_handle,
|
|
uint32_t, uint8_t, uint32_t, uint32_t);
|
|
static void NdisMFreeMapRegisters(ndis_handle);
|
|
static void ndis_mapshared_cb(void *, bus_dma_segment_t *, int, int);
|
|
static void NdisMAllocateSharedMemory(ndis_handle, uint32_t,
|
|
uint8_t, void **, ndis_physaddr *);
|
|
static void ndis_asyncmem_complete(device_object *, void *);
|
|
static ndis_status NdisMAllocateSharedMemoryAsync(ndis_handle,
|
|
uint32_t, uint8_t, void *);
|
|
static void NdisMFreeSharedMemory(ndis_handle, uint32_t,
|
|
uint8_t, void *, ndis_physaddr);
|
|
static ndis_status NdisMMapIoSpace(void **, ndis_handle,
|
|
ndis_physaddr, uint32_t);
|
|
static void NdisMUnmapIoSpace(ndis_handle, void *, uint32_t);
|
|
static uint32_t NdisGetCacheFillSize(void);
|
|
static void *NdisGetRoutineAddress(unicode_string *);
|
|
static uint32_t NdisMGetDmaAlignment(ndis_handle);
|
|
static ndis_status NdisMInitializeScatterGatherDma(ndis_handle,
|
|
uint8_t, uint32_t);
|
|
static void NdisUnchainBufferAtFront(ndis_packet *, ndis_buffer **);
|
|
static void NdisUnchainBufferAtBack(ndis_packet *, ndis_buffer **);
|
|
static void NdisAllocateBufferPool(ndis_status *,
|
|
ndis_handle *, uint32_t);
|
|
static void NdisFreeBufferPool(ndis_handle);
|
|
static void NdisAllocateBuffer(ndis_status *, ndis_buffer **,
|
|
ndis_handle, void *, uint32_t);
|
|
static void NdisFreeBuffer(ndis_buffer *);
|
|
static uint32_t NdisBufferLength(ndis_buffer *);
|
|
static void NdisQueryBuffer(ndis_buffer *, void **, uint32_t *);
|
|
static void NdisQueryBufferSafe(ndis_buffer *, void **,
|
|
uint32_t *, uint32_t);
|
|
static void *NdisBufferVirtualAddress(ndis_buffer *);
|
|
static void *NdisBufferVirtualAddressSafe(ndis_buffer *, uint32_t);
|
|
static void NdisAdjustBufferLength(ndis_buffer *, int);
|
|
static uint32_t NdisInterlockedIncrement(uint32_t *);
|
|
static uint32_t NdisInterlockedDecrement(uint32_t *);
|
|
static void NdisInitializeEvent(ndis_event *);
|
|
static void NdisSetEvent(ndis_event *);
|
|
static void NdisResetEvent(ndis_event *);
|
|
static uint8_t NdisWaitEvent(ndis_event *, uint32_t);
|
|
static ndis_status NdisUnicodeStringToAnsiString(ansi_string *,
|
|
unicode_string *);
|
|
static ndis_status
|
|
NdisAnsiStringToUnicodeString(unicode_string *, ansi_string *);
|
|
static ndis_status NdisMPciAssignResources(ndis_handle,
|
|
uint32_t, ndis_resource_list **);
|
|
static ndis_status NdisMRegisterInterrupt(ndis_miniport_interrupt *,
|
|
ndis_handle, uint32_t, uint32_t, uint8_t,
|
|
uint8_t, ndis_interrupt_mode);
|
|
static void NdisMDeregisterInterrupt(ndis_miniport_interrupt *);
|
|
static void NdisMRegisterAdapterShutdownHandler(ndis_handle, void *,
|
|
ndis_shutdown_handler);
|
|
static void NdisMDeregisterAdapterShutdownHandler(ndis_handle);
|
|
static uint32_t NDIS_BUFFER_TO_SPAN_PAGES(ndis_buffer *);
|
|
static void NdisGetBufferPhysicalArraySize(ndis_buffer *,
|
|
uint32_t *);
|
|
static void NdisQueryBufferOffset(ndis_buffer *,
|
|
uint32_t *, uint32_t *);
|
|
static uint32_t NdisReadPcmciaAttributeMemory(ndis_handle,
|
|
uint32_t, void *, uint32_t);
|
|
static uint32_t NdisWritePcmciaAttributeMemory(ndis_handle,
|
|
uint32_t, void *, uint32_t);
|
|
static list_entry *NdisInterlockedInsertHeadList(list_entry *,
|
|
list_entry *, ndis_spin_lock *);
|
|
static list_entry *NdisInterlockedRemoveHeadList(list_entry *,
|
|
ndis_spin_lock *);
|
|
static list_entry *NdisInterlockedInsertTailList(list_entry *,
|
|
list_entry *, ndis_spin_lock *);
|
|
static uint8_t
|
|
NdisMSynchronizeWithInterrupt(ndis_miniport_interrupt *,
|
|
void *, void *);
|
|
static void NdisGetCurrentSystemTime(uint64_t *);
|
|
static void NdisGetSystemUpTime(uint32_t *);
|
|
static uint32_t NdisGetVersion(void);
|
|
static void NdisInitializeString(unicode_string *, char *);
|
|
static void NdisInitAnsiString(ansi_string *, char *);
|
|
static void NdisInitUnicodeString(unicode_string *, uint16_t *);
|
|
static void NdisFreeString(unicode_string *);
|
|
static ndis_status NdisMRemoveMiniport(ndis_handle *);
|
|
static void NdisTerminateWrapper(ndis_handle, void *);
|
|
static void NdisMGetDeviceProperty(ndis_handle, device_object **,
|
|
device_object **, device_object **, cm_resource_list *,
|
|
cm_resource_list *);
|
|
static void NdisGetFirstBufferFromPacket(ndis_packet *,
|
|
ndis_buffer **, void **, uint32_t *, uint32_t *);
|
|
static void NdisGetFirstBufferFromPacketSafe(ndis_packet *,
|
|
ndis_buffer **, void **, uint32_t *, uint32_t *, uint32_t);
|
|
static int ndis_find_sym(linker_file_t, char *, char *, caddr_t *);
|
|
static void NdisOpenFile(ndis_status *, ndis_handle *, uint32_t *,
|
|
unicode_string *, ndis_physaddr);
|
|
static void NdisMapFile(ndis_status *, void **, ndis_handle);
|
|
static void NdisUnmapFile(ndis_handle);
|
|
static void NdisCloseFile(ndis_handle);
|
|
static uint8_t NdisSystemProcessorCount(void);
|
|
static void NdisGetCurrentProcessorCounts(uint32_t *, uint32_t *, uint32_t *);
|
|
static void NdisMIndicateStatusComplete(ndis_handle);
|
|
static void NdisMIndicateStatus(ndis_handle, ndis_status,
|
|
void *, uint32_t);
|
|
static uint8_t ndis_intr(kinterrupt *, void *);
|
|
static void ndis_intrhand(kdpc *, ndis_miniport_interrupt *, void *, void *);
|
|
static funcptr ndis_findwrap(funcptr);
|
|
static void NdisCopyFromPacketToPacket(ndis_packet *,
|
|
uint32_t, uint32_t, ndis_packet *, uint32_t, uint32_t *);
|
|
static void NdisCopyFromPacketToPacketSafe(ndis_packet *,
|
|
uint32_t, uint32_t, ndis_packet *, uint32_t, uint32_t *, uint32_t);
|
|
static void NdisIMCopySendPerPacketInfo(ndis_packet *, ndis_packet *);
|
|
static ndis_status NdisMRegisterDevice(ndis_handle,
|
|
unicode_string *, unicode_string *, driver_dispatch **,
|
|
void **, ndis_handle *);
|
|
static ndis_status NdisMDeregisterDevice(ndis_handle);
|
|
static ndis_status
|
|
NdisMQueryAdapterInstanceName(unicode_string *, ndis_handle);
|
|
static void NdisMRegisterUnloadHandler(ndis_handle, void *);
|
|
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()
|
|
{
|
|
image_patch_table *patch;
|
|
|
|
strcpy(ndis_filepath, "/compat/ndis");
|
|
|
|
patch = ndis_functbl;
|
|
while (patch->ipt_func != NULL) {
|
|
windrv_wrap((funcptr)patch->ipt_func,
|
|
(funcptr *)&patch->ipt_wrap,
|
|
patch->ipt_argcnt, patch->ipt_ftype);
|
|
patch++;
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
int
|
|
ndis_libfini()
|
|
{
|
|
image_patch_table *patch;
|
|
|
|
patch = ndis_functbl;
|
|
while (patch->ipt_func != NULL) {
|
|
windrv_unwrap(patch->ipt_wrap);
|
|
patch++;
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static funcptr
|
|
ndis_findwrap(func)
|
|
funcptr func;
|
|
{
|
|
image_patch_table *patch;
|
|
|
|
patch = ndis_functbl;
|
|
while (patch->ipt_func != NULL) {
|
|
if ((funcptr)patch->ipt_func == func)
|
|
return ((funcptr)patch->ipt_wrap);
|
|
patch++;
|
|
}
|
|
|
|
return (NULL);
|
|
}
|
|
|
|
/*
|
|
* This routine does the messy Windows Driver Model device attachment
|
|
* stuff on behalf of NDIS drivers. We register our own AddDevice
|
|
* routine here
|
|
*/
|
|
static void
|
|
NdisInitializeWrapper(wrapper, drv, path, unused)
|
|
ndis_handle *wrapper;
|
|
driver_object *drv;
|
|
void *path;
|
|
void *unused;
|
|
{
|
|
/*
|
|
* As of yet, I haven't come up with a compelling
|
|
* reason to define a private NDIS wrapper structure,
|
|
* so we use a pointer to the driver object as the
|
|
* wrapper handle. The driver object has the miniport
|
|
* characteristics struct for this driver hung off it
|
|
* via IoAllocateDriverObjectExtension(), and that's
|
|
* really all the private data we need.
|
|
*/
|
|
|
|
*wrapper = drv;
|
|
|
|
/*
|
|
* If this was really Windows, we'd be registering dispatch
|
|
* routines for the NDIS miniport module here, but we're
|
|
* not Windows so all we really need to do is set up an
|
|
* AddDevice function that'll be invoked when a new device
|
|
* instance appears.
|
|
*/
|
|
|
|
drv->dro_driverext->dre_adddevicefunc = NdisAddDevice;
|
|
}
|
|
|
|
static void
|
|
NdisTerminateWrapper(handle, syspec)
|
|
ndis_handle handle;
|
|
void *syspec;
|
|
{
|
|
/* Nothing to see here, move along. */
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMRegisterMiniport(handle, characteristics, len)
|
|
ndis_handle handle;
|
|
ndis_miniport_characteristics *characteristics;
|
|
int len;
|
|
{
|
|
ndis_miniport_characteristics *ch = NULL;
|
|
driver_object *drv;
|
|
|
|
drv = (driver_object *)handle;
|
|
|
|
/*
|
|
* We need to save the NDIS miniport characteristics
|
|
* somewhere. This data is per-driver, not per-device
|
|
* (all devices handled by the same driver have the
|
|
* same characteristics) so we hook it onto the driver
|
|
* object using IoAllocateDriverObjectExtension().
|
|
* The extra extension info is automagically deleted when
|
|
* the driver is unloaded (see windrv_unload()).
|
|
*/
|
|
|
|
if (IoAllocateDriverObjectExtension(drv, (void *)1,
|
|
sizeof(ndis_miniport_characteristics), (void **)&ch) !=
|
|
STATUS_SUCCESS) {
|
|
return (NDIS_STATUS_RESOURCES);
|
|
}
|
|
|
|
bzero((char *)ch, sizeof(ndis_miniport_characteristics));
|
|
|
|
bcopy((char *)characteristics, (char *)ch, len);
|
|
|
|
if (ch->nmc_version_major < 5 || ch->nmc_version_minor < 1) {
|
|
ch->nmc_shutdown_handler = NULL;
|
|
ch->nmc_canceltxpkts_handler = NULL;
|
|
ch->nmc_pnpevent_handler = NULL;
|
|
}
|
|
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisAllocateMemoryWithTag(vaddr, len, tag)
|
|
void **vaddr;
|
|
uint32_t len;
|
|
uint32_t tag;
|
|
{
|
|
void *mem;
|
|
|
|
mem = ExAllocatePoolWithTag(NonPagedPool, len, tag);
|
|
if (mem == NULL) {
|
|
return (NDIS_STATUS_RESOURCES);
|
|
}
|
|
*vaddr = mem;
|
|
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisAllocateMemory(vaddr, len, flags, highaddr)
|
|
void **vaddr;
|
|
uint32_t len;
|
|
uint32_t flags;
|
|
ndis_physaddr highaddr;
|
|
{
|
|
void *mem;
|
|
|
|
mem = ExAllocatePoolWithTag(NonPagedPool, len, 0);
|
|
if (mem == NULL)
|
|
return (NDIS_STATUS_RESOURCES);
|
|
*vaddr = mem;
|
|
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static void
|
|
NdisFreeMemory(vaddr, len, flags)
|
|
void *vaddr;
|
|
uint32_t len;
|
|
uint32_t flags;
|
|
{
|
|
if (len == 0)
|
|
return;
|
|
|
|
ExFreePool(vaddr);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMSetAttributesEx(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);
|
|
}
|
|
|
|
static void
|
|
NdisOpenConfiguration(status, cfg, wrapctx)
|
|
ndis_status *status;
|
|
ndis_handle *cfg;
|
|
ndis_handle wrapctx;
|
|
{
|
|
*cfg = wrapctx;
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
static void
|
|
NdisOpenConfigurationKeyByName(status, cfg, subkey, subhandle)
|
|
ndis_status *status;
|
|
ndis_handle cfg;
|
|
unicode_string *subkey;
|
|
ndis_handle *subhandle;
|
|
{
|
|
*subhandle = cfg;
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
static void
|
|
NdisOpenConfigurationKeyByIndex(status, cfg, idx, subkey, subhandle)
|
|
ndis_status *status;
|
|
ndis_handle cfg;
|
|
uint32_t idx;
|
|
unicode_string *subkey;
|
|
ndis_handle *subhandle;
|
|
{
|
|
*status = NDIS_STATUS_FAILURE;
|
|
}
|
|
|
|
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;
|
|
{
|
|
ndis_config_parm *p;
|
|
ndis_parmlist_entry *np;
|
|
unicode_string *us;
|
|
ansi_string as;
|
|
int base = 0;
|
|
uint32_t val;
|
|
char tmp[32];
|
|
|
|
np = ExAllocatePoolWithTag(NonPagedPool,
|
|
sizeof(ndis_parmlist_entry), 0);
|
|
if (np == NULL)
|
|
return (NDIS_STATUS_RESOURCES);
|
|
InsertHeadList((&block->nmb_parmlist), (&np->np_list));
|
|
*parm = p = &np->np_parm;
|
|
|
|
switch(type) {
|
|
case ndis_parm_string:
|
|
/* See if this might be a number. */
|
|
val = strtoul((char *)oid->oid_arg1, NULL, 10);
|
|
us = &p->ncp_parmdata.ncp_stringdata;
|
|
p->ncp_type = ndis_parm_string;
|
|
if (val) {
|
|
snprintf(tmp, 32, "%x", val);
|
|
RtlInitAnsiString(&as, tmp);
|
|
} else {
|
|
RtlInitAnsiString(&as, (char *)oid->oid_arg1);
|
|
}
|
|
|
|
if (RtlAnsiStringToUnicodeString(us, &as, TRUE)) {
|
|
ExFreePool(np);
|
|
return (NDIS_STATUS_RESOURCES);
|
|
}
|
|
break;
|
|
case ndis_parm_int:
|
|
if (strncmp((char *)oid->oid_arg1, "0x", 2) == 0)
|
|
base = 16;
|
|
else
|
|
base = 10;
|
|
p->ncp_type = ndis_parm_int;
|
|
p->ncp_parmdata.ncp_intdata =
|
|
strtol((char *)oid->oid_arg1, NULL, base);
|
|
break;
|
|
case ndis_parm_hexint:
|
|
#ifdef notdef
|
|
if (strncmp((char *)oid->oid_arg1, "0x", 2) == 0)
|
|
base = 16;
|
|
else
|
|
base = 10;
|
|
#endif
|
|
base = 16;
|
|
p->ncp_type = ndis_parm_hexint;
|
|
p->ncp_parmdata.ncp_intdata =
|
|
strtoul((char *)oid->oid_arg1, NULL, base);
|
|
break;
|
|
default:
|
|
return (NDIS_STATUS_FAILURE);
|
|
break;
|
|
}
|
|
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static void
|
|
NdisReadConfiguration(status, parm, cfg, key, type)
|
|
ndis_status *status;
|
|
ndis_config_parm **parm;
|
|
ndis_handle cfg;
|
|
unicode_string *key;
|
|
ndis_parm_type type;
|
|
{
|
|
char *keystr = NULL;
|
|
ndis_miniport_block *block;
|
|
struct ndis_softc *sc;
|
|
struct sysctl_oid *oidp;
|
|
struct sysctl_ctx_entry *e;
|
|
ansi_string as;
|
|
|
|
block = (ndis_miniport_block *)cfg;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
/*
|
|
device_printf(sc->ndis_dev, "NdisReadConfiguration sc=%p\n", sc);
|
|
*/
|
|
|
|
if (key->us_len == 0 || key->us_buf == NULL) {
|
|
*status = NDIS_STATUS_FAILURE;
|
|
return;
|
|
}
|
|
|
|
if (RtlUnicodeStringToAnsiString(&as, key, TRUE)) {
|
|
*status = NDIS_STATUS_RESOURCES;
|
|
return;
|
|
}
|
|
|
|
keystr = as.as_buf;
|
|
|
|
/*
|
|
* See if registry key is already in a list of known keys
|
|
* included with the driver.
|
|
*/
|
|
TAILQ_FOREACH(e, device_get_sysctl_ctx(sc->ndis_dev), link) {
|
|
oidp = e->entry;
|
|
if (strcasecmp(oidp->oid_name, keystr) == 0) {
|
|
if (strcmp((char *)oidp->oid_arg1, "UNSET") == 0) {
|
|
RtlFreeAnsiString(&as);
|
|
*status = NDIS_STATUS_FAILURE;
|
|
return;
|
|
}
|
|
|
|
*status = ndis_encode_parm(block, oidp, type, parm);
|
|
RtlFreeAnsiString(&as);
|
|
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);
|
|
|
|
RtlFreeAnsiString(&as);
|
|
*status = NDIS_STATUS_FAILURE;
|
|
}
|
|
|
|
static ndis_status
|
|
ndis_decode_parm(block, parm, val)
|
|
ndis_miniport_block *block;
|
|
ndis_config_parm *parm;
|
|
char *val;
|
|
{
|
|
unicode_string *ustr;
|
|
ansi_string as;
|
|
|
|
switch(parm->ncp_type) {
|
|
case ndis_parm_string:
|
|
ustr = &parm->ncp_parmdata.ncp_stringdata;
|
|
if (RtlUnicodeStringToAnsiString(&as, ustr, TRUE))
|
|
return (NDIS_STATUS_RESOURCES);
|
|
bcopy(as.as_buf, val, as.as_len);
|
|
RtlFreeAnsiString(&as);
|
|
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);
|
|
}
|
|
|
|
static void
|
|
NdisWriteConfiguration(status, cfg, key, parm)
|
|
ndis_status *status;
|
|
ndis_handle cfg;
|
|
unicode_string *key;
|
|
ndis_config_parm *parm;
|
|
{
|
|
ansi_string as;
|
|
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 = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
if (RtlUnicodeStringToAnsiString(&as, key, TRUE)) {
|
|
*status = NDIS_STATUS_RESOURCES;
|
|
return;
|
|
}
|
|
|
|
keystr = as.as_buf;
|
|
|
|
/* Decode the parameter into a string. */
|
|
bzero(val, sizeof(val));
|
|
*status = ndis_decode_parm(block, parm, val);
|
|
if (*status != NDIS_STATUS_SUCCESS) {
|
|
RtlFreeAnsiString(&as);
|
|
return;
|
|
}
|
|
|
|
/* See if the key already exists. */
|
|
|
|
TAILQ_FOREACH(e, device_get_sysctl_ctx(sc->ndis_dev), link) {
|
|
oidp = e->entry;
|
|
if (strcasecmp(oidp->oid_name, keystr) == 0) {
|
|
/* Found it, set the value. */
|
|
strcpy((char *)oidp->oid_arg1, val);
|
|
RtlFreeAnsiString(&as);
|
|
return;
|
|
}
|
|
}
|
|
|
|
/* Not found, add a new key with the specified value. */
|
|
ndis_add_sysctl(sc, keystr, "(dynamically set key)",
|
|
val, CTLFLAG_RW);
|
|
|
|
RtlFreeAnsiString(&as);
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
static void
|
|
NdisCloseConfiguration(cfg)
|
|
ndis_handle cfg;
|
|
{
|
|
list_entry *e;
|
|
ndis_parmlist_entry *pe;
|
|
ndis_miniport_block *block;
|
|
ndis_config_parm *p;
|
|
|
|
block = (ndis_miniport_block *)cfg;
|
|
|
|
while (!IsListEmpty(&block->nmb_parmlist)) {
|
|
e = RemoveHeadList(&block->nmb_parmlist);
|
|
pe = CONTAINING_RECORD(e, ndis_parmlist_entry, np_list);
|
|
p = &pe->np_parm;
|
|
if (p->ncp_type == ndis_parm_string)
|
|
RtlFreeUnicodeString(&p->ncp_parmdata.ncp_stringdata);
|
|
ExFreePool(e);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Initialize a Windows spinlock.
|
|
*/
|
|
static void
|
|
NdisAllocateSpinLock(lock)
|
|
ndis_spin_lock *lock;
|
|
{
|
|
KeInitializeSpinLock(&lock->nsl_spinlock);
|
|
lock->nsl_kirql = 0;
|
|
}
|
|
|
|
/*
|
|
* Destroy a Windows spinlock. This is a no-op for now. There are two reasons
|
|
* for this. One is that it's sort of superfluous: we don't have to do anything
|
|
* special to deallocate the spinlock. The other is that there are some buggy
|
|
* drivers which call NdisFreeSpinLock() _after_ calling NdisFreeMemory() on
|
|
* the block of memory in which the spinlock resides. (Yes, ADMtek, I'm
|
|
* talking to you.)
|
|
*/
|
|
static void
|
|
NdisFreeSpinLock(lock)
|
|
ndis_spin_lock *lock;
|
|
{
|
|
#ifdef notdef
|
|
KeInitializeSpinLock(&lock->nsl_spinlock);
|
|
lock->nsl_kirql = 0;
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* Acquire a spinlock from IRQL <= DISPATCH_LEVEL.
|
|
*/
|
|
|
|
static void
|
|
NdisAcquireSpinLock(lock)
|
|
ndis_spin_lock *lock;
|
|
{
|
|
KeAcquireSpinLock(&lock->nsl_spinlock, &lock->nsl_kirql);
|
|
}
|
|
|
|
/*
|
|
* Release a spinlock from IRQL == DISPATCH_LEVEL.
|
|
*/
|
|
|
|
static void
|
|
NdisReleaseSpinLock(lock)
|
|
ndis_spin_lock *lock;
|
|
{
|
|
KeReleaseSpinLock(&lock->nsl_spinlock, lock->nsl_kirql);
|
|
}
|
|
|
|
/*
|
|
* Acquire a spinlock when already running at IRQL == DISPATCH_LEVEL.
|
|
*/
|
|
static void
|
|
NdisDprAcquireSpinLock(lock)
|
|
ndis_spin_lock *lock;
|
|
{
|
|
KeAcquireSpinLockAtDpcLevel(&lock->nsl_spinlock);
|
|
}
|
|
|
|
/*
|
|
* Release a spinlock without leaving IRQL == DISPATCH_LEVEL.
|
|
*/
|
|
static void
|
|
NdisDprReleaseSpinLock(lock)
|
|
ndis_spin_lock *lock;
|
|
{
|
|
KeReleaseSpinLockFromDpcLevel(&lock->nsl_spinlock);
|
|
}
|
|
|
|
static void
|
|
NdisInitializeReadWriteLock(lock)
|
|
ndis_rw_lock *lock;
|
|
{
|
|
KeInitializeSpinLock(&lock->nrl_spinlock);
|
|
bzero((char *)&lock->nrl_rsvd, sizeof(lock->nrl_rsvd));
|
|
}
|
|
|
|
static void
|
|
NdisAcquireReadWriteLock(ndis_rw_lock *lock, uint8_t writeacc,
|
|
ndis_lock_state *state)
|
|
{
|
|
if (writeacc == TRUE) {
|
|
KeAcquireSpinLock(&lock->nrl_spinlock, &state->nls_oldirql);
|
|
lock->nrl_rsvd[0]++;
|
|
} else
|
|
lock->nrl_rsvd[1]++;
|
|
}
|
|
|
|
static void
|
|
NdisReleaseReadWriteLock(lock, state)
|
|
ndis_rw_lock *lock;
|
|
ndis_lock_state *state;
|
|
{
|
|
if (lock->nrl_rsvd[0]) {
|
|
lock->nrl_rsvd[0]--;
|
|
KeReleaseSpinLock(&lock->nrl_spinlock, state->nls_oldirql);
|
|
} else
|
|
lock->nrl_rsvd[1]--;
|
|
}
|
|
|
|
static uint32_t
|
|
NdisReadPciSlotInformation(adapter, slot, offset, buf, len)
|
|
ndis_handle adapter;
|
|
uint32_t slot;
|
|
uint32_t offset;
|
|
void *buf;
|
|
uint32_t len;
|
|
{
|
|
ndis_miniport_block *block;
|
|
uint32_t i;
|
|
char *dest;
|
|
device_t dev;
|
|
|
|
block = (ndis_miniport_block *)adapter;
|
|
dest = buf;
|
|
if (block == NULL)
|
|
return (0);
|
|
|
|
dev = block->nmb_physdeviceobj->do_devext;
|
|
|
|
/*
|
|
* I have a test system consisting of a Sun w2100z
|
|
* dual 2.4Ghz Opteron machine and an Atheros 802.11a/b/g
|
|
* "Aries" miniPCI NIC. (The NIC is installed in the
|
|
* machine using a miniPCI to PCI bus adapter card.)
|
|
* When running in SMP mode, I found that
|
|
* performing a large number of consecutive calls to
|
|
* NdisReadPciSlotInformation() would result in a
|
|
* sudden system reset (or in some cases a freeze).
|
|
* My suspicion is that the multiple reads are somehow
|
|
* triggering a fatal PCI bus error that leads to a
|
|
* machine check. The 1us delay in the loop below
|
|
* seems to prevent this problem.
|
|
*/
|
|
|
|
for (i = 0; i < len; i++) {
|
|
DELAY(1);
|
|
dest[i] = pci_read_config(dev, i + offset, 1);
|
|
}
|
|
|
|
return (len);
|
|
}
|
|
|
|
static uint32_t
|
|
NdisWritePciSlotInformation(adapter, slot, offset, buf, len)
|
|
ndis_handle adapter;
|
|
uint32_t slot;
|
|
uint32_t offset;
|
|
void *buf;
|
|
uint32_t len;
|
|
{
|
|
ndis_miniport_block *block;
|
|
uint32_t i;
|
|
char *dest;
|
|
device_t dev;
|
|
|
|
block = (ndis_miniport_block *)adapter;
|
|
dest = buf;
|
|
|
|
if (block == NULL)
|
|
return (0);
|
|
|
|
dev = block->nmb_physdeviceobj->do_devext;
|
|
for (i = 0; i < len; i++) {
|
|
DELAY(1);
|
|
pci_write_config(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
|
|
NdisWriteErrorLogEntry(ndis_handle adapter, ndis_error_code code,
|
|
uint32_t numerrors, ...)
|
|
{
|
|
ndis_miniport_block *block;
|
|
va_list ap;
|
|
int i, error;
|
|
char *str = NULL;
|
|
uint16_t flags;
|
|
device_t dev;
|
|
driver_object *drv;
|
|
struct ndis_softc *sc;
|
|
struct ifnet *ifp;
|
|
unicode_string us;
|
|
ansi_string as = { 0, 0, NULL };
|
|
|
|
block = (ndis_miniport_block *)adapter;
|
|
dev = block->nmb_physdeviceobj->do_devext;
|
|
drv = block->nmb_deviceobj->do_drvobj;
|
|
sc = device_get_softc(dev);
|
|
ifp = NDISUSB_GET_IFNET(sc);
|
|
|
|
if (ifp != NULL && ifp->if_flags & IFF_DEBUG) {
|
|
error = pe_get_message((vm_offset_t)drv->dro_driverstart,
|
|
code, &str, &i, &flags);
|
|
if (error == 0) {
|
|
if (flags & MESSAGE_RESOURCE_UNICODE) {
|
|
RtlInitUnicodeString(&us, (uint16_t *)str);
|
|
if (RtlUnicodeStringToAnsiString(&as,
|
|
&us, TRUE) == STATUS_SUCCESS)
|
|
str = as.as_buf;
|
|
else
|
|
str = NULL;
|
|
}
|
|
}
|
|
}
|
|
|
|
device_printf(dev, "NDIS ERROR: %x (%s)\n", code,
|
|
str == NULL ? "unknown error" : str);
|
|
|
|
if (ifp != NULL && ifp->if_flags & IFF_DEBUG) {
|
|
device_printf(dev, "NDIS NUMERRORS: %x\n", numerrors);
|
|
va_start(ap, numerrors);
|
|
for (i = 0; i < numerrors; i++)
|
|
device_printf(dev, "argptr: %p\n",
|
|
va_arg(ap, void *));
|
|
va_end(ap);
|
|
}
|
|
|
|
if (as.as_len)
|
|
RtlFreeAnsiString(&as);
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
static void
|
|
NdisMStartBufferPhysicalMapping(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 = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
if (mapreg > sc->ndis_mmapcnt)
|
|
return;
|
|
|
|
map = sc->ndis_mmaps[mapreg];
|
|
nma.nma_fraglist = addrarray;
|
|
|
|
error = bus_dmamap_load(sc->ndis_mtag, map,
|
|
MmGetMdlVirtualAddress(buf), MmGetMdlByteCount(buf), 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;
|
|
}
|
|
|
|
static void
|
|
NdisMCompleteBufferPhysicalMapping(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 = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
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);
|
|
}
|
|
|
|
/*
|
|
* This is an older (?) timer init routine which doesn't
|
|
* accept a miniport context handle. Serialized miniports should
|
|
* never call this function.
|
|
*/
|
|
|
|
static void
|
|
NdisInitializeTimer(timer, func, ctx)
|
|
ndis_timer *timer;
|
|
ndis_timer_function func;
|
|
void *ctx;
|
|
{
|
|
KeInitializeTimer(&timer->nt_ktimer);
|
|
KeInitializeDpc(&timer->nt_kdpc, func, ctx);
|
|
KeSetImportanceDpc(&timer->nt_kdpc, KDPC_IMPORTANCE_LOW);
|
|
}
|
|
|
|
static void
|
|
ndis_timercall(dpc, timer, sysarg1, sysarg2)
|
|
kdpc *dpc;
|
|
ndis_miniport_timer *timer;
|
|
void *sysarg1;
|
|
void *sysarg2;
|
|
{
|
|
/*
|
|
* Since we're called as a DPC, we should be running
|
|
* at DISPATCH_LEVEL here. This means to acquire the
|
|
* spinlock, we can use KeAcquireSpinLockAtDpcLevel()
|
|
* rather than KeAcquireSpinLock().
|
|
*/
|
|
if (NDIS_SERIALIZED(timer->nmt_block))
|
|
KeAcquireSpinLockAtDpcLevel(&timer->nmt_block->nmb_lock);
|
|
|
|
MSCALL4(timer->nmt_timerfunc, dpc, timer->nmt_timerctx,
|
|
sysarg1, sysarg2);
|
|
|
|
if (NDIS_SERIALIZED(timer->nmt_block))
|
|
KeReleaseSpinLockFromDpcLevel(&timer->nmt_block->nmb_lock);
|
|
}
|
|
|
|
/*
|
|
* For a long time I wondered why there were two NDIS timer initialization
|
|
* routines, and why this one needed an NDIS_MINIPORT_TIMER and the
|
|
* MiniportAdapterHandle. The NDIS_MINIPORT_TIMER has its own callout
|
|
* function and context pointers separate from those in the DPC, which
|
|
* allows for another level of indirection: when the timer fires, we
|
|
* can have our own timer function invoked, and from there we can call
|
|
* the driver's function. But why go to all that trouble? Then it hit
|
|
* me: for serialized miniports, the timer callouts are not re-entrant.
|
|
* By trapping the callouts and having access to the MiniportAdapterHandle,
|
|
* we can protect the driver callouts by acquiring the NDIS serialization
|
|
* lock. This is essential for allowing serialized miniports to work
|
|
* correctly on SMP systems. On UP hosts, setting IRQL to DISPATCH_LEVEL
|
|
* is enough to prevent other threads from pre-empting you, but with
|
|
* SMP, you must acquire a lock as well, otherwise the other CPU is
|
|
* free to clobber you.
|
|
*/
|
|
static void
|
|
NdisMInitializeTimer(timer, handle, func, ctx)
|
|
ndis_miniport_timer *timer;
|
|
ndis_handle handle;
|
|
ndis_timer_function func;
|
|
void *ctx;
|
|
{
|
|
ndis_miniport_block *block;
|
|
struct ndis_softc *sc;
|
|
|
|
block = (ndis_miniport_block *)handle;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
/* Save the driver's funcptr and context */
|
|
|
|
timer->nmt_timerfunc = func;
|
|
timer->nmt_timerctx = ctx;
|
|
timer->nmt_block = handle;
|
|
|
|
/*
|
|
* Set up the timer so it will call our intermediate DPC.
|
|
* Be sure to use the wrapped entry point, since
|
|
* ntoskrnl_run_dpc() expects to invoke a function with
|
|
* Microsoft calling conventions.
|
|
*/
|
|
KeInitializeTimer(&timer->nmt_ktimer);
|
|
KeInitializeDpc(&timer->nmt_kdpc,
|
|
ndis_findwrap((funcptr)ndis_timercall), timer);
|
|
timer->nmt_ktimer.k_dpc = &timer->nmt_kdpc;
|
|
}
|
|
|
|
/*
|
|
* In Windows, there's both an NdisMSetTimer() and an NdisSetTimer(),
|
|
* but the former is just a macro wrapper around the latter.
|
|
*/
|
|
static void
|
|
NdisSetTimer(timer, msecs)
|
|
ndis_timer *timer;
|
|
uint32_t msecs;
|
|
{
|
|
/*
|
|
* KeSetTimer() wants the period in
|
|
* hundred nanosecond intervals.
|
|
*/
|
|
KeSetTimer(&timer->nt_ktimer,
|
|
((int64_t)msecs * -10000), &timer->nt_kdpc);
|
|
}
|
|
|
|
static void
|
|
NdisMSetPeriodicTimer(timer, msecs)
|
|
ndis_miniport_timer *timer;
|
|
uint32_t msecs;
|
|
{
|
|
KeSetTimerEx(&timer->nmt_ktimer,
|
|
((int64_t)msecs * -10000), msecs, &timer->nmt_kdpc);
|
|
}
|
|
|
|
/*
|
|
* Technically, this is really NdisCancelTimer(), but we also
|
|
* (ab)use it for NdisMCancelTimer(), since in our implementation
|
|
* we don't need the extra info in the ndis_miniport_timer
|
|
* structure just to cancel a timer.
|
|
*/
|
|
|
|
static void
|
|
NdisMCancelTimer(timer, cancelled)
|
|
ndis_timer *timer;
|
|
uint8_t *cancelled;
|
|
{
|
|
|
|
*cancelled = KeCancelTimer(&timer->nt_ktimer);
|
|
}
|
|
|
|
static void
|
|
NdisMQueryAdapterResources(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 = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
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, rsclen);
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMRegisterIoPortRange(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 = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
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 *)(uintptr_t)rman_get_start(sc->ndis_res_io);
|
|
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static void
|
|
NdisMDeregisterIoPortRange(adapter, port, numports, offset)
|
|
ndis_handle adapter;
|
|
uint32_t port;
|
|
uint32_t numports;
|
|
void *offset;
|
|
{
|
|
}
|
|
|
|
static void
|
|
NdisReadNetworkAddress(status, addr, addrlen, adapter)
|
|
ndis_status *status;
|
|
void **addr;
|
|
uint32_t *addrlen;
|
|
ndis_handle adapter;
|
|
{
|
|
struct ndis_softc *sc;
|
|
struct ifnet *ifp;
|
|
ndis_miniport_block *block;
|
|
uint8_t empty[] = { 0, 0, 0, 0, 0, 0 };
|
|
|
|
block = (ndis_miniport_block *)adapter;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
ifp = NDISUSB_GET_IFNET(sc);
|
|
if (ifp == NULL) {
|
|
*status = NDIS_STATUS_FAILURE;
|
|
return;
|
|
}
|
|
|
|
if (ifp->if_addr == NULL ||
|
|
bcmp(IF_LLADDR(sc->ifp), empty, ETHER_ADDR_LEN) == 0)
|
|
*status = NDIS_STATUS_FAILURE;
|
|
else {
|
|
*addr = IF_LLADDR(sc->ifp);
|
|
*addrlen = ETHER_ADDR_LEN;
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
}
|
|
}
|
|
|
|
static ndis_status
|
|
NdisQueryMapRegisterCount(bustype, cnt)
|
|
uint32_t bustype;
|
|
uint32_t *cnt;
|
|
{
|
|
*cnt = 8192;
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMAllocateMapRegisters(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 = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
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);
|
|
}
|
|
|
|
static void
|
|
NdisMFreeMapRegisters(adapter)
|
|
ndis_handle adapter;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_miniport_block *block;
|
|
int i;
|
|
|
|
block = (ndis_miniport_block *)adapter;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
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);
|
|
}
|
|
|
|
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;
|
|
}
|
|
|
|
/*
|
|
* This maps to bus_dmamem_alloc().
|
|
*/
|
|
|
|
static void
|
|
NdisMAllocateSharedMemory(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 = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
sh = malloc(sizeof(struct ndis_shmem), M_DEVBUF, M_NOWAIT|M_ZERO);
|
|
if (sh == NULL)
|
|
return;
|
|
|
|
InitializeListHead(&sh->ndis_list);
|
|
|
|
/*
|
|
* When performing shared memory allocations, create a tag
|
|
* with a lowaddr limit that restricts physical memory mappings
|
|
* so that they all fall within the first 1GB of memory.
|
|
* At least one device/driver combination (Linksys Instant
|
|
* Wireless PCI Card V2.7, Broadcom 802.11b) seems to have
|
|
* problems with performing DMA operations with physical
|
|
* addresses that lie above the 1GB mark. I don't know if this
|
|
* is a hardware limitation or if the addresses are being
|
|
* truncated within the driver, but this seems to be the only
|
|
* way to make these cards work reliably in systems with more
|
|
* than 1GB of physical memory.
|
|
*/
|
|
|
|
error = bus_dma_tag_create(sc->ndis_parent_tag, 64,
|
|
0, NDIS_BUS_SPACE_SHARED_MAXADDR, 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;
|
|
}
|
|
|
|
/*
|
|
* Save the physical address along with the source address.
|
|
* The AirGo MIMO driver will call NdisMFreeSharedMemory()
|
|
* with a bogus virtual address sometimes, but with a valid
|
|
* physical address. To keep this from causing trouble, we
|
|
* use the physical address to as a sanity check in case
|
|
* searching based on the virtual address fails.
|
|
*/
|
|
|
|
NDIS_LOCK(sc);
|
|
sh->ndis_paddr.np_quad = paddr->np_quad;
|
|
sh->ndis_saddr = *vaddr;
|
|
InsertHeadList((&sc->ndis_shlist), (&sh->ndis_list));
|
|
NDIS_UNLOCK(sc);
|
|
}
|
|
|
|
struct ndis_allocwork {
|
|
uint32_t na_len;
|
|
uint8_t na_cached;
|
|
void *na_ctx;
|
|
io_workitem *na_iw;
|
|
};
|
|
|
|
static void
|
|
ndis_asyncmem_complete(dobj, arg)
|
|
device_object *dobj;
|
|
void *arg;
|
|
{
|
|
ndis_miniport_block *block;
|
|
struct ndis_softc *sc;
|
|
struct ndis_allocwork *w;
|
|
void *vaddr;
|
|
ndis_physaddr paddr;
|
|
ndis_allocdone_handler donefunc;
|
|
|
|
w = arg;
|
|
block = (ndis_miniport_block *)dobj->do_devext;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
vaddr = NULL;
|
|
paddr.np_quad = 0;
|
|
|
|
donefunc = sc->ndis_chars->nmc_allocate_complete_func;
|
|
NdisMAllocateSharedMemory(block, w->na_len,
|
|
w->na_cached, &vaddr, &paddr);
|
|
MSCALL5(donefunc, block, vaddr, &paddr, w->na_len, w->na_ctx);
|
|
|
|
IoFreeWorkItem(w->na_iw);
|
|
free(w, M_DEVBUF);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMAllocateSharedMemoryAsync(ndis_handle adapter, uint32_t len,
|
|
uint8_t cached, void *ctx)
|
|
{
|
|
ndis_miniport_block *block;
|
|
struct ndis_allocwork *w;
|
|
io_workitem *iw;
|
|
io_workitem_func ifw;
|
|
|
|
if (adapter == NULL)
|
|
return (NDIS_STATUS_FAILURE);
|
|
|
|
block = adapter;
|
|
|
|
iw = IoAllocateWorkItem(block->nmb_deviceobj);
|
|
if (iw == NULL)
|
|
return (NDIS_STATUS_FAILURE);
|
|
|
|
w = malloc(sizeof(struct ndis_allocwork), M_TEMP, M_NOWAIT);
|
|
|
|
if (w == NULL)
|
|
return (NDIS_STATUS_FAILURE);
|
|
|
|
w->na_cached = cached;
|
|
w->na_len = len;
|
|
w->na_ctx = ctx;
|
|
w->na_iw = iw;
|
|
|
|
ifw = (io_workitem_func)ndis_findwrap((funcptr)ndis_asyncmem_complete);
|
|
IoQueueWorkItem(iw, ifw, WORKQUEUE_DELAYED, w);
|
|
|
|
return (NDIS_STATUS_PENDING);
|
|
}
|
|
|
|
static void
|
|
NdisMFreeSharedMemory(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 = NULL;
|
|
list_entry *l;
|
|
|
|
if (vaddr == NULL || adapter == NULL)
|
|
return;
|
|
|
|
block = (ndis_miniport_block *)adapter;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
/* Sanity check: is list empty? */
|
|
|
|
if (IsListEmpty(&sc->ndis_shlist))
|
|
return;
|
|
|
|
NDIS_LOCK(sc);
|
|
l = sc->ndis_shlist.nle_flink;
|
|
while (l != &sc->ndis_shlist) {
|
|
sh = CONTAINING_RECORD(l, struct ndis_shmem, ndis_list);
|
|
if (sh->ndis_saddr == vaddr)
|
|
break;
|
|
/*
|
|
* Check the physaddr too, just in case the driver lied
|
|
* about the virtual address.
|
|
*/
|
|
if (sh->ndis_paddr.np_quad == paddr.np_quad)
|
|
break;
|
|
l = l->nle_flink;
|
|
}
|
|
|
|
if (sh == NULL) {
|
|
NDIS_UNLOCK(sc);
|
|
printf("NDIS: buggy driver tried to free "
|
|
"invalid shared memory: vaddr: %p paddr: 0x%jx\n",
|
|
vaddr, (uintmax_t)paddr.np_quad);
|
|
return;
|
|
}
|
|
|
|
RemoveEntryList(&sh->ndis_list);
|
|
|
|
NDIS_UNLOCK(sc);
|
|
|
|
bus_dmamap_unload(sh->ndis_stag, sh->ndis_smap);
|
|
bus_dmamem_free(sh->ndis_stag, sh->ndis_saddr, sh->ndis_smap);
|
|
bus_dma_tag_destroy(sh->ndis_stag);
|
|
|
|
free(sh, M_DEVBUF);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMMapIoSpace(vaddr, adapter, paddr, len)
|
|
void **vaddr;
|
|
ndis_handle adapter;
|
|
ndis_physaddr paddr;
|
|
uint32_t len;
|
|
{
|
|
if (adapter == NULL)
|
|
return (NDIS_STATUS_FAILURE);
|
|
|
|
*vaddr = MmMapIoSpace(paddr.np_quad, len, 0);
|
|
|
|
if (*vaddr == NULL)
|
|
return (NDIS_STATUS_FAILURE);
|
|
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static void
|
|
NdisMUnmapIoSpace(adapter, vaddr, len)
|
|
ndis_handle adapter;
|
|
void *vaddr;
|
|
uint32_t len;
|
|
{
|
|
MmUnmapIoSpace(vaddr, len);
|
|
}
|
|
|
|
static uint32_t
|
|
NdisGetCacheFillSize(void)
|
|
{
|
|
return (128);
|
|
}
|
|
|
|
static void *
|
|
NdisGetRoutineAddress(ustr)
|
|
unicode_string *ustr;
|
|
{
|
|
ansi_string astr;
|
|
|
|
if (RtlUnicodeStringToAnsiString(&astr, ustr, TRUE))
|
|
return (NULL);
|
|
return (ndis_get_routine_address(ndis_functbl, astr.as_buf));
|
|
}
|
|
|
|
static uint32_t
|
|
NdisMGetDmaAlignment(handle)
|
|
ndis_handle handle;
|
|
{
|
|
return (16);
|
|
}
|
|
|
|
/*
|
|
* 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.
|
|
*/
|
|
|
|
static ndis_status
|
|
NdisMInitializeScatterGatherDma(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 = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
/* 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);
|
|
}
|
|
|
|
void
|
|
NdisAllocatePacketPool(status, pool, descnum, protrsvdlen)
|
|
ndis_status *status;
|
|
ndis_handle *pool;
|
|
uint32_t descnum;
|
|
uint32_t protrsvdlen;
|
|
{
|
|
ndis_packet_pool *p;
|
|
ndis_packet *packets;
|
|
int i;
|
|
|
|
p = ExAllocatePoolWithTag(NonPagedPool, sizeof(ndis_packet_pool), 0);
|
|
if (p == NULL) {
|
|
*status = NDIS_STATUS_RESOURCES;
|
|
return;
|
|
}
|
|
|
|
p->np_cnt = descnum + NDIS_POOL_EXTRA;
|
|
p->np_protrsvd = protrsvdlen;
|
|
p->np_len = sizeof(ndis_packet) + protrsvdlen;
|
|
|
|
packets = ExAllocatePoolWithTag(NonPagedPool, p->np_cnt *
|
|
p->np_len, 0);
|
|
|
|
|
|
if (packets == NULL) {
|
|
ExFreePool(p);
|
|
*status = NDIS_STATUS_RESOURCES;
|
|
return;
|
|
}
|
|
|
|
p->np_pktmem = packets;
|
|
|
|
for (i = 0; i < p->np_cnt; i++)
|
|
InterlockedPushEntrySList(&p->np_head,
|
|
(struct slist_entry *)&packets[i]);
|
|
|
|
#ifdef NDIS_DEBUG_PACKETS
|
|
p->np_dead = 0;
|
|
KeInitializeSpinLock(&p->np_lock);
|
|
KeInitializeEvent(&p->np_event, EVENT_TYPE_NOTIFY, TRUE);
|
|
#endif
|
|
|
|
*pool = p;
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
void
|
|
NdisAllocatePacketPoolEx(status, pool, descnum, oflowdescnum, protrsvdlen)
|
|
ndis_status *status;
|
|
ndis_handle *pool;
|
|
uint32_t descnum;
|
|
uint32_t oflowdescnum;
|
|
uint32_t protrsvdlen;
|
|
{
|
|
return (NdisAllocatePacketPool(status, pool,
|
|
descnum + oflowdescnum, protrsvdlen));
|
|
}
|
|
|
|
uint32_t
|
|
NdisPacketPoolUsage(pool)
|
|
ndis_handle pool;
|
|
{
|
|
ndis_packet_pool *p;
|
|
|
|
p = (ndis_packet_pool *)pool;
|
|
return (p->np_cnt - ExQueryDepthSList(&p->np_head));
|
|
}
|
|
|
|
void
|
|
NdisFreePacketPool(pool)
|
|
ndis_handle pool;
|
|
{
|
|
ndis_packet_pool *p;
|
|
int usage;
|
|
#ifdef NDIS_DEBUG_PACKETS
|
|
uint8_t irql;
|
|
#endif
|
|
|
|
p = (ndis_packet_pool *)pool;
|
|
|
|
#ifdef NDIS_DEBUG_PACKETS
|
|
KeAcquireSpinLock(&p->np_lock, &irql);
|
|
#endif
|
|
|
|
usage = NdisPacketPoolUsage(pool);
|
|
|
|
#ifdef NDIS_DEBUG_PACKETS
|
|
if (usage) {
|
|
p->np_dead = 1;
|
|
KeResetEvent(&p->np_event);
|
|
KeReleaseSpinLock(&p->np_lock, irql);
|
|
KeWaitForSingleObject(&p->np_event, 0, 0, FALSE, NULL);
|
|
} else
|
|
KeReleaseSpinLock(&p->np_lock, irql);
|
|
#endif
|
|
|
|
ExFreePool(p->np_pktmem);
|
|
ExFreePool(p);
|
|
}
|
|
|
|
void
|
|
NdisAllocatePacket(status, packet, pool)
|
|
ndis_status *status;
|
|
ndis_packet **packet;
|
|
ndis_handle pool;
|
|
{
|
|
ndis_packet_pool *p;
|
|
ndis_packet *pkt;
|
|
#ifdef NDIS_DEBUG_PACKETS
|
|
uint8_t irql;
|
|
#endif
|
|
|
|
p = (ndis_packet_pool *)pool;
|
|
|
|
#ifdef NDIS_DEBUG_PACKETS
|
|
KeAcquireSpinLock(&p->np_lock, &irql);
|
|
if (p->np_dead) {
|
|
KeReleaseSpinLock(&p->np_lock, irql);
|
|
printf("NDIS: tried to allocate packet from dead pool %p\n",
|
|
pool);
|
|
*status = NDIS_STATUS_RESOURCES;
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
pkt = (ndis_packet *)InterlockedPopEntrySList(&p->np_head);
|
|
|
|
#ifdef NDIS_DEBUG_PACKETS
|
|
KeReleaseSpinLock(&p->np_lock, irql);
|
|
#endif
|
|
|
|
if (pkt == NULL) {
|
|
*status = NDIS_STATUS_RESOURCES;
|
|
return;
|
|
}
|
|
|
|
|
|
bzero((char *)pkt, sizeof(ndis_packet));
|
|
|
|
/* Save pointer to the pool. */
|
|
pkt->np_private.npp_pool = pool;
|
|
|
|
/* 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() macros to work
|
|
* correctly.
|
|
*/
|
|
pkt->np_private.npp_ndispktflags = NDIS_PACKET_ALLOCATED_BY_NDIS;
|
|
pkt->np_private.npp_validcounts = FALSE;
|
|
|
|
*packet = pkt;
|
|
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
void
|
|
NdisFreePacket(packet)
|
|
ndis_packet *packet;
|
|
{
|
|
ndis_packet_pool *p;
|
|
#ifdef NDIS_DEBUG_PACKETS
|
|
uint8_t irql;
|
|
#endif
|
|
|
|
p = (ndis_packet_pool *)packet->np_private.npp_pool;
|
|
|
|
#ifdef NDIS_DEBUG_PACKETS
|
|
KeAcquireSpinLock(&p->np_lock, &irql);
|
|
#endif
|
|
|
|
InterlockedPushEntrySList(&p->np_head, (slist_entry *)packet);
|
|
|
|
#ifdef NDIS_DEBUG_PACKETS
|
|
if (p->np_dead) {
|
|
if (ExQueryDepthSList(&p->np_head) == p->np_cnt)
|
|
KeSetEvent(&p->np_event, IO_NO_INCREMENT, FALSE);
|
|
}
|
|
KeReleaseSpinLock(&p->np_lock, irql);
|
|
#endif
|
|
}
|
|
|
|
static void
|
|
NdisUnchainBufferAtFront(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)->mdl_next;
|
|
}
|
|
}
|
|
|
|
static void
|
|
NdisUnchainBufferAtBack(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->mdl_next != priv->npp_tail)
|
|
tmp = tmp->mdl_next;
|
|
priv->npp_tail = tmp;
|
|
tmp->mdl_next = NULL;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* The NDIS "buffer" is really an MDL (memory descriptor list)
|
|
* which is used to describe a buffer in a way that allows it
|
|
* to mapped into different contexts. We have to be careful how
|
|
* we handle them: in some versions of Windows, the NdisFreeBuffer()
|
|
* routine is an actual function in the NDIS API, but in others
|
|
* it's just a macro wrapper around IoFreeMdl(). There's really
|
|
* no way to use the 'descnum' parameter to count how many
|
|
* "buffers" are allocated since in order to use IoFreeMdl() to
|
|
* dispose of a buffer, we have to use IoAllocateMdl() to allocate
|
|
* them, and IoAllocateMdl() just grabs them out of the heap.
|
|
*/
|
|
|
|
static void
|
|
NdisAllocateBufferPool(status, pool, descnum)
|
|
ndis_status *status;
|
|
ndis_handle *pool;
|
|
uint32_t descnum;
|
|
{
|
|
|
|
/*
|
|
* The only thing we can really do here is verify that descnum
|
|
* is a reasonable value, but I really don't know what to check
|
|
* it against.
|
|
*/
|
|
|
|
*pool = NonPagedPool;
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
static void
|
|
NdisFreeBufferPool(pool)
|
|
ndis_handle pool;
|
|
{
|
|
}
|
|
|
|
static void
|
|
NdisAllocateBuffer(status, buffer, pool, vaddr, len)
|
|
ndis_status *status;
|
|
ndis_buffer **buffer;
|
|
ndis_handle pool;
|
|
void *vaddr;
|
|
uint32_t len;
|
|
{
|
|
ndis_buffer *buf;
|
|
|
|
buf = IoAllocateMdl(vaddr, len, FALSE, FALSE, NULL);
|
|
if (buf == NULL) {
|
|
*status = NDIS_STATUS_RESOURCES;
|
|
return;
|
|
}
|
|
|
|
MmBuildMdlForNonPagedPool(buf);
|
|
|
|
*buffer = buf;
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
static void
|
|
NdisFreeBuffer(buf)
|
|
ndis_buffer *buf;
|
|
{
|
|
IoFreeMdl(buf);
|
|
}
|
|
|
|
/* Aw c'mon. */
|
|
|
|
static uint32_t
|
|
NdisBufferLength(buf)
|
|
ndis_buffer *buf;
|
|
{
|
|
return (MmGetMdlByteCount(buf));
|
|
}
|
|
|
|
/*
|
|
* Get the virtual address and length of a buffer.
|
|
* Note: the vaddr argument is optional.
|
|
*/
|
|
|
|
static void
|
|
NdisQueryBuffer(buf, vaddr, len)
|
|
ndis_buffer *buf;
|
|
void **vaddr;
|
|
uint32_t *len;
|
|
{
|
|
if (vaddr != NULL)
|
|
*vaddr = MmGetMdlVirtualAddress(buf);
|
|
*len = MmGetMdlByteCount(buf);
|
|
}
|
|
|
|
/* Same as above -- we don't care about the priority. */
|
|
|
|
static void
|
|
NdisQueryBufferSafe(buf, vaddr, len, prio)
|
|
ndis_buffer *buf;
|
|
void **vaddr;
|
|
uint32_t *len;
|
|
uint32_t prio;
|
|
{
|
|
if (vaddr != NULL)
|
|
*vaddr = MmGetMdlVirtualAddress(buf);
|
|
*len = MmGetMdlByteCount(buf);
|
|
}
|
|
|
|
/* Damnit Microsoft!! How many ways can you do the same thing?! */
|
|
|
|
static void *
|
|
NdisBufferVirtualAddress(buf)
|
|
ndis_buffer *buf;
|
|
{
|
|
return (MmGetMdlVirtualAddress(buf));
|
|
}
|
|
|
|
static void *
|
|
NdisBufferVirtualAddressSafe(buf, prio)
|
|
ndis_buffer *buf;
|
|
uint32_t prio;
|
|
{
|
|
return (MmGetMdlVirtualAddress(buf));
|
|
}
|
|
|
|
static void
|
|
NdisAdjustBufferLength(buf, len)
|
|
ndis_buffer *buf;
|
|
int len;
|
|
{
|
|
MmGetMdlByteCount(buf) = len;
|
|
}
|
|
|
|
static uint32_t
|
|
NdisInterlockedIncrement(addend)
|
|
uint32_t *addend;
|
|
{
|
|
atomic_add_long((u_long *)addend, 1);
|
|
return (*addend);
|
|
}
|
|
|
|
static uint32_t
|
|
NdisInterlockedDecrement(addend)
|
|
uint32_t *addend;
|
|
{
|
|
atomic_subtract_long((u_long *)addend, 1);
|
|
return (*addend);
|
|
}
|
|
|
|
static uint32_t
|
|
NdisGetVersion(void)
|
|
{
|
|
return (0x00050001);
|
|
}
|
|
|
|
static void
|
|
NdisInitializeEvent(event)
|
|
ndis_event *event;
|
|
{
|
|
/*
|
|
* NDIS events are always notification
|
|
* events, and should be initialized to the
|
|
* not signaled state.
|
|
*/
|
|
KeInitializeEvent(&event->ne_event, EVENT_TYPE_NOTIFY, FALSE);
|
|
}
|
|
|
|
static void
|
|
NdisSetEvent(event)
|
|
ndis_event *event;
|
|
{
|
|
KeSetEvent(&event->ne_event, IO_NO_INCREMENT, FALSE);
|
|
}
|
|
|
|
static void
|
|
NdisResetEvent(event)
|
|
ndis_event *event;
|
|
{
|
|
KeResetEvent(&event->ne_event);
|
|
}
|
|
|
|
static uint8_t
|
|
NdisWaitEvent(event, msecs)
|
|
ndis_event *event;
|
|
uint32_t msecs;
|
|
{
|
|
int64_t duetime;
|
|
uint32_t rval;
|
|
|
|
duetime = ((int64_t)msecs * -10000);
|
|
rval = KeWaitForSingleObject(event,
|
|
0, 0, TRUE, msecs ? & duetime : NULL);
|
|
|
|
if (rval == STATUS_TIMEOUT)
|
|
return (FALSE);
|
|
|
|
return (TRUE);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisUnicodeStringToAnsiString(dstr, sstr)
|
|
ansi_string *dstr;
|
|
unicode_string *sstr;
|
|
{
|
|
uint32_t rval;
|
|
|
|
rval = RtlUnicodeStringToAnsiString(dstr, sstr, FALSE);
|
|
|
|
if (rval == STATUS_INSUFFICIENT_RESOURCES)
|
|
return (NDIS_STATUS_RESOURCES);
|
|
if (rval)
|
|
return (NDIS_STATUS_FAILURE);
|
|
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisAnsiStringToUnicodeString(dstr, sstr)
|
|
unicode_string *dstr;
|
|
ansi_string *sstr;
|
|
{
|
|
uint32_t rval;
|
|
|
|
rval = RtlAnsiStringToUnicodeString(dstr, sstr, FALSE);
|
|
|
|
if (rval == STATUS_INSUFFICIENT_RESOURCES)
|
|
return (NDIS_STATUS_RESOURCES);
|
|
if (rval)
|
|
return (NDIS_STATUS_FAILURE);
|
|
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMPciAssignResources(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);
|
|
}
|
|
|
|
static uint8_t
|
|
ndis_intr(iobj, arg)
|
|
kinterrupt *iobj;
|
|
void *arg;
|
|
{
|
|
struct ndis_softc *sc;
|
|
uint8_t is_our_intr = FALSE;
|
|
int call_isr = 0;
|
|
ndis_miniport_interrupt *intr;
|
|
|
|
sc = arg;
|
|
intr = sc->ndis_block->nmb_interrupt;
|
|
|
|
if (intr == NULL || sc->ndis_block->nmb_miniportadapterctx == NULL)
|
|
return (FALSE);
|
|
|
|
if (sc->ndis_block->nmb_interrupt->ni_isrreq == TRUE)
|
|
MSCALL3(intr->ni_isrfunc, &is_our_intr, &call_isr,
|
|
sc->ndis_block->nmb_miniportadapterctx);
|
|
else {
|
|
MSCALL1(sc->ndis_chars->nmc_disable_interrupts_func,
|
|
sc->ndis_block->nmb_miniportadapterctx);
|
|
call_isr = 1;
|
|
}
|
|
|
|
if (call_isr)
|
|
IoRequestDpc(sc->ndis_block->nmb_deviceobj, NULL, sc);
|
|
|
|
return (is_our_intr);
|
|
}
|
|
|
|
static void
|
|
ndis_intrhand(dpc, intr, sysarg1, sysarg2)
|
|
kdpc *dpc;
|
|
ndis_miniport_interrupt *intr;
|
|
void *sysarg1;
|
|
void *sysarg2;
|
|
{
|
|
struct ndis_softc *sc;
|
|
ndis_miniport_block *block;
|
|
ndis_handle adapter;
|
|
|
|
block = intr->ni_block;
|
|
adapter = block->nmb_miniportadapterctx;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
|
|
if (NDIS_SERIALIZED(sc->ndis_block))
|
|
KeAcquireSpinLockAtDpcLevel(&block->nmb_lock);
|
|
|
|
MSCALL1(intr->ni_dpcfunc, adapter);
|
|
|
|
/* If there's a MiniportEnableInterrupt() routine, call it. */
|
|
|
|
if (sc->ndis_chars->nmc_enable_interrupts_func != NULL)
|
|
MSCALL1(sc->ndis_chars->nmc_enable_interrupts_func, adapter);
|
|
|
|
if (NDIS_SERIALIZED(sc->ndis_block))
|
|
KeReleaseSpinLockFromDpcLevel(&block->nmb_lock);
|
|
|
|
/*
|
|
* Set the completion event if we've drained all
|
|
* pending interrupts.
|
|
*/
|
|
|
|
KeAcquireSpinLockAtDpcLevel(&intr->ni_dpccountlock);
|
|
intr->ni_dpccnt--;
|
|
if (intr->ni_dpccnt == 0)
|
|
KeSetEvent(&intr->ni_dpcevt, IO_NO_INCREMENT, FALSE);
|
|
KeReleaseSpinLockFromDpcLevel(&intr->ni_dpccountlock);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMRegisterInterrupt(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;
|
|
ndis_miniport_characteristics *ch;
|
|
struct ndis_softc *sc;
|
|
int error;
|
|
|
|
block = adapter;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
ch = IoGetDriverObjectExtension(block->nmb_deviceobj->do_drvobj,
|
|
(void *)1);
|
|
|
|
intr->ni_rsvd = ExAllocatePoolWithTag(NonPagedPool,
|
|
sizeof(struct mtx), 0);
|
|
if (intr->ni_rsvd == NULL)
|
|
return (NDIS_STATUS_RESOURCES);
|
|
|
|
intr->ni_block = adapter;
|
|
intr->ni_isrreq = reqisr;
|
|
intr->ni_shared = shared;
|
|
intr->ni_dpccnt = 0;
|
|
intr->ni_isrfunc = ch->nmc_isr_func;
|
|
intr->ni_dpcfunc = ch->nmc_interrupt_func;
|
|
|
|
KeInitializeEvent(&intr->ni_dpcevt, EVENT_TYPE_NOTIFY, TRUE);
|
|
KeInitializeDpc(&intr->ni_dpc,
|
|
ndis_findwrap((funcptr)ndis_intrhand), intr);
|
|
KeSetImportanceDpc(&intr->ni_dpc, KDPC_IMPORTANCE_LOW);
|
|
|
|
error = IoConnectInterrupt(&intr->ni_introbj,
|
|
ndis_findwrap((funcptr)ndis_intr), sc, NULL,
|
|
ivec, ilevel, 0, imode, shared, 0, FALSE);
|
|
|
|
if (error != STATUS_SUCCESS)
|
|
return (NDIS_STATUS_FAILURE);
|
|
|
|
block->nmb_interrupt = intr;
|
|
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static void
|
|
NdisMDeregisterInterrupt(intr)
|
|
ndis_miniport_interrupt *intr;
|
|
{
|
|
ndis_miniport_block *block;
|
|
uint8_t irql;
|
|
|
|
block = intr->ni_block;
|
|
|
|
/* Should really be KeSynchronizeExecution() */
|
|
|
|
KeAcquireSpinLock(intr->ni_introbj->ki_lock, &irql);
|
|
block->nmb_interrupt = NULL;
|
|
KeReleaseSpinLock(intr->ni_introbj->ki_lock, irql);
|
|
/*
|
|
KeFlushQueuedDpcs();
|
|
*/
|
|
/* Disconnect our ISR */
|
|
|
|
IoDisconnectInterrupt(intr->ni_introbj);
|
|
|
|
KeWaitForSingleObject(&intr->ni_dpcevt, 0, 0, FALSE, NULL);
|
|
KeResetEvent(&intr->ni_dpcevt);
|
|
}
|
|
|
|
static void
|
|
NdisMRegisterAdapterShutdownHandler(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 = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
chars = sc->ndis_chars;
|
|
|
|
chars->nmc_shutdown_handler = shutdownfunc;
|
|
chars->nmc_rsvd0 = shutdownctx;
|
|
}
|
|
|
|
static void
|
|
NdisMDeregisterAdapterShutdownHandler(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 = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
chars = sc->ndis_chars;
|
|
|
|
chars->nmc_shutdown_handler = NULL;
|
|
chars->nmc_rsvd0 = NULL;
|
|
}
|
|
|
|
static uint32_t
|
|
NDIS_BUFFER_TO_SPAN_PAGES(buf)
|
|
ndis_buffer *buf;
|
|
{
|
|
if (buf == NULL)
|
|
return (0);
|
|
if (MmGetMdlByteCount(buf) == 0)
|
|
return (1);
|
|
return (SPAN_PAGES(MmGetMdlVirtualAddress(buf),
|
|
MmGetMdlByteCount(buf)));
|
|
}
|
|
|
|
static void
|
|
NdisGetBufferPhysicalArraySize(buf, pages)
|
|
ndis_buffer *buf;
|
|
uint32_t *pages;
|
|
{
|
|
if (buf == NULL)
|
|
return;
|
|
|
|
*pages = NDIS_BUFFER_TO_SPAN_PAGES(buf);
|
|
}
|
|
|
|
static void
|
|
NdisQueryBufferOffset(buf, off, len)
|
|
ndis_buffer *buf;
|
|
uint32_t *off;
|
|
uint32_t *len;
|
|
{
|
|
if (buf == NULL)
|
|
return;
|
|
|
|
*off = MmGetMdlByteOffset(buf);
|
|
*len = MmGetMdlByteCount(buf);
|
|
}
|
|
|
|
void
|
|
NdisMSleep(usecs)
|
|
uint32_t usecs;
|
|
{
|
|
ktimer timer;
|
|
|
|
/*
|
|
* During system bootstrap, (i.e. cold == 1), we aren't
|
|
* allowed to sleep, so we have to do a hard DELAY()
|
|
* instead.
|
|
*/
|
|
|
|
if (cold)
|
|
DELAY(usecs);
|
|
else {
|
|
KeInitializeTimer(&timer);
|
|
KeSetTimer(&timer, ((int64_t)usecs * -10), NULL);
|
|
KeWaitForSingleObject(&timer, 0, 0, FALSE, NULL);
|
|
}
|
|
}
|
|
|
|
static uint32_t
|
|
NdisReadPcmciaAttributeMemory(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;
|
|
uint32_t i;
|
|
|
|
if (handle == NULL)
|
|
return (0);
|
|
|
|
block = (ndis_miniport_block *)handle;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
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 + i) * 2);
|
|
|
|
return (i);
|
|
}
|
|
|
|
static uint32_t
|
|
NdisWritePcmciaAttributeMemory(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;
|
|
uint32_t i;
|
|
|
|
if (handle == NULL)
|
|
return (0);
|
|
|
|
block = (ndis_miniport_block *)handle;
|
|
sc = device_get_softc(block->nmb_physdeviceobj->do_devext);
|
|
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 + i) * 2, src[i]);
|
|
|
|
return (i);
|
|
}
|
|
|
|
static list_entry *
|
|
NdisInterlockedInsertHeadList(head, entry, lock)
|
|
list_entry *head;
|
|
list_entry *entry;
|
|
ndis_spin_lock *lock;
|
|
{
|
|
list_entry *flink;
|
|
|
|
KeAcquireSpinLock(&lock->nsl_spinlock, &lock->nsl_kirql);
|
|
flink = head->nle_flink;
|
|
entry->nle_flink = flink;
|
|
entry->nle_blink = head;
|
|
flink->nle_blink = entry;
|
|
head->nle_flink = entry;
|
|
KeReleaseSpinLock(&lock->nsl_spinlock, lock->nsl_kirql);
|
|
|
|
return (flink);
|
|
}
|
|
|
|
static list_entry *
|
|
NdisInterlockedRemoveHeadList(head, lock)
|
|
list_entry *head;
|
|
ndis_spin_lock *lock;
|
|
{
|
|
list_entry *flink;
|
|
list_entry *entry;
|
|
|
|
KeAcquireSpinLock(&lock->nsl_spinlock, &lock->nsl_kirql);
|
|
entry = head->nle_flink;
|
|
flink = entry->nle_flink;
|
|
head->nle_flink = flink;
|
|
flink->nle_blink = head;
|
|
KeReleaseSpinLock(&lock->nsl_spinlock, lock->nsl_kirql);
|
|
|
|
return (entry);
|
|
}
|
|
|
|
static list_entry *
|
|
NdisInterlockedInsertTailList(head, entry, lock)
|
|
list_entry *head;
|
|
list_entry *entry;
|
|
ndis_spin_lock *lock;
|
|
{
|
|
list_entry *blink;
|
|
|
|
KeAcquireSpinLock(&lock->nsl_spinlock, &lock->nsl_kirql);
|
|
blink = head->nle_blink;
|
|
entry->nle_flink = head;
|
|
entry->nle_blink = blink;
|
|
blink->nle_flink = entry;
|
|
head->nle_blink = entry;
|
|
KeReleaseSpinLock(&lock->nsl_spinlock, lock->nsl_kirql);
|
|
|
|
return (blink);
|
|
}
|
|
|
|
static uint8_t
|
|
NdisMSynchronizeWithInterrupt(intr, syncfunc, syncctx)
|
|
ndis_miniport_interrupt *intr;
|
|
void *syncfunc;
|
|
void *syncctx;
|
|
{
|
|
return (KeSynchronizeExecution(intr->ni_introbj, syncfunc, syncctx));
|
|
}
|
|
|
|
static void
|
|
NdisGetCurrentSystemTime(tval)
|
|
uint64_t *tval;
|
|
{
|
|
ntoskrnl_time(tval);
|
|
}
|
|
|
|
/*
|
|
* Return the number of milliseconds since the system booted.
|
|
*/
|
|
static void
|
|
NdisGetSystemUpTime(tval)
|
|
uint32_t *tval;
|
|
{
|
|
struct timespec ts;
|
|
|
|
nanouptime(&ts);
|
|
*tval = ts.tv_nsec / 1000000 + ts.tv_sec * 1000;
|
|
}
|
|
|
|
static void
|
|
NdisInitializeString(dst, src)
|
|
unicode_string *dst;
|
|
char *src;
|
|
{
|
|
ansi_string as;
|
|
RtlInitAnsiString(&as, src);
|
|
RtlAnsiStringToUnicodeString(dst, &as, TRUE);
|
|
}
|
|
|
|
static void
|
|
NdisFreeString(str)
|
|
unicode_string *str;
|
|
{
|
|
RtlFreeUnicodeString(str);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMRemoveMiniport(adapter)
|
|
ndis_handle *adapter;
|
|
{
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static void
|
|
NdisInitAnsiString(dst, src)
|
|
ansi_string *dst;
|
|
char *src;
|
|
{
|
|
RtlInitAnsiString(dst, src);
|
|
}
|
|
|
|
static void
|
|
NdisInitUnicodeString(dst, src)
|
|
unicode_string *dst;
|
|
uint16_t *src;
|
|
{
|
|
RtlInitUnicodeString(dst, src);
|
|
}
|
|
|
|
static void NdisMGetDeviceProperty(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_physdeviceobj;
|
|
if (funcdevobj != NULL)
|
|
*funcdevobj = block->nmb_deviceobj;
|
|
if (nextdevobj != NULL)
|
|
*nextdevobj = block->nmb_nextdeviceobj;
|
|
}
|
|
|
|
static void
|
|
NdisGetFirstBufferFromPacket(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 = MmGetMdlVirtualAddress(tmp);
|
|
*firstlen = *totlen = MmGetMdlByteCount(tmp);
|
|
for (tmp = tmp->mdl_next; tmp != NULL; tmp = tmp->mdl_next)
|
|
*totlen += MmGetMdlByteCount(tmp);
|
|
}
|
|
}
|
|
|
|
static void
|
|
NdisGetFirstBufferFromPacketSafe(packet, buf, firstva, firstlen, totlen, prio)
|
|
ndis_packet *packet;
|
|
ndis_buffer **buf;
|
|
void **firstva;
|
|
uint32_t *firstlen;
|
|
uint32_t *totlen;
|
|
uint32_t prio;
|
|
{
|
|
NdisGetFirstBufferFromPacket(packet, buf, firstva, firstlen, totlen);
|
|
}
|
|
|
|
static int
|
|
ndis_find_sym(lf, filename, suffix, sym)
|
|
linker_file_t lf;
|
|
char *filename;
|
|
char *suffix;
|
|
caddr_t *sym;
|
|
{
|
|
char *fullsym;
|
|
char *suf;
|
|
u_int i;
|
|
|
|
fullsym = ExAllocatePoolWithTag(NonPagedPool, MAXPATHLEN, 0);
|
|
if (fullsym == NULL)
|
|
return (ENOMEM);
|
|
|
|
bzero(fullsym, MAXPATHLEN);
|
|
strncpy(fullsym, filename, MAXPATHLEN);
|
|
if (strlen(filename) < 4) {
|
|
ExFreePool(fullsym);
|
|
return (EINVAL);
|
|
}
|
|
|
|
/* If the filename has a .ko suffix, strip if off. */
|
|
suf = fullsym + (strlen(filename) - 3);
|
|
if (strcmp(suf, ".ko") == 0)
|
|
*suf = '\0';
|
|
|
|
for (i = 0; i < strlen(fullsym); i++) {
|
|
if (fullsym[i] == '.')
|
|
fullsym[i] = '_';
|
|
else
|
|
fullsym[i] = tolower(fullsym[i]);
|
|
}
|
|
strcat(fullsym, suffix);
|
|
*sym = linker_file_lookup_symbol(lf, fullsym, 0);
|
|
ExFreePool(fullsym);
|
|
if (*sym == 0)
|
|
return (ENOENT);
|
|
|
|
return (0);
|
|
}
|
|
|
|
struct ndis_checkmodule {
|
|
char *afilename;
|
|
ndis_fh *fh;
|
|
};
|
|
|
|
/*
|
|
* See if a single module contains the symbols for a specified file.
|
|
*/
|
|
static int
|
|
NdisCheckModule(linker_file_t lf, void *context)
|
|
{
|
|
struct ndis_checkmodule *nc;
|
|
caddr_t kldstart, kldend;
|
|
|
|
nc = (struct ndis_checkmodule *)context;
|
|
if (ndis_find_sym(lf, nc->afilename, "_start", &kldstart))
|
|
return (0);
|
|
if (ndis_find_sym(lf, nc->afilename, "_end", &kldend))
|
|
return (0);
|
|
nc->fh->nf_vp = lf;
|
|
nc->fh->nf_map = NULL;
|
|
nc->fh->nf_type = NDIS_FH_TYPE_MODULE;
|
|
nc->fh->nf_maplen = (kldend - kldstart) & 0xFFFFFFFF;
|
|
return (1);
|
|
}
|
|
|
|
/* can also return NDIS_STATUS_RESOURCES/NDIS_STATUS_ERROR_READING_FILE */
|
|
static void
|
|
NdisOpenFile(status, filehandle, filelength, filename, highestaddr)
|
|
ndis_status *status;
|
|
ndis_handle *filehandle;
|
|
uint32_t *filelength;
|
|
unicode_string *filename;
|
|
ndis_physaddr highestaddr;
|
|
{
|
|
ansi_string as;
|
|
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;
|
|
struct ndis_checkmodule nc;
|
|
|
|
if (RtlUnicodeStringToAnsiString(&as, filename, TRUE)) {
|
|
*status = NDIS_STATUS_RESOURCES;
|
|
return;
|
|
}
|
|
|
|
afilename = strdup(as.as_buf, M_DEVBUF);
|
|
RtlFreeAnsiString(&as);
|
|
|
|
fh = ExAllocatePoolWithTag(NonPagedPool, sizeof(ndis_fh), 0);
|
|
if (fh == NULL) {
|
|
free(afilename, M_DEVBUF);
|
|
*status = NDIS_STATUS_RESOURCES;
|
|
return;
|
|
}
|
|
|
|
fh->nf_name = afilename;
|
|
|
|
/*
|
|
* During system bootstrap, it's impossible to load files
|
|
* from the rootfs since it's not mounted yet. We therefore
|
|
* offer the possibility of opening files that have been
|
|
* preloaded as modules instead. Both choices will work
|
|
* when kldloading a module from multiuser, but only the
|
|
* module option will work during bootstrap. The module
|
|
* loading option works by using the ndiscvt(8) utility
|
|
* to convert the arbitrary file into a .ko using objcopy(1).
|
|
* This file will contain two special symbols: filename_start
|
|
* and filename_end. All we have to do is traverse the KLD
|
|
* list in search of those symbols and we've found the file
|
|
* data. As an added bonus, ndiscvt(8) will also generate
|
|
* a normal .o file which can be linked statically with
|
|
* the kernel. This means that the symbols will actual reside
|
|
* in the kernel's symbol table, but that doesn't matter to
|
|
* us since the kernel appears to us as just another module.
|
|
*/
|
|
|
|
nc.afilename = afilename;
|
|
nc.fh = fh;
|
|
if (linker_file_foreach(NdisCheckModule, &nc)) {
|
|
*filelength = fh->nf_maplen;
|
|
*filehandle = fh;
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
return;
|
|
}
|
|
|
|
if (TAILQ_EMPTY(&mountlist)) {
|
|
ExFreePool(fh);
|
|
*status = NDIS_STATUS_FILE_NOT_FOUND;
|
|
printf("NDIS: could not find file %s in linker list\n",
|
|
afilename);
|
|
printf("NDIS: and no filesystems mounted yet, "
|
|
"aborting NdisOpenFile()\n");
|
|
free(afilename, M_DEVBUF);
|
|
return;
|
|
}
|
|
|
|
path = ExAllocatePoolWithTag(NonPagedPool, MAXPATHLEN, 0);
|
|
if (path == NULL) {
|
|
ExFreePool(fh);
|
|
free(afilename, M_DEVBUF);
|
|
*status = NDIS_STATUS_RESOURCES;
|
|
return;
|
|
}
|
|
|
|
snprintf(path, MAXPATHLEN, "%s/%s", ndis_filepath, afilename);
|
|
|
|
/* Some threads don't have a current working directory. */
|
|
|
|
pwd_ensure_dirs();
|
|
|
|
NDINIT(&nd, LOOKUP, FOLLOW, UIO_SYSSPACE, path, td);
|
|
|
|
flags = FREAD;
|
|
error = vn_open(&nd, &flags, 0, NULL);
|
|
if (error) {
|
|
*status = NDIS_STATUS_FILE_NOT_FOUND;
|
|
ExFreePool(fh);
|
|
printf("NDIS: open file %s failed: %d\n", path, error);
|
|
ExFreePool(path);
|
|
free(afilename, M_DEVBUF);
|
|
return;
|
|
}
|
|
|
|
ExFreePool(path);
|
|
|
|
NDFREE(&nd, NDF_ONLY_PNBUF);
|
|
|
|
/* Get the file size. */
|
|
VOP_GETATTR(nd.ni_vp, vap, td->td_ucred);
|
|
VOP_UNLOCK(nd.ni_vp, 0);
|
|
|
|
fh->nf_vp = nd.ni_vp;
|
|
fh->nf_map = NULL;
|
|
fh->nf_type = NDIS_FH_TYPE_VFS;
|
|
*filehandle = fh;
|
|
*filelength = fh->nf_maplen = vap->va_size & 0xFFFFFFFF;
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
}
|
|
|
|
static void
|
|
NdisMapFile(status, mappedbuffer, filehandle)
|
|
ndis_status *status;
|
|
void **mappedbuffer;
|
|
ndis_handle filehandle;
|
|
{
|
|
ndis_fh *fh;
|
|
struct thread *td = curthread;
|
|
linker_file_t lf;
|
|
caddr_t kldstart;
|
|
int error;
|
|
ssize_t resid;
|
|
struct vnode *vp;
|
|
|
|
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;
|
|
}
|
|
|
|
if (fh->nf_type == NDIS_FH_TYPE_MODULE) {
|
|
lf = fh->nf_vp;
|
|
if (ndis_find_sym(lf, fh->nf_name, "_start", &kldstart)) {
|
|
*status = NDIS_STATUS_FAILURE;
|
|
return;
|
|
}
|
|
fh->nf_map = kldstart;
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
*mappedbuffer = fh->nf_map;
|
|
return;
|
|
}
|
|
|
|
fh->nf_map = ExAllocatePoolWithTag(NonPagedPool, fh->nf_maplen, 0);
|
|
|
|
if (fh->nf_map == NULL) {
|
|
*status = NDIS_STATUS_RESOURCES;
|
|
return;
|
|
}
|
|
|
|
vp = fh->nf_vp;
|
|
error = vn_rdwr(UIO_READ, vp, fh->nf_map, fh->nf_maplen, 0,
|
|
UIO_SYSSPACE, 0, td->td_ucred, NOCRED, &resid, td);
|
|
|
|
if (error)
|
|
*status = NDIS_STATUS_FAILURE;
|
|
else {
|
|
*status = NDIS_STATUS_SUCCESS;
|
|
*mappedbuffer = fh->nf_map;
|
|
}
|
|
}
|
|
|
|
static void
|
|
NdisUnmapFile(filehandle)
|
|
ndis_handle filehandle;
|
|
{
|
|
ndis_fh *fh;
|
|
fh = (ndis_fh *)filehandle;
|
|
|
|
if (fh->nf_map == NULL)
|
|
return;
|
|
|
|
if (fh->nf_type == NDIS_FH_TYPE_VFS)
|
|
ExFreePool(fh->nf_map);
|
|
fh->nf_map = NULL;
|
|
}
|
|
|
|
static void
|
|
NdisCloseFile(filehandle)
|
|
ndis_handle filehandle;
|
|
{
|
|
struct thread *td = curthread;
|
|
ndis_fh *fh;
|
|
struct vnode *vp;
|
|
|
|
if (filehandle == NULL)
|
|
return;
|
|
|
|
fh = (ndis_fh *)filehandle;
|
|
if (fh->nf_map != NULL) {
|
|
if (fh->nf_type == NDIS_FH_TYPE_VFS)
|
|
ExFreePool(fh->nf_map);
|
|
fh->nf_map = NULL;
|
|
}
|
|
|
|
if (fh->nf_vp == NULL)
|
|
return;
|
|
|
|
if (fh->nf_type == NDIS_FH_TYPE_VFS) {
|
|
vp = fh->nf_vp;
|
|
vn_close(vp, FREAD, td->td_ucred, td);
|
|
}
|
|
|
|
fh->nf_vp = NULL;
|
|
free(fh->nf_name, M_DEVBUF);
|
|
ExFreePool(fh);
|
|
}
|
|
|
|
static uint8_t
|
|
NdisSystemProcessorCount()
|
|
{
|
|
return (mp_ncpus);
|
|
}
|
|
|
|
static void
|
|
NdisGetCurrentProcessorCounts(idle_count, kernel_and_user, index)
|
|
uint32_t *idle_count;
|
|
uint32_t *kernel_and_user;
|
|
uint32_t *index;
|
|
{
|
|
struct pcpu *pcpu;
|
|
|
|
pcpu = pcpu_find(curthread->td_oncpu);
|
|
*index = pcpu->pc_cpuid;
|
|
*idle_count = pcpu->pc_cp_time[CP_IDLE];
|
|
*kernel_and_user = pcpu->pc_cp_time[CP_INTR];
|
|
}
|
|
|
|
typedef void (*ndis_statusdone_handler)(ndis_handle);
|
|
typedef void (*ndis_status_handler)(ndis_handle, ndis_status,
|
|
void *, uint32_t);
|
|
|
|
static void
|
|
NdisMIndicateStatusComplete(adapter)
|
|
ndis_handle adapter;
|
|
{
|
|
ndis_miniport_block *block;
|
|
ndis_statusdone_handler statusdonefunc;
|
|
|
|
block = (ndis_miniport_block *)adapter;
|
|
statusdonefunc = block->nmb_statusdone_func;
|
|
|
|
MSCALL1(statusdonefunc, adapter);
|
|
}
|
|
|
|
static void
|
|
NdisMIndicateStatus(adapter, status, sbuf, slen)
|
|
ndis_handle adapter;
|
|
ndis_status status;
|
|
void *sbuf;
|
|
uint32_t slen;
|
|
{
|
|
ndis_miniport_block *block;
|
|
ndis_status_handler statusfunc;
|
|
|
|
block = (ndis_miniport_block *)adapter;
|
|
statusfunc = block->nmb_status_func;
|
|
|
|
MSCALL4(statusfunc, adapter, status, sbuf, slen);
|
|
}
|
|
|
|
/*
|
|
* The DDK documentation says that you should use IoQueueWorkItem()
|
|
* instead of ExQueueWorkItem(). The problem is, IoQueueWorkItem()
|
|
* is fundamentally incompatible with NdisScheduleWorkItem(), which
|
|
* depends on the API semantics of ExQueueWorkItem(). In our world,
|
|
* ExQueueWorkItem() is implemented on top of IoAllocateQueueItem()
|
|
* anyway.
|
|
*
|
|
* There are actually three distinct APIs here. NdisScheduleWorkItem()
|
|
* takes a pointer to an NDIS_WORK_ITEM. ExQueueWorkItem() takes a pointer
|
|
* to a WORK_QUEUE_ITEM. And finally, IoQueueWorkItem() takes a pointer
|
|
* to an opaque work item thingie which you get from IoAllocateWorkItem().
|
|
* An NDIS_WORK_ITEM is not the same as a WORK_QUEUE_ITEM. However,
|
|
* the NDIS_WORK_ITEM has some opaque storage at the end of it, and we
|
|
* (ab)use this storage as a WORK_QUEUE_ITEM, which is what we submit
|
|
* to ExQueueWorkItem().
|
|
*
|
|
* Got all that? (Sheesh.)
|
|
*/
|
|
|
|
ndis_status
|
|
NdisScheduleWorkItem(work)
|
|
ndis_work_item *work;
|
|
{
|
|
work_queue_item *wqi;
|
|
|
|
wqi = (work_queue_item *)work->nwi_wraprsvd;
|
|
ExInitializeWorkItem(wqi,
|
|
(work_item_func)work->nwi_func, work->nwi_ctx);
|
|
ExQueueWorkItem(wqi, WORKQUEUE_DELAYED);
|
|
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static void
|
|
NdisCopyFromPacketToPacket(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 = MmGetMdlVirtualAddress(src);
|
|
dptr = MmGetMdlVirtualAddress(dst);
|
|
scnt = MmGetMdlByteCount(src);
|
|
dcnt = MmGetMdlByteCount(dst);
|
|
|
|
while (soff) {
|
|
if (MmGetMdlByteCount(src) > soff) {
|
|
sptr += soff;
|
|
scnt = MmGetMdlByteCount(src)- soff;
|
|
break;
|
|
}
|
|
soff -= MmGetMdlByteCount(src);
|
|
src = src->mdl_next;
|
|
if (src == NULL)
|
|
return;
|
|
sptr = MmGetMdlVirtualAddress(src);
|
|
}
|
|
|
|
while (doff) {
|
|
if (MmGetMdlByteCount(dst) > doff) {
|
|
dptr += doff;
|
|
dcnt = MmGetMdlByteCount(dst) - doff;
|
|
break;
|
|
}
|
|
doff -= MmGetMdlByteCount(dst);
|
|
dst = dst->mdl_next;
|
|
if (dst == NULL)
|
|
return;
|
|
dptr = MmGetMdlVirtualAddress(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->mdl_next;
|
|
if (dst == NULL)
|
|
break;
|
|
dptr = MmGetMdlVirtualAddress(dst);
|
|
dcnt = MmGetMdlByteCount(dst);
|
|
}
|
|
|
|
scnt -= len;
|
|
if (scnt == 0) {
|
|
src = src->mdl_next;
|
|
if (src == NULL)
|
|
break;
|
|
sptr = MmGetMdlVirtualAddress(src);
|
|
scnt = MmGetMdlByteCount(src);
|
|
}
|
|
}
|
|
|
|
*cpylen = copied;
|
|
}
|
|
|
|
static void
|
|
NdisCopyFromPacketToPacketSafe(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;
|
|
{
|
|
NdisCopyFromPacketToPacket(dpkt, doff, reqlen, spkt, soff, cpylen);
|
|
}
|
|
|
|
static void
|
|
NdisIMCopySendPerPacketInfo(dpkt, spkt)
|
|
ndis_packet *dpkt;
|
|
ndis_packet *spkt;
|
|
{
|
|
memcpy(&dpkt->np_ext, &spkt->np_ext, sizeof(ndis_packet_extension));
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMRegisterDevice(handle, devname, symname, majorfuncs, devobj, devhandle)
|
|
ndis_handle handle;
|
|
unicode_string *devname;
|
|
unicode_string *symname;
|
|
driver_dispatch *majorfuncs[];
|
|
void **devobj;
|
|
ndis_handle *devhandle;
|
|
{
|
|
uint32_t status;
|
|
device_object *dobj;
|
|
|
|
status = IoCreateDevice(handle, 0, devname,
|
|
FILE_DEVICE_UNKNOWN, 0, FALSE, &dobj);
|
|
|
|
if (status == STATUS_SUCCESS) {
|
|
*devobj = dobj;
|
|
*devhandle = dobj;
|
|
}
|
|
|
|
return (status);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMDeregisterDevice(handle)
|
|
ndis_handle handle;
|
|
{
|
|
IoDeleteDevice(handle);
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static ndis_status
|
|
NdisMQueryAdapterInstanceName(name, handle)
|
|
unicode_string *name;
|
|
ndis_handle handle;
|
|
{
|
|
ndis_miniport_block *block;
|
|
device_t dev;
|
|
ansi_string as;
|
|
|
|
block = (ndis_miniport_block *)handle;
|
|
dev = block->nmb_physdeviceobj->do_devext;
|
|
|
|
RtlInitAnsiString(&as, __DECONST(char *, device_get_nameunit(dev)));
|
|
if (RtlAnsiStringToUnicodeString(name, &as, TRUE))
|
|
return (NDIS_STATUS_RESOURCES);
|
|
|
|
return (NDIS_STATUS_SUCCESS);
|
|
}
|
|
|
|
static void
|
|
NdisMRegisterUnloadHandler(handle, func)
|
|
ndis_handle handle;
|
|
void *func;
|
|
{
|
|
}
|
|
|
|
static void
|
|
dummy()
|
|
{
|
|
printf("NDIS dummy called...\n");
|
|
}
|
|
|
|
/*
|
|
* Note: a couple of entries in this table specify the
|
|
* number of arguments as "foo + 1". These are routines
|
|
* that accept a 64-bit argument, passed by value. On
|
|
* x86, these arguments consume two longwords on the stack,
|
|
* so we lie and say there's one additional argument so
|
|
* that the wrapping routines will do the right thing.
|
|
*/
|
|
|
|
image_patch_table ndis_functbl[] = {
|
|
IMPORT_SFUNC(NdisCopyFromPacketToPacket, 6),
|
|
IMPORT_SFUNC(NdisCopyFromPacketToPacketSafe, 7),
|
|
IMPORT_SFUNC(NdisIMCopySendPerPacketInfo, 2),
|
|
IMPORT_SFUNC(NdisScheduleWorkItem, 1),
|
|
IMPORT_SFUNC(NdisMIndicateStatusComplete, 1),
|
|
IMPORT_SFUNC(NdisMIndicateStatus, 4),
|
|
IMPORT_SFUNC(NdisSystemProcessorCount, 0),
|
|
IMPORT_SFUNC(NdisGetCurrentProcessorCounts, 3),
|
|
IMPORT_SFUNC(NdisUnchainBufferAtBack, 2),
|
|
IMPORT_SFUNC(NdisGetFirstBufferFromPacket, 5),
|
|
IMPORT_SFUNC(NdisGetFirstBufferFromPacketSafe, 6),
|
|
IMPORT_SFUNC(NdisGetBufferPhysicalArraySize, 2),
|
|
IMPORT_SFUNC(NdisMGetDeviceProperty, 6),
|
|
IMPORT_SFUNC(NdisInitAnsiString, 2),
|
|
IMPORT_SFUNC(NdisInitUnicodeString, 2),
|
|
IMPORT_SFUNC(NdisWriteConfiguration, 4),
|
|
IMPORT_SFUNC(NdisAnsiStringToUnicodeString, 2),
|
|
IMPORT_SFUNC(NdisTerminateWrapper, 2),
|
|
IMPORT_SFUNC(NdisOpenConfigurationKeyByName, 4),
|
|
IMPORT_SFUNC(NdisOpenConfigurationKeyByIndex, 5),
|
|
IMPORT_SFUNC(NdisMRemoveMiniport, 1),
|
|
IMPORT_SFUNC(NdisInitializeString, 2),
|
|
IMPORT_SFUNC(NdisFreeString, 1),
|
|
IMPORT_SFUNC(NdisGetCurrentSystemTime, 1),
|
|
IMPORT_SFUNC(NdisGetRoutineAddress, 1),
|
|
IMPORT_SFUNC(NdisGetSystemUpTime, 1),
|
|
IMPORT_SFUNC(NdisGetVersion, 0),
|
|
IMPORT_SFUNC(NdisMSynchronizeWithInterrupt, 3),
|
|
IMPORT_SFUNC(NdisMAllocateSharedMemoryAsync, 4),
|
|
IMPORT_SFUNC(NdisInterlockedInsertHeadList, 3),
|
|
IMPORT_SFUNC(NdisInterlockedInsertTailList, 3),
|
|
IMPORT_SFUNC(NdisInterlockedRemoveHeadList, 2),
|
|
IMPORT_SFUNC(NdisInitializeWrapper, 4),
|
|
IMPORT_SFUNC(NdisMRegisterMiniport, 3),
|
|
IMPORT_SFUNC(NdisAllocateMemoryWithTag, 3),
|
|
IMPORT_SFUNC(NdisAllocateMemory, 4 + 1),
|
|
IMPORT_SFUNC(NdisMSetAttributesEx, 5),
|
|
IMPORT_SFUNC(NdisCloseConfiguration, 1),
|
|
IMPORT_SFUNC(NdisReadConfiguration, 5),
|
|
IMPORT_SFUNC(NdisOpenConfiguration, 3),
|
|
IMPORT_SFUNC(NdisAcquireSpinLock, 1),
|
|
IMPORT_SFUNC(NdisReleaseSpinLock, 1),
|
|
IMPORT_SFUNC(NdisDprAcquireSpinLock, 1),
|
|
IMPORT_SFUNC(NdisDprReleaseSpinLock, 1),
|
|
IMPORT_SFUNC(NdisAllocateSpinLock, 1),
|
|
IMPORT_SFUNC(NdisInitializeReadWriteLock, 1),
|
|
IMPORT_SFUNC(NdisAcquireReadWriteLock, 3),
|
|
IMPORT_SFUNC(NdisReleaseReadWriteLock, 2),
|
|
IMPORT_SFUNC(NdisFreeSpinLock, 1),
|
|
IMPORT_SFUNC(NdisFreeMemory, 3),
|
|
IMPORT_SFUNC(NdisReadPciSlotInformation, 5),
|
|
IMPORT_SFUNC(NdisWritePciSlotInformation, 5),
|
|
IMPORT_SFUNC_MAP(NdisImmediateReadPciSlotInformation,
|
|
NdisReadPciSlotInformation, 5),
|
|
IMPORT_SFUNC_MAP(NdisImmediateWritePciSlotInformation,
|
|
NdisWritePciSlotInformation, 5),
|
|
IMPORT_CFUNC(NdisWriteErrorLogEntry, 0),
|
|
IMPORT_SFUNC(NdisMStartBufferPhysicalMapping, 6),
|
|
IMPORT_SFUNC(NdisMCompleteBufferPhysicalMapping, 3),
|
|
IMPORT_SFUNC(NdisMInitializeTimer, 4),
|
|
IMPORT_SFUNC(NdisInitializeTimer, 3),
|
|
IMPORT_SFUNC(NdisSetTimer, 2),
|
|
IMPORT_SFUNC(NdisMCancelTimer, 2),
|
|
IMPORT_SFUNC_MAP(NdisCancelTimer, NdisMCancelTimer, 2),
|
|
IMPORT_SFUNC(NdisMSetPeriodicTimer, 2),
|
|
IMPORT_SFUNC(NdisMQueryAdapterResources, 4),
|
|
IMPORT_SFUNC(NdisMRegisterIoPortRange, 4),
|
|
IMPORT_SFUNC(NdisMDeregisterIoPortRange, 4),
|
|
IMPORT_SFUNC(NdisReadNetworkAddress, 4),
|
|
IMPORT_SFUNC(NdisQueryMapRegisterCount, 2),
|
|
IMPORT_SFUNC(NdisMAllocateMapRegisters, 5),
|
|
IMPORT_SFUNC(NdisMFreeMapRegisters, 1),
|
|
IMPORT_SFUNC(NdisMAllocateSharedMemory, 5),
|
|
IMPORT_SFUNC(NdisMMapIoSpace, 4 + 1),
|
|
IMPORT_SFUNC(NdisMUnmapIoSpace, 3),
|
|
IMPORT_SFUNC(NdisGetCacheFillSize, 0),
|
|
IMPORT_SFUNC(NdisMGetDmaAlignment, 1),
|
|
IMPORT_SFUNC(NdisMInitializeScatterGatherDma, 3),
|
|
IMPORT_SFUNC(NdisAllocatePacketPool, 4),
|
|
IMPORT_SFUNC(NdisAllocatePacketPoolEx, 5),
|
|
IMPORT_SFUNC(NdisAllocatePacket, 3),
|
|
IMPORT_SFUNC(NdisFreePacket, 1),
|
|
IMPORT_SFUNC(NdisFreePacketPool, 1),
|
|
IMPORT_SFUNC_MAP(NdisDprAllocatePacket, NdisAllocatePacket, 3),
|
|
IMPORT_SFUNC_MAP(NdisDprFreePacket, NdisFreePacket, 1),
|
|
IMPORT_SFUNC(NdisAllocateBufferPool, 3),
|
|
IMPORT_SFUNC(NdisAllocateBuffer, 5),
|
|
IMPORT_SFUNC(NdisQueryBuffer, 3),
|
|
IMPORT_SFUNC(NdisQueryBufferSafe, 4),
|
|
IMPORT_SFUNC(NdisBufferVirtualAddress, 1),
|
|
IMPORT_SFUNC(NdisBufferVirtualAddressSafe, 2),
|
|
IMPORT_SFUNC(NdisBufferLength, 1),
|
|
IMPORT_SFUNC(NdisFreeBuffer, 1),
|
|
IMPORT_SFUNC(NdisFreeBufferPool, 1),
|
|
IMPORT_SFUNC(NdisInterlockedIncrement, 1),
|
|
IMPORT_SFUNC(NdisInterlockedDecrement, 1),
|
|
IMPORT_SFUNC(NdisInitializeEvent, 1),
|
|
IMPORT_SFUNC(NdisSetEvent, 1),
|
|
IMPORT_SFUNC(NdisResetEvent, 1),
|
|
IMPORT_SFUNC(NdisWaitEvent, 2),
|
|
IMPORT_SFUNC(NdisUnicodeStringToAnsiString, 2),
|
|
IMPORT_SFUNC(NdisMPciAssignResources, 3),
|
|
IMPORT_SFUNC(NdisMFreeSharedMemory, 5 + 1),
|
|
IMPORT_SFUNC(NdisMRegisterInterrupt, 7),
|
|
IMPORT_SFUNC(NdisMDeregisterInterrupt, 1),
|
|
IMPORT_SFUNC(NdisMRegisterAdapterShutdownHandler, 3),
|
|
IMPORT_SFUNC(NdisMDeregisterAdapterShutdownHandler, 1),
|
|
IMPORT_SFUNC(NDIS_BUFFER_TO_SPAN_PAGES, 1),
|
|
IMPORT_SFUNC(NdisQueryBufferOffset, 3),
|
|
IMPORT_SFUNC(NdisAdjustBufferLength, 2),
|
|
IMPORT_SFUNC(NdisPacketPoolUsage, 1),
|
|
IMPORT_SFUNC(NdisMSleep, 1),
|
|
IMPORT_SFUNC(NdisUnchainBufferAtFront, 2),
|
|
IMPORT_SFUNC(NdisReadPcmciaAttributeMemory, 4),
|
|
IMPORT_SFUNC(NdisWritePcmciaAttributeMemory, 4),
|
|
IMPORT_SFUNC(NdisOpenFile, 5 + 1),
|
|
IMPORT_SFUNC(NdisMapFile, 3),
|
|
IMPORT_SFUNC(NdisUnmapFile, 1),
|
|
IMPORT_SFUNC(NdisCloseFile, 1),
|
|
IMPORT_SFUNC(NdisMRegisterDevice, 6),
|
|
IMPORT_SFUNC(NdisMDeregisterDevice, 1),
|
|
IMPORT_SFUNC(NdisMQueryAdapterInstanceName, 2),
|
|
IMPORT_SFUNC(NdisMRegisterUnloadHandler, 2),
|
|
IMPORT_SFUNC(ndis_timercall, 4),
|
|
IMPORT_SFUNC(ndis_asyncmem_complete, 2),
|
|
IMPORT_SFUNC(ndis_intr, 2),
|
|
IMPORT_SFUNC(ndis_intrhand, 4),
|
|
|
|
/*
|
|
* 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, NULL, 0, WINDRV_WRAP_STDCALL },
|
|
|
|
/* End of list. */
|
|
|
|
{ NULL, NULL, NULL }
|
|
};
|