reactos/drivers/input/psaux/psaux.c

   1 /*
   2
   3  ** PS/2 driver 0.0.1
   4  ** Written by Jason Filby (jasonfilby@yahoo.com)
   5  ** For ReactOS (www.reactos.com)
   6
   7  ** Handles the keyboard and mouse on the PS/2 ports
   8
   9  ** TODO: Fix detect_ps2_port(void) so that it works under BOCHs
  10           Implement mouse button support
  11
  12 */
  13
  14 #include <ddk/ntddk.h>
  15 #include "../include/mouse.h"
  16 #include "mouse.h"
  17 #include "psaux.h"
  18
  19 BOOLEAN STDCALL
  20 MouseSynchronizeRoutine(PVOID Context)
  21 {
  22    PIRP Irp = (PIRP)Context;
  23    PMOUSE_INPUT_DATA rec  = (PMOUSE_INPUT_DATA)Irp->AssociatedIrp.SystemBuffer;
  24    PIO_STACK_LOCATION stk = IoGetCurrentIrpStackLocation(Irp);
  25    ULONG NrToRead         = stk->Parameters.Read.Length/sizeof(MOUSE_INPUT_DATA);
  26    int i;
  27
  28    if ((stk->Parameters.Read.Length/sizeof(MOUSE_INPUT_DATA))==NrToRead)
  29    {
  30       return(TRUE);
  31    }
  32
  33    MouseDataRequired=stk->Parameters.Read.Length/sizeof(MOUSE_INPUT_DATA);
  34    MouseDataRead=NrToRead;
  35    CurrentIrp=Irp;
  36
  37    return(FALSE);
  38 }
  39
  40 VOID STDCALL
  41 PS2MouseStartIo(PDEVICE_OBJECT DeviceObject, PIRP Irp)
  42 {
  43    PDEVICE_EXTENSION DeviceExtension = DeviceObject->DeviceExtension;
  44
  45    if (KeSynchronizeExecution(DeviceExtension->MouseInterrupt, MouseSynchronizeRoutine, Irp))
  46      {
  47         Irp->IoStatus.Status = STATUS_SUCCESS;
  48         Irp->IoStatus.Information = 0;
  49         IoCompleteRequest(Irp, IO_NO_INCREMENT);
  50         IoStartNextPacket(DeviceObject, FALSE);
  51      }
  52 }
  53
  54 NTSTATUS STDCALL
  55 PS2MouseDispatch(PDEVICE_OBJECT DeviceObject, PIRP Irp)
  56 {
  57    PIO_STACK_LOCATION stk = IoGetCurrentIrpStackLocation(Irp);
  58    NTSTATUS Status;
  59
  60    switch (stk->MajorFunction)
  61      {
  62       case IRP_MJ_CREATE:
  63         if (AlreadyOpened == TRUE)
  64           {
  65              Status = STATUS_SUCCESS;
  66           }
  67         else
  68           {
  69              Status = STATUS_SUCCESS;
  70              AlreadyOpened = TRUE;
  71           }
  72         break;
  73
  74       case IRP_MJ_CLOSE:
  75         Status = STATUS_SUCCESS;
  76         break;
  77
  78       default:
  79         DbgPrint("NOT IMPLEMENTED\n");
  80         Status = STATUS_NOT_IMPLEMENTED;
  81         break;
  82      }
  83
  84    if (Status==STATUS_PENDING)
  85      {
  86         IoMarkIrpPending(Irp);
  87      }
  88    else
  89      {
  90         Irp->IoStatus.Status = Status;
  91         Irp->IoStatus.Information = 0;
  92         IoCompleteRequest(Irp,IO_NO_INCREMENT);
  93      }
  94    return(Status);
  95 }
  96
  97 VOID PS2MouseInitializeDataQueue(PVOID Context)
  98 {
  99 }
 100
 101 NTSTATUS STDCALL
 102 PS2MouseInternalDeviceControl(IN PDEVICE_OBJECT DeviceObject, IN PIRP Irp)
 103 {
 104    PDEVICE_EXTENSION DeviceExtension = DeviceObject->DeviceExtension;
 105    PIO_STACK_LOCATION Stack = IoGetCurrentIrpStackLocation(Irp);
 106    NTSTATUS status;
 107
 108    switch(Stack->Parameters.DeviceIoControl.IoControlCode)
 109    {
 110       case IOCTL_INTERNAL_MOUSE_CONNECT:
 111
 112          DeviceExtension->ClassInformation =
 113             *((PCLASS_INFORMATION)Stack->Parameters.DeviceIoControl.Type3InputBuffer);
 114
 115          // Reinitialize the port input data queue synchronously
 116          KeSynchronizeExecution(DeviceExtension->MouseInterrupt,
 117             (PKSYNCHRONIZE_ROUTINE)PS2MouseInitializeDataQueue, DeviceExtension);
 118
 119          status = STATUS_SUCCESS;
 120          break;
 121
 122       default:
 123          status = STATUS_INVALID_DEVICE_REQUEST;
 124          break;
 125    }
 126
 127    Irp->IoStatus.Status = status;
 128    if (status == STATUS_PENDING) {
 129       IoMarkIrpPending(Irp);
 130       IoStartPacket(DeviceObject, Irp, NULL, NULL);
 131    } else {
 132       IoCompleteRequest(Irp, IO_NO_INCREMENT);
 133    }
 134
 135    return status;
 136 }
 137
 138 VOID PS2MouseIsrDpc(PKDPC Dpc, PDEVICE_OBJECT DeviceObject, PIRP Irp, PVOID Context)
 139 {
 140    PDEVICE_EXTENSION DeviceExtension = DeviceObject->DeviceExtension;
 141    ULONG Queue;
 142
 143    Queue = DeviceExtension->ActiveQueue % 2;
 144    InterlockedIncrement(&DeviceExtension->ActiveQueue);
 145    (*(PSERVICE_CALLBACK_ROUTINE)DeviceExtension->ClassInformation.CallBack)(
 146                         DeviceExtension->ClassInformation.DeviceObject,
 147                         DeviceExtension->MouseInputData[Queue],
 148                         NULL,
 149                         &DeviceExtension->InputDataCount[Queue]);
 150    DeviceExtension->InputDataCount[Queue] = 0;
 151 }
 152
 153 NTSTATUS STDCALL
 154 DriverEntry(PDRIVER_OBJECT DriverObject, PUNICODE_STRING RegistryPath)
 155 {
 156    PDEVICE_OBJECT DeviceObject;
 157    UNICODE_STRING DeviceName;
 158    UNICODE_STRING SymlinkName;
 159    PDEVICE_EXTENSION DeviceExtension;
 160
 161    if (detect_ps2_port() == TRUE) {
 162      DbgPrint("PS2 Port Driver version 0.0.1\n");
 163    } else {
 164      DbgPrint("PS2 port not found.\n");
 165      return STATUS_UNSUCCESSFUL;
 166    }
 167
 168    DriverObject->MajorFunction[IRP_MJ_CREATE] = PS2MouseDispatch;
 169    DriverObject->MajorFunction[IRP_MJ_CLOSE]  = PS2MouseDispatch;
 170    DriverObject->MajorFunction[IRP_MJ_INTERNAL_DEVICE_CONTROL] = PS2MouseInternalDeviceControl;
 171    DriverObject->DriverStartIo                = PS2MouseStartIo;
 172
 173    RtlInitUnicodeStringFromLiteral(&DeviceName,
 174                                    L"\\Device\\Mouse"); // FIXME: find correct device name
 175    IoCreateDevice(DriverObject,
 176                   sizeof(DEVICE_EXTENSION),
 177                   &DeviceName,
 178                   FILE_DEVICE_SERIAL_MOUSE_PORT, // FIXME: this isn't really a serial mouse port driver
 179                   0,
 180                   TRUE,
 181                   &DeviceObject);
 182    DeviceObject->Flags = DeviceObject->Flags | DO_BUFFERED_IO;
 183
 184    RtlInitUnicodeStringFromLiteral(&SymlinkName,
 185                                    L"\\??\\Mouse"); // FIXME: find correct device name
 186    IoCreateSymbolicLink(&SymlinkName, &DeviceName);
 187
 188    DeviceExtension = DeviceObject->DeviceExtension;
 189    KeInitializeDpc(&DeviceExtension->IsrDpc, (PKDEFERRED_ROUTINE)PS2MouseIsrDpc, DeviceObject);
 190
 191    mouse_init(DeviceObject);
 192
 193    return(STATUS_SUCCESS);
 194 }