Add giveio device driver source. Requires MS DDK to build.
git-svn-id: svn://svn.savannah.nongnu.org/avrdude/trunk/avrdude@228 81a1dc3b-b13d-400b-aceb-764788c761c2
This commit is contained in:
parent
8ddff90eae
commit
46c28924d0
|
@ -0,0 +1,168 @@
|
|||
/*********************************************************************
|
||||
|
||||
Author: Dale Roberts
|
||||
Date: 8/30/95
|
||||
Program: GIVEIO.SYS
|
||||
Compile: Use DDK BUILD facility
|
||||
|
||||
Purpose: Give direct port I/O access to a user mode process.
|
||||
|
||||
*********************************************************************/
|
||||
#include <ntddk.h>
|
||||
|
||||
/*
|
||||
* The name of our device driver.
|
||||
*/
|
||||
#define DEVICE_NAME_STRING L"giveio"
|
||||
|
||||
/*
|
||||
* This is the "structure" of the IOPM. It is just a simple
|
||||
* character array of length 0x2000.
|
||||
*
|
||||
* This holds 8K * 8 bits -> 64K bits of the IOPM, which maps the
|
||||
* entire 64K I/O space of the x86 processor. Any 0 bits will give
|
||||
* access to the corresponding port for user mode processes. Any 1
|
||||
* bits will disallow I/O access to the corresponding port.
|
||||
*/
|
||||
#define IOPM_SIZE 0x2000
|
||||
typedef UCHAR IOPM[IOPM_SIZE];
|
||||
|
||||
/*
|
||||
* This will hold simply an array of 0's which will be copied
|
||||
* into our actual IOPM in the TSS by Ke386SetIoAccessMap().
|
||||
* The memory is allocated at driver load time.
|
||||
*/
|
||||
IOPM *IOPM_local = 0;
|
||||
|
||||
/*
|
||||
* These are the two undocumented calls that we will use to give
|
||||
* the calling process I/O access.
|
||||
*
|
||||
* Ke386IoSetAccessMap() copies the passed map to the TSS.
|
||||
*
|
||||
* Ke386IoSetAccessProcess() adjusts the IOPM offset pointer so that
|
||||
* the newly copied map is actually used. Otherwise, the IOPM offset
|
||||
* points beyond the end of the TSS segment limit, causing any I/O
|
||||
* access by the user mode process to generate an exception.
|
||||
*/
|
||||
void Ke386SetIoAccessMap(int, IOPM *);
|
||||
void Ke386QueryIoAccessMap(int, IOPM *);
|
||||
void Ke386IoSetAccessProcess(PEPROCESS, int);
|
||||
|
||||
/*********************************************************************
|
||||
Release any allocated objects.
|
||||
*********************************************************************/
|
||||
VOID GiveioUnload(IN PDRIVER_OBJECT DriverObject)
|
||||
{
|
||||
WCHAR DOSNameBuffer[] = L"\\DosDevices\\" DEVICE_NAME_STRING;
|
||||
UNICODE_STRING uniDOSString;
|
||||
|
||||
if(IOPM_local)
|
||||
MmFreeNonCachedMemory(IOPM_local, sizeof(IOPM));
|
||||
|
||||
RtlInitUnicodeString(&uniDOSString, DOSNameBuffer);
|
||||
IoDeleteSymbolicLink (&uniDOSString);
|
||||
IoDeleteDevice(DriverObject->DeviceObject);
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
Set the IOPM (I/O permission map) of the calling process so that it
|
||||
is given full I/O access. Our IOPM_local[] array is all zeros, so
|
||||
the IOPM will be all zeros. If OnFlag is 1, the process is given I/O
|
||||
access. If it is 0, access is removed.
|
||||
*********************************************************************/
|
||||
VOID SetIOPermissionMap(int OnFlag)
|
||||
{
|
||||
Ke386IoSetAccessProcess(PsGetCurrentProcess(), OnFlag);
|
||||
Ke386SetIoAccessMap(1, IOPM_local);
|
||||
}
|
||||
|
||||
void GiveIO(void)
|
||||
{
|
||||
SetIOPermissionMap(1);
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
Service handler for a CreateFile() user mode call.
|
||||
|
||||
This routine is entered in the driver object function call table by
|
||||
the DriverEntry() routine. When the user mode application calls
|
||||
CreateFile(), this routine gets called while still in the context of
|
||||
the user mode application, but with the CPL (the processor's Current
|
||||
Privelege Level) set to 0. This allows us to do kernel mode
|
||||
operations. GiveIO() is called to give the calling process I/O
|
||||
access. All the user mode application needs do to obtain I/O access
|
||||
is open this device with CreateFile(). No other operations are
|
||||
required.
|
||||
*********************************************************************/
|
||||
NTSTATUS GiveioCreateDispatch(
|
||||
IN PDEVICE_OBJECT DeviceObject,
|
||||
IN PIRP Irp
|
||||
)
|
||||
{
|
||||
GiveIO(); // give the calling process I/O access
|
||||
|
||||
Irp->IoStatus.Information = 0;
|
||||
Irp->IoStatus.Status = STATUS_SUCCESS;
|
||||
IoCompleteRequest(Irp, IO_NO_INCREMENT);
|
||||
return STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
/*********************************************************************
|
||||
Driver Entry routine.
|
||||
|
||||
This routine is called only once after the driver is initially
|
||||
loaded into memory. It allocates everything necessary for the
|
||||
driver's operation. In our case, it allocates memory for our IOPM
|
||||
array, and creates a device which user mode applications can open.
|
||||
It also creates a symbolic link to the device driver. This allows
|
||||
a user mode application to access our driver using the \\.\giveio
|
||||
notation.
|
||||
*********************************************************************/
|
||||
NTSTATUS DriverEntry(
|
||||
IN PDRIVER_OBJECT DriverObject,
|
||||
IN PUNICODE_STRING RegistryPath
|
||||
)
|
||||
{
|
||||
PDEVICE_OBJECT deviceObject;
|
||||
NTSTATUS status;
|
||||
WCHAR NameBuffer[] = L"\\Device\\" DEVICE_NAME_STRING;
|
||||
WCHAR DOSNameBuffer[] = L"\\DosDevices\\" DEVICE_NAME_STRING;
|
||||
UNICODE_STRING uniNameString, uniDOSString;
|
||||
|
||||
//
|
||||
// Allocate a buffer for the local IOPM and zero it.
|
||||
//
|
||||
IOPM_local = MmAllocateNonCachedMemory(sizeof(IOPM));
|
||||
if(IOPM_local == 0)
|
||||
return STATUS_INSUFFICIENT_RESOURCES;
|
||||
RtlZeroMemory(IOPM_local, sizeof(IOPM));
|
||||
|
||||
//
|
||||
// Set up device driver name and device object.
|
||||
//
|
||||
RtlInitUnicodeString(&uniNameString, NameBuffer);
|
||||
RtlInitUnicodeString(&uniDOSString, DOSNameBuffer);
|
||||
|
||||
status = IoCreateDevice(DriverObject, 0,
|
||||
&uniNameString,
|
||||
FILE_DEVICE_UNKNOWN,
|
||||
0, FALSE, &deviceObject);
|
||||
|
||||
if(!NT_SUCCESS(status))
|
||||
return status;
|
||||
|
||||
status = IoCreateSymbolicLink (&uniDOSString, &uniNameString);
|
||||
|
||||
if (!NT_SUCCESS(status))
|
||||
return status;
|
||||
|
||||
//
|
||||
// Initialize the Driver Object with driver's entry points.
|
||||
// All we require are the Create and Unload operations.
|
||||
//
|
||||
DriverObject->MajorFunction[IRP_MJ_CREATE] = GiveioCreateDispatch;
|
||||
DriverObject->DriverUnload = GiveioUnload;
|
||||
return STATUS_SUCCESS;
|
||||
}
|
||||
|
Loading…
Reference in New Issue