//
// only supported for PDO
//
- DPRINT1("[HIDCLASS] IRP_MJ_CREATE for FDO\n");
Irp->IoStatus.Status = STATUS_UNSUCCESSFUL;
IoCompleteRequest(Irp, IO_NO_INCREMENT);
return STATUS_UNSUCCESSFUL;
return STATUS_SUCCESS;
}
+PVOID
+HidClass_GetSystemAddress(
+ IN PMDL ReportMDL)
+{
+ //
+ // sanity check
+ //
+ ASSERT(ReportMDL);
+
+ if (ReportMDL->MdlFlags & (MDL_SOURCE_IS_NONPAGED_POOL | MDL_MAPPED_TO_SYSTEM_VA))
+ {
+ //
+ // buffer is non paged pool
+ //
+ return ReportMDL->MappedSystemVa;
+ }
+ else
+ {
+ //
+ // map mdl
+ //
+ return MmMapLockedPages(ReportMDL, KernelMode);
+ }
+}
+
NTSTATUS
NTAPI
HidClass_ReadCompleteIrp(
{
PHIDCLASS_IRP_CONTEXT IrpContext;
KIRQL OldLevel;
+ PUCHAR Address;
+ ULONG Offset;
+ PHIDP_DEVICE_DESC DeviceDescription;
+ ULONG CollectionIndex;
//
// get irp context
//
IrpContext = (PHIDCLASS_IRP_CONTEXT)Ctx;
- DPRINT1("HidClass_ReadCompleteIrp Irql %lu\n", KeGetCurrentIrql());
- DPRINT1("HidClass_ReadCompleteIrp Status %lx\n", Irp->IoStatus.Status);
- DPRINT1("HidClass_ReadCompleteIrp Length %lu\n", Irp->IoStatus.Information);
- DPRINT1("HidClass_ReadCompleteIrp Irp %p\n", Irp);
- DPRINT1("HidClass_ReadCompleteIrp InputReportBuffer %p\n", IrpContext->InputReportBuffer);
- DPRINT1("HidClass_ReadCompleteIrp InputReportBufferLength %li\n", IrpContext->InputReportBufferLength);
- DPRINT1("HidClass_ReadCompleteIrp OriginalIrp %p\n", IrpContext->OriginalIrp);
+ DPRINT("HidClass_ReadCompleteIrp Irql %lu\n", KeGetCurrentIrql());
+ DPRINT("HidClass_ReadCompleteIrp Status %lx\n", Irp->IoStatus.Status);
+ DPRINT("HidClass_ReadCompleteIrp Length %lu\n", Irp->IoStatus.Information);
+ DPRINT("HidClass_ReadCompleteIrp Irp %p\n", Irp);
+ DPRINT("HidClass_ReadCompleteIrp InputReportBuffer %p\n", IrpContext->InputReportBuffer);
+ DPRINT("HidClass_ReadCompleteIrp InputReportBufferLength %li\n", IrpContext->InputReportBufferLength);
+ DPRINT("HidClass_ReadCompleteIrp OriginalIrp %p\n", IrpContext->OriginalIrp);
//
// copy result
if (Irp->IoStatus.Information)
{
//
- // copy result
+ // get address
//
- RtlCopyMemory(IrpContext->OriginalIrp->UserBuffer, IrpContext->InputReportBuffer, IrpContext->InputReportBufferLength);
+ Address = HidClass_GetSystemAddress(IrpContext->OriginalIrp->MdlAddress);
+ if (Address)
+ {
+ //
+ // reports may have a report id prepended
+ //
+ CollectionIndex = IrpContext->FileOp->DeviceExtension->CollectionIndex;
+ DeviceDescription = &IrpContext->FileOp->DeviceExtension->Common.DeviceDescription;
+
+ //
+ // calculate offset
+ //
+ ASSERT(DeviceDescription->CollectionDesc[CollectionIndex].InputLength >= DeviceDescription->ReportIDs[CollectionIndex].InputLength);
+ Offset = DeviceDescription->CollectionDesc[CollectionIndex].InputLength - DeviceDescription->ReportIDs[CollectionIndex].InputLength;
+
+ //
+ // copy result
+ //
+ RtlCopyMemory(&Address[Offset], IrpContext->InputReportBuffer, IrpContext->InputReportBufferLength);
+ }
}
//
//
ExFreePool(IrpContext->InputReportBuffer);
- //
- // complete original request
- //
- IoCompleteRequest(IrpContext->OriginalIrp, IO_NO_INCREMENT);
-
//
// remove us from pending list
//
//
RemoveEntryList(&Irp->Tail.Overlay.ListEntry);
+ //
+ // insert into completed list
+ //
+ InsertTailList(&IrpContext->FileOp->IrpCompletedListHead, &Irp->Tail.Overlay.ListEntry);
+
//
// release lock
//
KeReleaseSpinLock(&IrpContext->FileOp->Lock, OldLevel);
+ //
+ // complete original request
+ //
+ IoCompleteRequest(IrpContext->OriginalIrp, IO_NO_INCREMENT);
+
//
// free irp context
//
//
// done
//
- return STATUS_SUCCESS;
+ return STATUS_MORE_PROCESSING_REQUIRED;
+}
+
+PIRP
+HidClass_GetIrp(
+ IN PHIDCLASS_FILEOP_CONTEXT Context)
+{
+ KIRQL OldLevel;
+ PIRP Irp = NULL;
+ PLIST_ENTRY ListEntry;
+
+ //
+ // acquire lock
+ //
+ KeAcquireSpinLock(&Context->Lock, &OldLevel);
+
+ //
+ // is list empty?
+ //
+ if (!IsListEmpty(&Context->IrpCompletedListHead))
+ {
+ //
+ // grab first entry
+ //
+ ListEntry = RemoveHeadList(&Context->IrpCompletedListHead);
+
+ //
+ // get irp
+ //
+ Irp = (PIRP)CONTAINING_RECORD(ListEntry, IRP, Tail.Overlay.ListEntry);
+ }
+
+ //
+ // release lock
+ //
+ KeReleaseSpinLock(&Context->Lock, OldLevel);
+
+ //
+ // done
+ //
+ return Irp;
}
NTSTATUS
PIRP Irp;
PIO_STACK_LOCATION IoStack;
PHIDCLASS_IRP_CONTEXT IrpContext;
+ PHIDCLASS_PDO_DEVICE_EXTENSION PDODeviceExtension;
//
- // build new irp
+ // get an irp from fresh list
//
- Irp = IoAllocateIrp(DeviceObject->StackSize, FALSE);
+ Irp = HidClass_GetIrp(Context);
if (!Irp)
{
//
- // no memory
+ // build new irp
//
- return STATUS_INSUFFICIENT_RESOURCES;
+ Irp = IoAllocateIrp(DeviceObject->StackSize, FALSE);
+ if (!Irp)
+ {
+ //
+ // no memory
+ //
+ return STATUS_INSUFFICIENT_RESOURCES;
+ }
+ }
+ else
+ {
+ //
+ // re-use irp
+ //
+ IoReuseIrp(Irp, STATUS_SUCCESS);
}
//
return STATUS_INSUFFICIENT_RESOURCES;
}
+ //
+ // get device extension
+ //
+ PDODeviceExtension = (PHIDCLASS_PDO_DEVICE_EXTENSION)DeviceObject->DeviceExtension;
+ ASSERT(PDODeviceExtension->Common.IsFDO == FALSE);
+
+ //
+ // sanity checks
+ //
+ ASSERT(PDODeviceExtension->CollectionIndex < PDODeviceExtension->Common.DeviceDescription.CollectionDescLength);
+ ASSERT(PDODeviceExtension->CollectionIndex < PDODeviceExtension->Common.DeviceDescription.ReportIDsLength);
+ ASSERT(PDODeviceExtension->Common.DeviceDescription.ReportIDs[PDODeviceExtension->CollectionIndex].InputLength > 0);
+ ASSERT(PDODeviceExtension->Common.DeviceDescription.CollectionDesc[PDODeviceExtension->CollectionIndex].InputLength == BufferLength);
+
//
// init irp context
//
RtlZeroMemory(IrpContext, sizeof(HIDCLASS_IRP_CONTEXT));
- IrpContext->InputReportBufferLength = BufferLength;
+ IrpContext->InputReportBufferLength = PDODeviceExtension->Common.DeviceDescription.ReportIDs[PDODeviceExtension->CollectionIndex].InputLength;
IrpContext->OriginalIrp = RequestIrp;
IrpContext->FileOp = Context;
//
// allocate buffer
//
- IrpContext->InputReportBuffer = ExAllocatePool(NonPagedPool, BufferLength);
+ IrpContext->InputReportBuffer = ExAllocatePool(NonPagedPool, IrpContext->InputReportBufferLength);
if (!IrpContext->InputReportBuffer)
{
//
*OutIrp = Irp;
*OutIrpContext = IrpContext;
- DPRINT1("IRP %p Buffer %p\n", Irp, Irp->UserBuffer);
-
//
// done
//
NTSTATUS Status;
PIRP NewIrp;
PHIDCLASS_IRP_CONTEXT NewIrpContext;
+ PHIDCLASS_COMMON_DEVICE_EXTENSION CommonDeviceExtension;
//
// get current stack location
//
IoStack = IoGetCurrentIrpStackLocation(Irp);
+ //
+ // get device extension
+ //
+ CommonDeviceExtension = (PHIDCLASS_COMMON_DEVICE_EXTENSION)DeviceObject->DeviceExtension;
+ ASSERT(CommonDeviceExtension->IsFDO == FALSE);
+
//
// sanity check
//
//
ASSERT(Context->DeviceExtension->Common.DriverExtension->DevicesArePolled == FALSE);
- DPRINT1("[HIDCLASS] IRP_MJ_READ\n");
-
//
// build irp request
//
- Status = HidClass_BuildIrp(DeviceObject, Irp, Context, IOCTL_HID_READ_REPORT, IoStack->Parameters.DeviceIoControl.OutputBufferLength, &NewIrp, &NewIrpContext);
+ Status = HidClass_BuildIrp(DeviceObject, Irp, Context, IOCTL_HID_READ_REPORT, IoStack->Parameters.Read.Length, &NewIrp, &NewIrpContext);
if (!NT_SUCCESS(Status))
{
//
// lets dispatch the request
//
ASSERT(Context->DeviceExtension);
- Status = Context->DeviceExtension->Common.DriverExtension->MajorFunction[IRP_MJ_INTERNAL_DEVICE_CONTROL](DeviceObject, NewIrp);
+ Status = Context->DeviceExtension->Common.DriverExtension->MajorFunction[IRP_MJ_INTERNAL_DEVICE_CONTROL](Context->DeviceExtension->FDODeviceObject, NewIrp);
//
// complete
//
- return Status;
+ return STATUS_PENDING;
}
NTSTATUS
{
UNIMPLEMENTED
ASSERT(FALSE);
+ Irp->IoStatus.Status = STATUS_NOT_IMPLEMENTED;
+ IoCompleteRequest(Irp, IO_NO_INCREMENT);
return STATUS_NOT_IMPLEMENTED;
}
//
// dispatch to lower device object
//
- return IoCallDriver(CommonDeviceExtension->HidDeviceExtension.NextDeviceObject, Irp);
+ return IoCallDriver(CommonDeviceExtension->HidDeviceExtension.NextDeviceObject, Irp);
}
// get current stack location
//
IoStack = IoGetCurrentIrpStackLocation(Irp);
- DPRINT1("[HIDCLASS] Dispatch Major %x Minor %x\n", IoStack->MajorFunction, IoStack->MinorFunction);
+ DPRINT("[HIDCLASS] Dispatch Major %x Minor %x\n", IoStack->MajorFunction, IoStack->MinorFunction);
//
// dispatch request based on major function
// get port status
//
Status = HidUsb_GetPortStatus(ResetContext->DeviceObject, &PortStatus);
- DPRINT1("[HIDUSB] ResetWorkerRoutine GetPortStatus %x\n", Status);
+ DPRINT1("[HIDUSB] ResetWorkerRoutine GetPortStatus %x PortStatus %x\n", Status, PortStatus);
if (NT_SUCCESS(Status))
{
if (!(PortStatus & USB_PORT_STATUS_ENABLE))
//
ASSERT(KeGetCurrentIrql() == PASSIVE_LEVEL);
IoFreeWorkItem(ResetContext->WorkItem);
- ResetContext->Irp->IoStatus.Status = STATUS_SUCCESS;
IoCompleteRequest(ResetContext->Irp, IO_NO_INCREMENT);
ExFreePool(ResetContext);
}
PHID_USB_DEVICE_EXTENSION HidDeviceExtension;
PHID_DEVICE_EXTENSION DeviceExtension;
PURB Urb;
- PUCHAR Buffer;
PHID_USB_RESET_CONTEXT ResetContext;
//
Urb = (PURB)Context;
ASSERT(Urb);
+ DPRINT("[HIDUSB] HidUsb_ReadReportCompletion %p Status %x Urb Status %x\n", Irp, Irp->IoStatus, Urb->UrbHeader.Status);
+
+ if (Irp->PendingReturned)
+ {
+ //
+ // mark irp pending
+ //
+ IoMarkIrpPending(Irp);
+ }
+
//
// did the reading report succeed / cancelled
//
//
ASSERT(Urb->UrbHeader.Status == USBD_STATUS_SUCCESS);
-
- Buffer = (PUCHAR)Urb->UrbBulkOrInterruptTransfer.TransferBuffer;
- ASSERT(Urb->UrbBulkOrInterruptTransfer.TransferBufferLength == 4);
- DPRINT("[HIDUSB] ReadCompletion Information %lu Buffer %x %x %x %x\n", Buffer[0] & 0xFF, Buffer[1] & 0xFF, Buffer[2] & 0xFF, Buffer[3] & 0xFF);
-
//
// free the urb
//
//
// finish completion
//
- return STATUS_SUCCESS;
+ return STATUS_CONTINUE_COMPLETION;
}
//
//
// complete request
//
- return STATUS_SUCCESS;
+ return STATUS_CONTINUE_COMPLETION;
}
//
RtlZeroMemory(Urb, sizeof(struct _URB_BULK_OR_INTERRUPT_TRANSFER));
+ //
+ // sanity check
+ //
+ ASSERT(Irp->UserBuffer);
+ ASSERT(IoStack->Parameters.DeviceIoControl.OutputBufferLength);
+ ASSERT(PipeInformation->PipeHandle);
+
//
// build the urb
//
USBD_TRANSFER_DIRECTION_IN | USBD_SHORT_TRANSFER_OK,
NULL);
+ //
+ // store configuration handle
+ //
+ Urb->UrbHeader.UsbdDeviceHandle = HidDeviceExtension->ConfigurationHandle;
+
//
// get next location to setup irp
//
// init irp for lower driver
//
IoStack->MajorFunction = IRP_MJ_INTERNAL_DEVICE_CONTROL;
- IoStack->Parameters.Others.Argument1 = (PVOID)Urb;
IoStack->Parameters.DeviceIoControl.IoControlCode = IOCTL_INTERNAL_USB_SUBMIT_URB;
+ IoStack->Parameters.DeviceIoControl.InputBufferLength = 0;
+ IoStack->Parameters.DeviceIoControl.OutputBufferLength = 0;
+ IoStack->Parameters.DeviceIoControl.Type3InputBuffer = NULL;
+ IoStack->Parameters.Others.Argument1 = (PVOID)Urb;
+
//
// set completion routine
}
case IOCTL_HID_READ_REPORT:
{
- DPRINT1("[HIDUSB] IOCTL_HID_READ_REPORT\n");
+ DPRINT("[HIDUSB] IOCTL_HID_READ_REPORT\n");
Status = HidUsb_ReadReport(DeviceObject, Irp);
return Status;
}
//
IoStack->Parameters.Others.Argument1 = (PVOID)Urb;
+ //
+ // set completion routine
+ //
+ IoSetCompletionRoutine(Irp, Hid_PnpCompletion, (PVOID)&Event, TRUE, TRUE, TRUE);
+
//
// call driver
//
// select configuration
//
Status = Hid_SelectConfiguration(DeviceObject);
+ ASSERT(Status == STATUS_SUCCESS);
//
// done