- Remove Mou and Mouse strings in names to share more code with kbdclass

- Handle IRP_MJ_CLEANUP and IRP_MJ_DEVICE_CONTROL
- Read parameters in the right registry key
- Force exclusive opening on device object
- Reference pointer port DOs when they are linked to pointer class DO
- Fix PORT_DEVICE_EXTENSION and CLASS_DEVICE_EXTENSION structures and use them correctly (PORT_DEVICE_EXTENSION was not used...)

svn path=/trunk/; revision=19011
This commit is contained in:
Hervé Poussineau 2005-11-05 08:37:01 +00:00
parent cfd5a15157
commit 175467288d
3 changed files with 209 additions and 114 deletions

View file

@ -28,10 +28,13 @@ ForwardIrpAndWait(
IN PDEVICE_OBJECT DeviceObject, IN PDEVICE_OBJECT DeviceObject,
IN PIRP Irp) IN PIRP Irp)
{ {
PDEVICE_OBJECT LowerDevice = ((PMOUCLASS_DEVICE_EXTENSION)DeviceObject->DeviceExtension)->LowerDevice; PDEVICE_OBJECT LowerDevice;
KEVENT Event; KEVENT Event;
NTSTATUS Status; NTSTATUS Status;
ASSERT(!((PCOMMON_DEVICE_EXTENSION)DeviceObject->DeviceExtension)->IsClassDO);
LowerDevice = ((PPORT_DEVICE_EXTENSION)DeviceObject->DeviceExtension)->LowerDevice;
KeInitializeEvent(&Event, NotificationEvent, FALSE); KeInitializeEvent(&Event, NotificationEvent, FALSE);
IoCopyCurrentIrpStackLocationToNext(Irp); IoCopyCurrentIrpStackLocationToNext(Irp);
@ -54,7 +57,10 @@ ForwardIrpAndForget(
IN PDEVICE_OBJECT DeviceObject, IN PDEVICE_OBJECT DeviceObject,
IN PIRP Irp) IN PIRP Irp)
{ {
PDEVICE_OBJECT LowerDevice = ((PMOUCLASS_DEVICE_EXTENSION)DeviceObject->DeviceExtension)->LowerDevice; PDEVICE_OBJECT LowerDevice;
ASSERT(!((PCOMMON_DEVICE_EXTENSION)DeviceObject->DeviceExtension)->IsClassDO);
LowerDevice = ((PPORT_DEVICE_EXTENSION)DeviceObject->DeviceExtension)->LowerDevice;
IoSkipCurrentIrpStackLocation(Irp); IoSkipCurrentIrpStackLocation(Irp);
return IoCallDriver(LowerDevice, Irp); return IoCallDriver(LowerDevice, Irp);

View file

@ -20,7 +20,7 @@ DriverUnload(IN PDRIVER_OBJECT DriverObject)
} }
static NTSTATUS NTAPI static NTSTATUS NTAPI
MouclassCreate( ClassCreate(
IN PDEVICE_OBJECT DeviceObject, IN PDEVICE_OBJECT DeviceObject,
IN PIRP Irp) IN PIRP Irp)
{ {
@ -34,7 +34,7 @@ MouclassCreate(
} }
static NTSTATUS NTAPI static NTSTATUS NTAPI
MouclassClose( ClassClose(
IN PDEVICE_OBJECT DeviceObject, IN PDEVICE_OBJECT DeviceObject,
IN PIRP Irp) IN PIRP Irp)
{ {
@ -48,7 +48,21 @@ MouclassClose(
} }
static NTSTATUS NTAPI static NTSTATUS NTAPI
MouclassRead( ClassCleanup(
IN PDEVICE_OBJECT DeviceObject,
IN PIRP Irp)
{
DPRINT("IRP_MJ_CLEANUP\n");
if (!((PCOMMON_DEVICE_EXTENSION)DeviceObject->DeviceExtension)->IsClassDO)
return ForwardIrpAndForget(DeviceObject, Irp);
/* FIXME: cleanup all associated Port devices */
return STATUS_SUCCESS;
}
static NTSTATUS NTAPI
ClassRead(
IN PDEVICE_OBJECT DeviceObject, IN PDEVICE_OBJECT DeviceObject,
IN PIRP Irp) IN PIRP Irp)
{ {
@ -71,6 +85,40 @@ MouclassRead(
return STATUS_PENDING; return STATUS_PENDING;
} }
static NTSTATUS NTAPI
ClassDeviceControl(
IN PDEVICE_OBJECT DeviceObject,
IN PIRP Irp)
{
PCLASS_DEVICE_EXTENSION DeviceExtension;
NTSTATUS Status;
DPRINT("IRP_MJ_DEVICE_CONTROL\n");
if (!((PCOMMON_DEVICE_EXTENSION)DeviceObject->DeviceExtension)->IsClassDO)
return ForwardIrpAndForget(DeviceObject, Irp);
DeviceExtension = (PCLASS_DEVICE_EXTENSION)DeviceObject->DeviceExtension;
switch (IoGetCurrentIrpStackLocation(Irp)->Parameters.DeviceIoControl.IoControlCode)
{
case IOCTL_MOUSE_QUERY_ATTRIBUTES:
/* FIXME */
Status = STATUS_NOT_SUPPORTED;
break;
default:
DPRINT1("IRP_MJ_DEVICE_CONTROL / unknown I/O control code 0x%lx\n",
IoGetCurrentIrpStackLocation(Irp)->Parameters.DeviceIoControl.IoControlCode);
Status = STATUS_NOT_SUPPORTED;
}
Irp->IoStatus.Status = Status;
Irp->IoStatus.Information = 0;
IoCompleteRequest(Irp, IO_NO_INCREMENT);
return Status;
}
static NTSTATUS NTAPI static NTSTATUS NTAPI
IrpStub( IrpStub(
IN PDEVICE_OBJECT DeviceObject, IN PDEVICE_OBJECT DeviceObject,
@ -110,14 +158,27 @@ IrpStub(
static NTSTATUS static NTSTATUS
ReadRegistryEntries( ReadRegistryEntries(
IN PUNICODE_STRING RegistryPath, IN PUNICODE_STRING RegistryPath,
IN PMOUCLASS_DRIVER_EXTENSION DriverExtension) IN PCLASS_DRIVER_EXTENSION DriverExtension)
{ {
UNICODE_STRING ParametersRegistryKey;
RTL_QUERY_REGISTRY_TABLE Parameters[4]; RTL_QUERY_REGISTRY_TABLE Parameters[4];
NTSTATUS Status; NTSTATUS Status;
ULONG DefaultConnectMultiplePorts = 1; ULONG DefaultConnectMultiplePorts = 1;
ULONG DefaultMouseDataQueueSize = 0x64; ULONG DefaultDataQueueSize = 0x64;
UNICODE_STRING DefaultPointerDeviceBaseName = RTL_CONSTANT_STRING(L"PointerClass"); UNICODE_STRING DefaultDeviceBaseName = RTL_CONSTANT_STRING(L"PointerClass");
ParametersRegistryKey.Length = 0;
ParametersRegistryKey.MaximumLength = RegistryPath->Length + sizeof(L"\\Parameters") + sizeof(UNICODE_NULL);
ParametersRegistryKey.Buffer = ExAllocatePool(PagedPool, ParametersRegistryKey.MaximumLength);
if (!ParametersRegistryKey.Buffer)
{
DPRINT("ExAllocatePool() failed\n");
return STATUS_INSUFFICIENT_RESOURCES;
}
RtlCopyUnicodeString(&ParametersRegistryKey, RegistryPath);
RtlAppendUnicodeToString(&ParametersRegistryKey, L"\\Parameters");
ParametersRegistryKey.Buffer[ParametersRegistryKey.Length / sizeof(WCHAR)] = UNICODE_NULL;
RtlZeroMemory(Parameters, sizeof(Parameters)); RtlZeroMemory(Parameters, sizeof(Parameters));
@ -127,24 +188,24 @@ ReadRegistryEntries(
Parameters[0].DefaultType = REG_DWORD; Parameters[0].DefaultType = REG_DWORD;
Parameters[0].DefaultData = &DefaultConnectMultiplePorts; Parameters[0].DefaultData = &DefaultConnectMultiplePorts;
Parameters[0].DefaultLength = sizeof(ULONG); Parameters[0].DefaultLength = sizeof(ULONG);
Parameters[1].Flags = RTL_QUERY_REGISTRY_DIRECT | RTL_REGISTRY_OPTIONAL; Parameters[1].Flags = RTL_QUERY_REGISTRY_DIRECT | RTL_REGISTRY_OPTIONAL;
Parameters[1].Name = L"MouseDataQueueSize"; Parameters[1].Name = L"MouseDataQueueSize";
Parameters[1].EntryContext = &DriverExtension->MouseDataQueueSize; Parameters[1].EntryContext = &DriverExtension->DataQueueSize;
Parameters[1].DefaultType = REG_DWORD; Parameters[1].DefaultType = REG_DWORD;
Parameters[1].DefaultData = &DefaultMouseDataQueueSize; Parameters[1].DefaultData = &DefaultDataQueueSize;
Parameters[1].DefaultLength = sizeof(ULONG); Parameters[1].DefaultLength = sizeof(ULONG);
Parameters[2].Flags = RTL_QUERY_REGISTRY_DIRECT | RTL_REGISTRY_OPTIONAL; Parameters[2].Flags = RTL_QUERY_REGISTRY_DIRECT | RTL_REGISTRY_OPTIONAL;
Parameters[2].Name = L"PointerDeviceBaseName"; Parameters[2].Name = L"PointerDeviceBaseName";
Parameters[2].EntryContext = &DriverExtension->PointerDeviceBaseName; Parameters[2].EntryContext = &DriverExtension->DeviceBaseName;
Parameters[2].DefaultType = REG_SZ; Parameters[2].DefaultType = REG_SZ;
Parameters[2].DefaultData = &DefaultPointerDeviceBaseName; Parameters[2].DefaultData = &DefaultDeviceBaseName;
Parameters[2].DefaultLength = sizeof(ULONG); Parameters[2].DefaultLength = sizeof(ULONG);
Status = RtlQueryRegistryValues( Status = RtlQueryRegistryValues(
RTL_REGISTRY_ABSOLUTE, RTL_REGISTRY_ABSOLUTE,
RegistryPath->Buffer, ParametersRegistryKey.Buffer,
Parameters, Parameters,
NULL, NULL,
NULL); NULL);
@ -157,39 +218,49 @@ ReadRegistryEntries(
{ {
DriverExtension->ConnectMultiplePorts = DefaultConnectMultiplePorts; DriverExtension->ConnectMultiplePorts = DefaultConnectMultiplePorts;
} }
if (DriverExtension->MouseDataQueueSize == 0) if (DriverExtension->DataQueueSize == 0)
{ {
DriverExtension->MouseDataQueueSize = DefaultMouseDataQueueSize; DriverExtension->DataQueueSize = DefaultDataQueueSize;
} }
} }
else if (Status == STATUS_OBJECT_NAME_NOT_FOUND)
{
/* Registry path doesn't exist. Set defaults */
DriverExtension->ConnectMultiplePorts = DefaultConnectMultiplePorts;
DriverExtension->DataQueueSize = DefaultDataQueueSize;
Status = RtlDuplicateUnicodeString(
RTL_DUPLICATE_UNICODE_STRING_NULL_TERMINATE,
&DefaultDeviceBaseName,
&DriverExtension->DeviceBaseName);
}
return Status; return Status;
} }
static NTSTATUS static NTSTATUS
CreatePointerClassDeviceObject( CreateClassDeviceObject(
IN PDRIVER_OBJECT DriverObject, IN PDRIVER_OBJECT DriverObject,
OUT PDEVICE_OBJECT *ClassDO OPTIONAL) OUT PDEVICE_OBJECT *ClassDO OPTIONAL)
{ {
PMOUCLASS_DRIVER_EXTENSION DriverExtension; PCLASS_DRIVER_EXTENSION DriverExtension;
ULONG DeviceId = 0; ULONG DeviceId = 0;
ULONG PrefixLength; ULONG PrefixLength;
UNICODE_STRING DeviceNameU; UNICODE_STRING DeviceNameU;
PWSTR DeviceIdW = NULL; /* Pointer into DeviceNameU.Buffer */ PWSTR DeviceIdW = NULL; /* Pointer into DeviceNameU.Buffer */
PDEVICE_OBJECT Fdo; PDEVICE_OBJECT Fdo;
PMOUCLASS_DEVICE_EXTENSION DeviceExtension; PCLASS_DEVICE_EXTENSION DeviceExtension;
NTSTATUS Status; NTSTATUS Status;
DPRINT("CreatePointerClassDeviceObject(0x%p)\n", DriverObject); DPRINT("CreateClassDeviceObject(0x%p)\n", DriverObject);
/* Create new device object */ /* Create new device object */
DriverExtension = IoGetDriverObjectExtension(DriverObject, DriverObject); DriverExtension = IoGetDriverObjectExtension(DriverObject, DriverObject);
DeviceNameU.Length = 0; DeviceNameU.Length = 0;
DeviceNameU.MaximumLength = DeviceNameU.MaximumLength =
wcslen(L"\\Device\\") * sizeof(WCHAR) /* "\Device\" */ wcslen(L"\\Device\\") * sizeof(WCHAR) /* "\Device\" */
+ DriverExtension->PointerDeviceBaseName.Length /* "PointerClass" */ + DriverExtension->DeviceBaseName.Length /* "PointerClass" */
+ 4 * sizeof(WCHAR) /* Id between 0 and 9999 */ + 4 * sizeof(WCHAR) /* Id between 0 and 9999 */
+ sizeof(UNICODE_NULL); /* Final NULL char */ + sizeof(UNICODE_NULL); /* Final NULL char */
DeviceNameU.Buffer = ExAllocatePool(PagedPool, DeviceNameU.MaximumLength); DeviceNameU.Buffer = ExAllocatePool(PagedPool, DeviceNameU.MaximumLength);
if (!DeviceNameU.Buffer) if (!DeviceNameU.Buffer)
{ {
@ -202,7 +273,7 @@ CreatePointerClassDeviceObject(
DPRINT("RtlAppendUnicodeToString() failed with status 0x%08lx\n", Status); DPRINT("RtlAppendUnicodeToString() failed with status 0x%08lx\n", Status);
goto cleanup; goto cleanup;
} }
Status = RtlAppendUnicodeStringToString(&DeviceNameU, &DriverExtension->PointerDeviceBaseName); Status = RtlAppendUnicodeStringToString(&DeviceNameU, &DriverExtension->DeviceBaseName);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
{ {
DPRINT("RtlAppendUnicodeStringToString() failed with status 0x%08lx\n", Status); DPRINT("RtlAppendUnicodeStringToString() failed with status 0x%08lx\n", Status);
@ -215,11 +286,11 @@ CreatePointerClassDeviceObject(
DeviceNameU.Length = PrefixLength + swprintf(DeviceIdW, L"%lu", DeviceId) * sizeof(WCHAR); DeviceNameU.Length = PrefixLength + swprintf(DeviceIdW, L"%lu", DeviceId) * sizeof(WCHAR);
Status = IoCreateDevice( Status = IoCreateDevice(
DriverObject, DriverObject,
sizeof(MOUCLASS_DEVICE_EXTENSION), sizeof(CLASS_DEVICE_EXTENSION),
&DeviceNameU, &DeviceNameU,
FILE_DEVICE_MOUSE, FILE_DEVICE_MOUSE,
FILE_DEVICE_SECURE_OPEN, FILE_DEVICE_SECURE_OPEN,
FALSE, TRUE,
&Fdo); &Fdo);
if (NT_SUCCESS(Status)) if (NT_SUCCESS(Status))
goto cleanup; goto cleanup;
@ -230,27 +301,30 @@ CreatePointerClassDeviceObject(
} }
DeviceId++; DeviceId++;
} }
DPRINT("Too much devices starting with '\\Device\\%wZ'\n", &DriverExtension->PointerDeviceBaseName); DPRINT("Too much devices starting with '\\Device\\%wZ'\n", &DriverExtension->DeviceBaseName);
Status = STATUS_UNSUCCESSFUL; Status = STATUS_UNSUCCESSFUL;
cleanup: cleanup:
ExFreePool(DeviceNameU.Buffer);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
{
ExFreePool(DeviceNameU.Buffer);
return Status; return Status;
}
DeviceExtension = (PMOUCLASS_DEVICE_EXTENSION)Fdo->DeviceExtension; DeviceExtension = (PCLASS_DEVICE_EXTENSION)Fdo->DeviceExtension;
RtlZeroMemory(DeviceExtension, sizeof(MOUCLASS_DEVICE_EXTENSION)); RtlZeroMemory(DeviceExtension, sizeof(CLASS_DEVICE_EXTENSION));
DeviceExtension->Common.IsClassDO = TRUE; DeviceExtension->Common.IsClassDO = TRUE;
DeviceExtension->DriverExtension = DriverExtension; DeviceExtension->DriverExtension = DriverExtension;
DeviceExtension->PnpState = dsStopped;
KeInitializeSpinLock(&(DeviceExtension->SpinLock)); KeInitializeSpinLock(&(DeviceExtension->SpinLock));
DeviceExtension->ReadIsPending = FALSE; DeviceExtension->ReadIsPending = FALSE;
DeviceExtension->InputCount = 0; DeviceExtension->InputCount = 0;
DeviceExtension->PortData = ExAllocatePool(NonPagedPool, DeviceExtension->DriverExtension->MouseDataQueueSize * sizeof(MOUSE_INPUT_DATA)); DeviceExtension->PortData = ExAllocatePool(NonPagedPool, DeviceExtension->DriverExtension->DataQueueSize * sizeof(MOUSE_INPUT_DATA));
Fdo->Flags |= DO_POWER_PAGABLE; Fdo->Flags |= DO_POWER_PAGABLE;
Fdo->Flags &= ~DO_DEVICE_INITIALIZING; Fdo->Flags &= ~DO_DEVICE_INITIALIZING;
/* FIXME: create registry entry in HKEY_LOCAL_MACHINE\HARDWARE\DEVICEMAP */ /* FIXME: create registry entry in HKEY_LOCAL_MACHINE\HARDWARE\DEVICEMAP */
ExFreePool(DeviceNameU.Buffer);
if (ClassDO) if (ClassDO)
*ClassDO = Fdo; *ClassDO = Fdo;
@ -258,22 +332,22 @@ cleanup:
} }
static BOOLEAN static BOOLEAN
MouclassCallback( ClassCallback(
IN PDEVICE_OBJECT ClassDeviceObject, IN PDEVICE_OBJECT ClassDeviceObject,
IN OUT PMOUSE_INPUT_DATA MouseDataStart, IN OUT PMOUSE_INPUT_DATA DataStart,
IN PMOUSE_INPUT_DATA MouseDataEnd, IN PMOUSE_INPUT_DATA DataEnd,
IN OUT PULONG ConsumedCount) IN OUT PULONG ConsumedCount)
{ {
PMOUCLASS_DEVICE_EXTENSION ClassDeviceExtension = ClassDeviceObject->DeviceExtension; PCLASS_DEVICE_EXTENSION ClassDeviceExtension = ClassDeviceObject->DeviceExtension;
PIRP Irp = NULL; PIRP Irp = NULL;
KIRQL OldIrql; KIRQL OldIrql;
PIO_STACK_LOCATION Stack; PIO_STACK_LOCATION Stack;
ULONG InputCount = MouseDataEnd - MouseDataStart; ULONG InputCount = DataEnd - DataStart;
ULONG ReadSize; ULONG ReadSize;
ASSERT(ClassDeviceExtension->Common.IsClassDO); ASSERT(ClassDeviceExtension->Common.IsClassDO);
DPRINT("MouclassCallback()\n"); DPRINT("ClassCallback()\n");
/* A filter driver might have consumed all the data already; I'm /* A filter driver might have consumed all the data already; I'm
* not sure if they are supposed to move the packets when they * not sure if they are supposed to move the packets when they
* consume them though. * consume them though.
@ -288,7 +362,7 @@ MouclassCallback(
/* FIXME: use SEH */ /* FIXME: use SEH */
RtlCopyMemory( RtlCopyMemory(
Irp->MdlAddress ? MmGetSystemAddressForMdlSafe(Irp->MdlAddress, NormalPagePriority) : Irp->UserBuffer, Irp->MdlAddress ? MmGetSystemAddressForMdlSafe(Irp->MdlAddress, NormalPagePriority) : Irp->UserBuffer,
MouseDataStart, DataStart,
sizeof(MOUSE_INPUT_DATA)); sizeof(MOUSE_INPUT_DATA));
/* Go to next packet and complete this request with STATUS_SUCCESS */ /* Go to next packet and complete this request with STATUS_SUCCESS */
@ -299,7 +373,7 @@ MouclassCallback(
ClassDeviceExtension->ReadIsPending = FALSE; ClassDeviceExtension->ReadIsPending = FALSE;
/* Skip the packet we just sent away */ /* Skip the packet we just sent away */
MouseDataStart++; DataStart++;
(*ConsumedCount)++; (*ConsumedCount)++;
InputCount--; InputCount--;
} }
@ -309,23 +383,23 @@ MouclassCallback(
{ {
KeAcquireSpinLock(&ClassDeviceExtension->SpinLock, &OldIrql); KeAcquireSpinLock(&ClassDeviceExtension->SpinLock, &OldIrql);
if (ClassDeviceExtension->InputCount + InputCount > ClassDeviceExtension->DriverExtension->MouseDataQueueSize) if (ClassDeviceExtension->InputCount + InputCount > ClassDeviceExtension->DriverExtension->DataQueueSize)
ReadSize = ClassDeviceExtension->DriverExtension->MouseDataQueueSize - ClassDeviceExtension->InputCount; ReadSize = ClassDeviceExtension->DriverExtension->DataQueueSize - ClassDeviceExtension->InputCount;
else else
ReadSize = InputCount; ReadSize = InputCount;
/* /*
* FIXME: If we exceed the buffer, mouse data gets thrown away.. better * FIXME: If we exceed the buffer, data gets thrown away.. better
* solution? * solution?
*/ */
/* /*
* Move the mouse input data from the port data queue to our class data * Move the input data from the port data queue to our class data
* queue. * queue.
*/ */
RtlMoveMemory( RtlMoveMemory(
ClassDeviceExtension->PortData, ClassDeviceExtension->PortData,
(PCHAR)MouseDataStart, (PCHAR)DataStart,
sizeof(MOUSE_INPUT_DATA) * ReadSize); sizeof(MOUSE_INPUT_DATA) * ReadSize);
/* Move the pointer and counter up */ /* Move the pointer and counter up */
@ -337,7 +411,7 @@ MouclassCallback(
} }
else else
{ {
DPRINT("MouclassCallBack() entered, InputCount = %lu - DOING NOTHING\n", InputCount); DPRINT("ClassCallBack() entered, InputCount = %lu - DOING NOTHING\n", InputCount);
} }
if (Irp != NULL) if (Irp != NULL)
@ -346,15 +420,15 @@ MouclassCallback(
IoCompleteRequest(Irp, IO_MOUSE_INCREMENT); IoCompleteRequest(Irp, IO_MOUSE_INCREMENT);
} }
DPRINT("Leaving MouclassCallback()\n"); DPRINT("Leaving ClassCallback()\n");
return TRUE; return TRUE;
} }
/* Send IOCTL_INTERNAL_MOUSE_CONNECT to pointer port */ /* Send IOCTL_INTERNAL_*_CONNECT to port */
static NTSTATUS static NTSTATUS
ConnectMousePortDriver( ConnectPortDriver(
IN PDEVICE_OBJECT PointerPortDO, IN PDEVICE_OBJECT PortDO,
IN PDEVICE_OBJECT PointerClassDO) IN PDEVICE_OBJECT ClassDO)
{ {
KEVENT Event; KEVENT Event;
PIRP Irp; PIRP Irp;
@ -364,47 +438,50 @@ ConnectMousePortDriver(
KeInitializeEvent(&Event, NotificationEvent, FALSE); KeInitializeEvent(&Event, NotificationEvent, FALSE);
ConnectData.ClassDeviceObject = PointerClassDO; ConnectData.ClassDeviceObject = ClassDO;
ConnectData.ClassService = MouclassCallback; ConnectData.ClassService = ClassCallback;
Irp = IoBuildDeviceIoControlRequest(IOCTL_INTERNAL_MOUSE_CONNECT, Irp = IoBuildDeviceIoControlRequest(IOCTL_INTERNAL_MOUSE_CONNECT,
PointerPortDO, PortDO,
&ConnectData, sizeof(CONNECT_DATA), &ConnectData, sizeof(CONNECT_DATA),
NULL, 0, NULL, 0,
TRUE, &Event, &IoStatus); TRUE, &Event, &IoStatus);
Status = IoCallDriver(PointerPortDO, Irp); Status = IoCallDriver(PortDO, Irp);
if (Status == STATUS_PENDING) if (Status == STATUS_PENDING)
KeWaitForSingleObject(&Event, Suspended, KernelMode, FALSE, NULL); KeWaitForSingleObject(&Event, Suspended, KernelMode, FALSE, NULL);
else else
IoStatus.Status = Status; IoStatus.Status = Status;
if (NT_SUCCESS(IoStatus.Status))
ObReferenceObject(PortDO);
return IoStatus.Status; return IoStatus.Status;
} }
static NTSTATUS NTAPI static NTSTATUS NTAPI
MouclassAddDevice( ClassAddDevice(
IN PDRIVER_OBJECT DriverObject, IN PDRIVER_OBJECT DriverObject,
IN PDEVICE_OBJECT Pdo) IN PDEVICE_OBJECT Pdo)
{ {
PMOUCLASS_DRIVER_EXTENSION DriverExtension; PCLASS_DRIVER_EXTENSION DriverExtension;
PDEVICE_OBJECT Fdo; PDEVICE_OBJECT Fdo;
PMOUCLASS_DEVICE_EXTENSION DeviceExtension; PPORT_DEVICE_EXTENSION DeviceExtension;
NTSTATUS Status; NTSTATUS Status;
DPRINT("MouclassAddDevice called. Pdo = 0x%p\n", Pdo); DPRINT("ClassAddDevice called. Pdo = 0x%p\n", Pdo);
DriverExtension = IoGetDriverObjectExtension(DriverObject, DriverObject); DriverExtension = IoGetDriverObjectExtension(DriverObject, DriverObject);
/* Create new device object */ /* Create new device object */
Status = IoCreateDevice( Status = IoCreateDevice(
DriverObject, DriverObject,
sizeof(MOUCLASS_DEVICE_EXTENSION), sizeof(PORT_DEVICE_EXTENSION),
NULL, NULL,
Pdo->DeviceType, Pdo->DeviceType,
FILE_DEVICE_SECURE_OPEN, FILE_DEVICE_SECURE_OPEN,
FALSE, TRUE,
&Fdo); &Fdo);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
{ {
@ -412,8 +489,8 @@ MouclassAddDevice(
return Status; return Status;
} }
DeviceExtension = (PMOUCLASS_DEVICE_EXTENSION)Fdo->DeviceExtension; DeviceExtension = (PPORT_DEVICE_EXTENSION)Fdo->DeviceExtension;
RtlZeroMemory(DeviceExtension, sizeof(MOUCLASS_DEVICE_EXTENSION)); RtlZeroMemory(DeviceExtension, sizeof(CLASS_DEVICE_EXTENSION));
DeviceExtension->Common.IsClassDO = FALSE; DeviceExtension->Common.IsClassDO = FALSE;
DeviceExtension->PnpState = dsStopped; DeviceExtension->PnpState = dsStopped;
Fdo->Flags |= DO_POWER_PAGABLE; Fdo->Flags |= DO_POWER_PAGABLE;
@ -425,27 +502,27 @@ MouclassAddDevice(
return Status; return Status;
} }
Fdo->Flags |= DO_BUFFERED_IO; Fdo->Flags |= DO_BUFFERED_IO;
Fdo->Flags &= ~DO_DEVICE_INITIALIZING;
if (DriverExtension->ConnectMultiplePorts) if (DriverExtension->ConnectMultiplePorts)
Status = ConnectMousePortDriver(Fdo, DriverExtension->MainMouclassDeviceObject); Status = ConnectPortDriver(Fdo, DriverExtension->MainClassDeviceObject);
else else
Status = ConnectMousePortDriver(Fdo, Fdo); Status = ConnectPortDriver(Fdo, Fdo);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
{ {
DPRINT("ConnectMousePortDriver() failed with status 0x%08lx\n", Status); DPRINT("ConnectPortDriver() failed with status 0x%08lx\n", Status);
IoDetachDevice(DeviceExtension->LowerDevice);
/* FIXME: why can't I cleanup without error? */ /* FIXME: why can't I cleanup without error? */
//IoDetachDevice(Fdo);
//IoDeleteDevice(Fdo); //IoDeleteDevice(Fdo);
return Status; return Status;
} }
Fdo->Flags &= ~DO_DEVICE_INITIALIZING;
/* Register GUID_DEVINTERFACE_MOUSE interface */ /* Register interface */
Status = IoRegisterDeviceInterface( Status = IoRegisterDeviceInterface(
Pdo, Pdo,
&GUID_DEVINTERFACE_MOUSE, &GUID_DEVINTERFACE_MOUSE,
NULL, NULL,
&DeviceExtension->MouseInterfaceName); &DeviceExtension->InterfaceName);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
{ {
DPRINT("IoRegisterDeviceInterface() failed with status 0x%08lx\n", Status); DPRINT("IoRegisterDeviceInterface() failed with status 0x%08lx\n", Status);
@ -456,11 +533,11 @@ MouclassAddDevice(
} }
static VOID NTAPI static VOID NTAPI
MouclassStartIo( ClassStartIo(
IN PDEVICE_OBJECT DeviceObject, IN PDEVICE_OBJECT DeviceObject,
IN PIRP Irp) IN PIRP Irp)
{ {
PMOUCLASS_DEVICE_EXTENSION DeviceExtension = DeviceObject->DeviceExtension; PCLASS_DEVICE_EXTENSION DeviceExtension = DeviceObject->DeviceExtension;
PIO_STACK_LOCATION Stack = IoGetCurrentIrpStackLocation(Irp); PIO_STACK_LOCATION Stack = IoGetCurrentIrpStackLocation(Irp);
ASSERT(DeviceExtension->Common.IsClassDO); ASSERT(DeviceExtension->Common.IsClassDO);
@ -506,7 +583,7 @@ MouclassStartIo(
static NTSTATUS static NTSTATUS
SearchForLegacyDrivers( SearchForLegacyDrivers(
IN PDRIVER_OBJECT DriverObject, IN PDRIVER_OBJECT DriverObject,
IN PMOUCLASS_DRIVER_EXTENSION DriverExtension) IN PCLASS_DRIVER_EXTENSION DriverExtension)
{ {
UNICODE_STRING DeviceMapKeyU = RTL_CONSTANT_STRING(L"\\REGISTRY\\MACHINE\\HARDWARE\\DEVICEMAP"); UNICODE_STRING DeviceMapKeyU = RTL_CONSTANT_STRING(L"\\REGISTRY\\MACHINE\\HARDWARE\\DEVICEMAP");
UNICODE_STRING PortBaseName = {0, }; UNICODE_STRING PortBaseName = {0, };
@ -521,7 +598,7 @@ SearchForLegacyDrivers(
/* Create port base name, by replacing Class by Port at the end of the class base name */ /* Create port base name, by replacing Class by Port at the end of the class base name */
Status = RtlDuplicateUnicodeString( Status = RtlDuplicateUnicodeString(
RTL_DUPLICATE_UNICODE_STRING_NULL_TERMINATE, RTL_DUPLICATE_UNICODE_STRING_NULL_TERMINATE,
&DriverExtension->PointerDeviceBaseName, &DriverExtension->DeviceBaseName,
&PortBaseName); &PortBaseName);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
{ {
@ -544,7 +621,13 @@ SearchForLegacyDrivers(
/* Open HKEY_LOCAL_MACHINE\HARDWARE\DEVICEMAP */ /* Open HKEY_LOCAL_MACHINE\HARDWARE\DEVICEMAP */
InitializeObjectAttributes(&ObjectAttributes, &DeviceMapKeyU, OBJ_KERNEL_HANDLE | OBJ_CASE_INSENSITIVE, NULL, NULL); InitializeObjectAttributes(&ObjectAttributes, &DeviceMapKeyU, OBJ_KERNEL_HANDLE | OBJ_CASE_INSENSITIVE, NULL, NULL);
Status = ZwOpenKey(&hDeviceMapKey, 0, &ObjectAttributes); Status = ZwOpenKey(&hDeviceMapKey, 0, &ObjectAttributes);
if (!NT_SUCCESS(Status)) if (Status == STATUS_OBJECT_NAME_NOT_FOUND)
{
DPRINT("HKLM\\HARDWARE\\DEVICEMAP is non-existent\n");
Status = STATUS_SUCCESS;
goto cleanup;
}
else if (!NT_SUCCESS(Status))
{ {
DPRINT("ZwOpenKey() failed with status 0x%08lx\n", Status); DPRINT("ZwOpenKey() failed with status 0x%08lx\n", Status);
goto cleanup; goto cleanup;
@ -553,10 +636,15 @@ SearchForLegacyDrivers(
/* Open sub key */ /* Open sub key */
InitializeObjectAttributes(&ObjectAttributes, &PortBaseName, OBJ_KERNEL_HANDLE | OBJ_CASE_INSENSITIVE, hDeviceMapKey, NULL); InitializeObjectAttributes(&ObjectAttributes, &PortBaseName, OBJ_KERNEL_HANDLE | OBJ_CASE_INSENSITIVE, hDeviceMapKey, NULL);
Status = ZwOpenKey(&hPortKey, KEY_QUERY_VALUE, &ObjectAttributes); Status = ZwOpenKey(&hPortKey, KEY_QUERY_VALUE, &ObjectAttributes);
if (!NT_SUCCESS(Status)) if (Status == STATUS_OBJECT_NAME_NOT_FOUND)
{
DPRINT("HKLM\\HARDWARE\\DEVICEMAP\\%wZ is non-existent\n", &PortBaseName);
Status = STATUS_SUCCESS;
goto cleanup;
}
else if (!NT_SUCCESS(Status))
{ {
DPRINT("ZwOpenKey() failed with status 0x%08lx\n", Status); DPRINT("ZwOpenKey() failed with status 0x%08lx\n", Status);
DPRINT1("ZwOpenKey() failed with status 0x%08lx\n", Status);
goto cleanup; goto cleanup;
} }
@ -580,31 +668,29 @@ SearchForLegacyDrivers(
/* Connect the port device object */ /* Connect the port device object */
if (DriverExtension->ConnectMultiplePorts) if (DriverExtension->ConnectMultiplePorts)
{ {
Status = ConnectMousePortDriver(PortDeviceObject, DriverExtension->MainMouclassDeviceObject); Status = ConnectPortDriver(PortDeviceObject, DriverExtension->MainClassDeviceObject);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
{ {
/* FIXME: Log the error */ /* FIXME: Log the error */
DPRINT("ConnectMousePortDriver() failed with status 0x%08lx\n", Status); DPRINT("ConnectPortDriver() failed with status 0x%08lx\n", Status);
/* FIXME: cleanup */
} }
} }
else else
{ {
PDEVICE_OBJECT ClassDO; PDEVICE_OBJECT ClassDO;
Status = CreatePointerClassDeviceObject(DriverObject, &ClassDO); Status = CreateClassDeviceObject(DriverObject, &ClassDO);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
{ {
/* FIXME: Log the error */ /* FIXME: Log the error */
DPRINT("CreatePointerClassDeviceObject() failed with status 0x%08lx\n", Status); DPRINT("CreatePointerClassDeviceObject() failed with status 0x%08lx\n", Status);
/* FIXME: cleanup */
continue; continue;
} }
Status = ConnectMousePortDriver(PortDeviceObject, ClassDO); Status = ConnectPortDriver(PortDeviceObject, ClassDO);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
{ {
/* FIXME: Log the error */ /* FIXME: Log the error */
DPRINT("ConnectMousePortDriver() failed with status 0x%08lx\n", Status); DPRINT("ConnectPortDriver() failed with status 0x%08lx\n", Status);
/* FIXME: cleanup */ IoDeleteDevice(ClassDO);
} }
} }
} }
@ -629,21 +715,21 @@ DriverEntry(
IN PDRIVER_OBJECT DriverObject, IN PDRIVER_OBJECT DriverObject,
IN PUNICODE_STRING RegistryPath) IN PUNICODE_STRING RegistryPath)
{ {
PMOUCLASS_DRIVER_EXTENSION DriverExtension; PCLASS_DRIVER_EXTENSION DriverExtension;
ULONG i; ULONG i;
NTSTATUS Status; NTSTATUS Status;
Status = IoAllocateDriverObjectExtension( Status = IoAllocateDriverObjectExtension(
DriverObject, DriverObject,
DriverObject, DriverObject,
sizeof(MOUCLASS_DRIVER_EXTENSION), sizeof(CLASS_DRIVER_EXTENSION),
(PVOID*)&DriverExtension); (PVOID*)&DriverExtension);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
{ {
DPRINT("IoAllocateDriverObjectExtension() failed with status 0x%08lx\n", Status); DPRINT("IoAllocateDriverObjectExtension() failed with status 0x%08lx\n", Status);
return Status; return Status;
} }
RtlZeroMemory(DriverExtension, sizeof(MOUCLASS_DRIVER_EXTENSION)); RtlZeroMemory(DriverExtension, sizeof(CLASS_DRIVER_EXTENSION));
Status = ReadRegistryEntries(RegistryPath, DriverExtension); Status = ReadRegistryEntries(RegistryPath, DriverExtension);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
@ -654,26 +740,28 @@ DriverEntry(
if (DriverExtension->ConnectMultiplePorts == 1) if (DriverExtension->ConnectMultiplePorts == 1)
{ {
Status = CreatePointerClassDeviceObject( Status = CreateClassDeviceObject(
DriverObject, DriverObject,
&DriverExtension->MainMouclassDeviceObject); &DriverExtension->MainClassDeviceObject);
if (!NT_SUCCESS(Status)) if (!NT_SUCCESS(Status))
{ {
DPRINT("CreatePointerClassDeviceObject() failed with status 0x%08lx\n", Status); DPRINT("CreateClassDeviceObject() failed with status 0x%08lx\n", Status);
return Status; return Status;
} }
} }
DriverObject->DriverExtension->AddDevice = MouclassAddDevice; DriverObject->DriverExtension->AddDevice = ClassAddDevice;
DriverObject->DriverUnload = DriverUnload; DriverObject->DriverUnload = DriverUnload;
for (i = 0; i < IRP_MJ_MAXIMUM_FUNCTION; i++) for (i = 0; i < IRP_MJ_MAXIMUM_FUNCTION; i++)
DriverObject->MajorFunction[i] = IrpStub; DriverObject->MajorFunction[i] = IrpStub;
DriverObject->MajorFunction[IRP_MJ_CREATE] = MouclassCreate; DriverObject->MajorFunction[IRP_MJ_CREATE] = ClassCreate;
DriverObject->MajorFunction[IRP_MJ_CLOSE] = MouclassClose; DriverObject->MajorFunction[IRP_MJ_CLOSE] = ClassClose;
DriverObject->MajorFunction[IRP_MJ_READ] = MouclassRead; DriverObject->MajorFunction[IRP_MJ_CLEANUP] = ClassCleanup;
DriverObject->DriverStartIo = MouclassStartIo; DriverObject->MajorFunction[IRP_MJ_READ] = ClassRead;
DriverObject->MajorFunction[IRP_MJ_DEVICE_CONTROL] = ClassDeviceControl;
DriverObject->DriverStartIo = ClassStartIo;
Status = SearchForLegacyDrivers(DriverObject, DriverExtension); Status = SearchForLegacyDrivers(DriverObject, DriverExtension);

View file

@ -20,42 +20,43 @@ typedef enum
dsPaused, dsPaused,
dsRemoved, dsRemoved,
dsSurpriseRemoved dsSurpriseRemoved
} MOUCLASS_DEVICE_STATE; } PORT_DEVICE_STATE;
typedef struct _MOUCLASS_DRIVER_EXTENSION typedef struct _CLASS_DRIVER_EXTENSION
{ {
/* Registry settings */ /* Registry settings */
ULONG ConnectMultiplePorts; ULONG ConnectMultiplePorts;
ULONG MouseDataQueueSize; ULONG DataQueueSize;
UNICODE_STRING PointerDeviceBaseName; UNICODE_STRING DeviceBaseName;
PDEVICE_OBJECT MainMouclassDeviceObject; PDEVICE_OBJECT MainClassDeviceObject;
} MOUCLASS_DRIVER_EXTENSION, *PMOUCLASS_DRIVER_EXTENSION; } CLASS_DRIVER_EXTENSION, *PCLASS_DRIVER_EXTENSION;
typedef struct _COMMON_DEVICE_EXTENSION typedef struct _COMMON_DEVICE_EXTENSION
{ {
BOOLEAN IsClassDO; BOOLEAN IsClassDO;
} COMMON_DEVICE_EXTENSION, *PCOMMON_DEVICE_EXTENSION; } COMMON_DEVICE_EXTENSION, *PCOMMON_DEVICE_EXTENSION;
typedef struct _MOUPORT_DEVICE_EXTENSION typedef struct _PORT_DEVICE_EXTENSION
{
COMMON_DEVICE_EXTENSION Common;
} MOUPORT_DEVICE_EXTENSION, *PMOUPORT_DEVICE_EXTENSION;
typedef struct _MOUCLASS_DEVICE_EXTENSION
{ {
COMMON_DEVICE_EXTENSION Common; COMMON_DEVICE_EXTENSION Common;
MOUCLASS_DEVICE_STATE PnpState; PORT_DEVICE_STATE PnpState;
PMOUCLASS_DRIVER_EXTENSION DriverExtension;
PDEVICE_OBJECT LowerDevice; PDEVICE_OBJECT LowerDevice;
UNICODE_STRING MouseInterfaceName; UNICODE_STRING InterfaceName;
} PORT_DEVICE_EXTENSION, *PPORT_DEVICE_EXTENSION;
typedef struct _CLASS_DEVICE_EXTENSION
{
COMMON_DEVICE_EXTENSION Common;
PCLASS_DRIVER_EXTENSION DriverExtension;
KSPIN_LOCK SpinLock; KSPIN_LOCK SpinLock;
BOOLEAN ReadIsPending; BOOLEAN ReadIsPending;
ULONG InputCount; ULONG InputCount;
PMOUSE_INPUT_DATA PortData; PMOUSE_INPUT_DATA PortData;
} MOUCLASS_DEVICE_EXTENSION, *PMOUCLASS_DEVICE_EXTENSION; } CLASS_DEVICE_EXTENSION, *PCLASS_DEVICE_EXTENSION;
/* misc.c */ /* misc.c */