mirror of
https://github.com/reactos/reactos.git
synced 2025-02-24 17:34:57 +00:00
Another rewrite of the mouse detection code by Logan_V8_TT with minor changes by me to get it really working with my mouse. This version should solve the problem where the mouse wasn't moving and also the conflicts with serial port debugging.
svn path=/trunk/; revision=7806
This commit is contained in:
Filip Navara
parent
5844d90709
commit
cad98f04c0
1 changed files with 77 additions and 62 deletions
|
|
@ -375,61 +375,67 @@ VOID SerialMouseIsrDpc(PKDPC Dpc, PDEVICE_OBJECT DeviceObject, PIRP Irp, PVOID C
|
|||
DeviceExtension->InputDataCount[Queue] = 0;
|
||||
}
|
||||
|
||||
void InitializeSerialPort(ULONG Port, unsigned int LineControl)
|
||||
void InitializeSerialPort(ULONG Port)
|
||||
{
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 3, 0x80); /* set DLAB on */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port, 0x60); /* speed LO byte */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 1, 0); /* speed HI byte */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 3, LineControl);
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 1, 0); /* set comm and DLAB to 0 */
|
||||
ULONG LineControl;
|
||||
|
||||
/* Read old value from line control register */
|
||||
LineControl = READ_PORT_UCHAR((PUCHAR)Port + 3);
|
||||
/* NOT SURE WHAT IS THIS SUPPOSED TO DO! */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 1, 0);
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 2, 0);
|
||||
/* Set DLAB on */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 3, 0x80);
|
||||
/* Set serial port speed */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port, 0x60);
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 1, 0);
|
||||
/* Set DLAB off and restore the old value of line control reg. */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 3, LineControl & ~0x80);
|
||||
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 4, 0x09); /* DR int enable */
|
||||
(void) READ_PORT_UCHAR((PUCHAR)Port + 5); /* clear error bits */
|
||||
KeStallExecutionProcessor(150000); /* Wait > 100 ms */
|
||||
}
|
||||
|
||||
ULONG DetectMicrosoftMouse(ULONG Port)
|
||||
{
|
||||
/*
|
||||
* Detection method number two. CuteMouse (GPL DOS Mouse driver
|
||||
* cutemouse.sourceforge.net) assembler port to C by Logan_V8_TT
|
||||
*/
|
||||
|
||||
CHAR Buffer[4];
|
||||
ULONG i;
|
||||
ULONG TimeOut = 250;
|
||||
UCHAR LineControl;
|
||||
UCHAR LCR, MCR;
|
||||
|
||||
/* Save original control */
|
||||
LineControl = READ_PORT_UCHAR((PUCHAR)Port + 4);
|
||||
/* Save original LCR/MCR */
|
||||
LCR = READ_PORT_UCHAR((PUCHAR)Port + 3); /* LCR (line ctrl reg) */
|
||||
MCR = READ_PORT_UCHAR((PUCHAR)Port + 4); /* MCR (modem ctrl reg) */
|
||||
|
||||
/* Inactivate RTS and set DTR */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 4, (LineControl & ~0x02) | 0x01);
|
||||
/* Reset UART */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 4, 0); /* MCR: DTR/RTS/OUT2 off */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 2, 0); /* FCR: disable FIFO */
|
||||
KeStallExecutionProcessor(150000); /* Wait > 100 ms */
|
||||
|
||||
/* Clear buffer */
|
||||
/* Set communications parameters */
|
||||
InitializeSerialPort(Port);
|
||||
|
||||
/* Enable DTR/RTS (OUT2 disabled) */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 4, 3);
|
||||
|
||||
/* Discard serial buffer data */
|
||||
while (READ_PORT_UCHAR((PUCHAR)Port + 5) & 0x01)
|
||||
(void)READ_PORT_UCHAR((PUCHAR)Port);
|
||||
KeStallExecutionProcessor(100000); /* Wait */
|
||||
|
||||
/*
|
||||
* Send modem control with 'Data Terminal Ready' and 'Request To Send'
|
||||
* message. This enables mouse to identify.
|
||||
*/
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 4, 0x03);
|
||||
|
||||
/* Wait 10 milliseconds for the mouse getting ready */
|
||||
KeStallExecutionProcessor(10000);
|
||||
|
||||
/* Read first four bytes, which contains Microsoft Mouse signs */
|
||||
/* Read the data */
|
||||
for (i = 0; i < 4; i++)
|
||||
{
|
||||
while (((READ_PORT_UCHAR((PUCHAR)Port + 5) & 1) == 0) && (TimeOut > 0))
|
||||
{
|
||||
KeStallExecutionProcessor(1000);
|
||||
--TimeOut;
|
||||
if (TimeOut == 0)
|
||||
return MOUSE_TYPE_NONE;
|
||||
}
|
||||
Buffer[i] = READ_PORT_UCHAR((PUCHAR)Port);
|
||||
}
|
||||
|
||||
/* Restore control */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 4, LineControl);
|
||||
/* Restore LCR/MCR */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 3, LCR); /* LCR (line ctrl reg) */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 4, MCR); /* MCR (modem ctrl reg) */
|
||||
|
||||
/* Check that four bytes for signs */
|
||||
for (i = 0; i < 4; ++i)
|
||||
{
|
||||
/* Sign for Microsoft Ballpoint */
|
||||
|
|
@ -464,6 +470,7 @@ ULONG DetectMicrosoftMouse(ULONG Port)
|
|||
}
|
||||
|
||||
return MOUSE_TYPE_NONE;
|
||||
|
||||
}
|
||||
|
||||
PDEVICE_OBJECT
|
||||
|
|
@ -541,16 +548,23 @@ InitializeMouse(ULONG Port, ULONG Irq, PDRIVER_OBJECT DriverObject)
|
|||
ULONG MouseType;
|
||||
|
||||
/* Try to detect mouse on specified port */
|
||||
InitializeSerialPort(Port, 2);
|
||||
MouseType = DetectMicrosoftMouse(Port);
|
||||
|
||||
/* Enable interrupts */
|
||||
WRITE_PORT_UCHAR((PUCHAR)(Port) + 1, 1);
|
||||
ClearMouse(Port);
|
||||
|
||||
/* No mouse, no need to continue */
|
||||
if (MouseType == MOUSE_TYPE_NONE)
|
||||
{
|
||||
WRITE_PORT_UCHAR((PUCHAR)(Port) + 1, 1);
|
||||
InitializeSerialPort(Port);
|
||||
return FALSE;
|
||||
}
|
||||
|
||||
/* Enable interrupts */
|
||||
WRITE_PORT_UCHAR((PUCHAR)(Port) + 1, 1);
|
||||
|
||||
ClearMouse(Port);
|
||||
|
||||
/* Enable RTS, DTR and OUT2 */
|
||||
WRITE_PORT_UCHAR((PUCHAR)Port + 4, 0x0b);
|
||||
|
||||
/* Allocate new device */
|
||||
DeviceObject = AllocatePointerDevice(DriverObject);
|
||||
|
|
@ -559,6 +573,7 @@ InitializeMouse(ULONG Port, ULONG Irq, PDRIVER_OBJECT DriverObject)
|
|||
DbgPrint("Oops, couldn't creat device object.\n");
|
||||
return FALSE;
|
||||
}
|
||||
|
||||
DeviceExtension = DeviceObject->DeviceExtension;
|
||||
|
||||
/* Setup device extension structure */
|
||||
|
|
|
|||
Loading…
Reference in a new issue