Major additions to usb stack:

1) Improve hardware support in linux_wrapper
2) Add embedded drivers, register them in linux usb stack
3) Add working wrapper for keyboard and mouse devices - now if usbohci or uhci loads, it will be the first to create KeyboardClass0 and PointerClass0 devices, so PS/2 keyb/mouse won't work.
4) Added logic for registering miniport at port driver (like Windows' usb stack does)

Bad things:
1) "multithreading" is still done not the proper way, but ugly way
2) under xbox xpad doesn't work
3) it must be wasting lots of CPU power now, since hub thread doesn't block while waiting for events

svn path=/trunk/; revision=17351
This commit is contained in:
Aleksey Bragin 2005-08-12 20:21:22 +00:00
parent c79bfba64d
commit 39007f77e2
15 changed files with 427 additions and 42 deletions

View file

@ -33,7 +33,7 @@
#include <linux/usb.h>
#include "hcd.h"
#else
#define DEBUG
#include "../usb_wrapper.h"
#include "hcd.h"
#endif
@ -193,6 +193,10 @@ clean_3:
if ((retval = driver->start (hcd)) < 0)
usb_hcd_pci_remove (dev);
//ReactOS-specific: Init core drivers here
UsbKeyBoardInit();
UsbMouseInit();
return retval;
}
EXPORT_SYMBOL (usb_hcd_pci_probe);

View file

@ -7,7 +7,6 @@
* (C) Copyright 2001 Brad Hards (bhards@bigpond.net.au)
*
*/
#define DEBUG
#if 0
#include <linux/config.h>
#include <linux/kernel.h>
@ -34,11 +33,13 @@
#include "hcd.h"
#include "hub.h"
#else
#include "../usb_wrapper.h"
#include "hcd.h"
#include "hub.h"
#define DEBUG
#endif
/* Wakes up khubd */
@ -152,7 +153,7 @@ static void hub_irq(struct urb *urb, struct pt_regs *regs)
default: /* presumably an error */
/* Cause a hub reset after 10 consecutive errors */
//printe("hub_irq got ...: error %d URB: %d",hub->error,urb->status);
printk("hub_irq got ...: error %d URB: %d",hub->error,urb->status);
dev_dbg (&hub->intf->dev, "transfer --> %d\n", urb->status);
if ((++hub->nerrors < 10) || hub->error)
@ -379,8 +380,8 @@ static int hub_configure(struct usb_hub *hub,
goto fail;
} else if (hub->descriptor->bNbrPorts > USB_MAXCHILDREN) {
message = "hub has too many ports!";
ret = -ENODEV;
goto fail;
// XBOX PATCH hub->descriptor->bNbrPorts = 4; //ret = -ENODEV;
//goto fail;
}
hub_dev = hubdev(dev);
@ -517,6 +518,7 @@ static int hub_configure(struct usb_hub *hub,
/* Wake up khubd */
wake_up(&khubd_wait);
printk("hub_thread should woke up\n");
hub_power_on(hub);
@ -597,7 +599,7 @@ static int hub_probe(struct usb_interface *intf, const struct usb_device_id *id)
/* specs is not defined, but it works */
if ((desc->desc.bInterfaceSubClass != 0) &&
(desc->desc.bInterfaceSubClass != 1)) {
descriptor_error:
//descriptor_error:
desc->desc.bInterfaceSubClass =0;
dev_err (&intf->dev, "bad descriptor, ignoring hub\n");
//return -EIO;
@ -1208,6 +1210,8 @@ static void hub_events(void)
// ReactOS: STDCALL is needed here
static int STDCALL hub_thread(void *__hub)
{
//LARGE_INTEGER delay;
/*
* This thread doesn't need any user-level access,
* so get rid of all our resources
@ -1219,6 +1223,11 @@ static int STDCALL hub_thread(void *__hub)
// Initialize khubd spinlock
KeInitializeSpinLock((PKSPIN_LOCK)&hub_event_lock);
//delay.QuadPart = -10000000*5; // wait 5 seconds before powering up
//KeDelayExecutionThread(KernelMode, FALSE, &delay); //wait_us(1);
printk("hub_thread starting");
/* Send me a signal to get me die (for debugging) */
do {
LARGE_INTEGER delay;
@ -1226,7 +1235,7 @@ static int STDCALL hub_thread(void *__hub)
/* The following is just for debug */
inc_jiffies(1);
do_all_timers();
handle_irqs(-1);
//handle_irqs(-1);
/* End of debug hack*/
hub_events();
/* The following is just for debug */

View file

@ -40,7 +40,7 @@ static int usb_start_wait_urb(struct urb *urb, int timeout, int* actual_length)
struct usb_api_data awd;
int status;
printk("usb_start_wait_urb(): urb devnum=%d, timeout=%d, urb->actual_length=%d\n", urb->dev->devnum, timeout, urb->actual_length);
//printk("usb_start_wait_urb(): urb devnum=%d, timeout=%d, urb->actual_length=%d\n", urb->dev->devnum, timeout, urb->actual_length);
init_waitqueue_head((PKEVENT)&awd.wqh);
awd.done = 0;
@ -58,7 +58,7 @@ static int usb_start_wait_urb(struct urb *urb, int timeout, int* actual_length)
remove_wait_queue(&awd.wqh, &wait);
return status;
}
printk("TRACE 3.1, timeout=%d, awd.done=%d\n", timeout, awd.done);
//printk("TRACE 3.1, timeout=%d, awd.done=%d\n", timeout, awd.done);
while (timeout && !awd.done)
{
timeout = schedule_timeout(timeout);
@ -156,7 +156,7 @@ int usb_control_msg(struct usb_device *dev, unsigned int pipe, __u8 request, __u
dr->wIndex = cpu_to_le16p(&index);
dr->wLength = cpu_to_le16p(&size);
printk("usb_control_msg: devnum=%d, size=%d, timeout=%d\n", dev->devnum, size, timeout);
//printk("usb_control_msg: devnum=%d, size=%d, timeout=%d\n", dev->devnum, size, timeout);
ret = usb_internal_control_msg(dev, pipe, dr, data, size, timeout);
kfree(dr);

View file

@ -201,8 +201,8 @@ int STDCALL usb_submit_urb(struct urb *urb, int mem_flags)
struct usb_device *dev;
struct usb_operations *op;
int is_out;
printk("sub dev %p bus %p num %i op %p sub %p\n",
urb->dev, urb->dev->bus,urb->dev->devnum,urb->dev->bus->op, urb->dev->bus->op->submit_urb);
//printk("sub dev %p bus %p num %i op %p sub %p\n",
// urb->dev, urb->dev->bus,urb->dev->devnum,urb->dev->bus->op, urb->dev->bus->op->submit_urb);
if (!urb || urb->hcpriv || !urb->complete)
return -EINVAL;
if (!(dev = urb->dev) ||

View file

@ -54,8 +54,6 @@
#include "hcd.h"
#endif
#define DEBUG
extern int usb_hub_init(void);
extern void usb_hub_cleanup(void);
extern int usb_major_init(void);

View file

@ -5,6 +5,17 @@
#include <ddk/ntddk.h>
#include <debug.h>
#include "../usb_wrapper.h"
USBPORT_INTERFACE UsbPortInterface;
void STDCALL RegisterPortDriver(PDRIVER_OBJECT pDrvObj, PUSBPORT_INTERFACE pUsbPortIntf)
{
// copy struct to global var
DPRINT("Miniport 0x%08X registered\n", (ULONG)pDrvObj);
memcpy(&UsbPortInterface.KbdConnectData, &pUsbPortIntf->KbdConnectData, sizeof(CONNECT_DATA));
memcpy(&UsbPortInterface.MouseConnectData, &pUsbPortIntf->MouseConnectData, sizeof(CONNECT_DATA));
}
NTSTATUS STDCALL
AddDevice(PDRIVER_OBJECT DriverObject, PDEVICE_OBJECT pdo)

View file

@ -29,4 +29,5 @@ usb_connect@4
usb_put_dev@4
usb_disabled@0
usb_hcd_pci_probe@8
usb_hcd_pci_remove@4
usb_hcd_pci_remove@4
RegisterPortDriver@8

View file

@ -2,6 +2,7 @@
<importlibrary definition="usbcore.def" />
<define name="__USE_W32API" />
<define name="DEBUG_MODE" />
<define name="DEBUG" />
<include base="ntoskrnl">include</include>
<library>sys_base</library>
<library>ntoskrnl</library>
@ -16,5 +17,8 @@
<file>buffer_simple.c</file>
<file>usb-debug.c</file>
<file>usbcore.c</file>
<file>core_drivers/usbkey.c</file>
<file>core_drivers/usbmouse.c</file>
<file>usbcore.rc</file>
</module>

View file

@ -5,6 +5,9 @@
*/
#include <ddk/ntddk.h>
#include <ddk/ntddkbd.h>
#include <ddk/ntdd8042.h>
#include <debug.h>
#include "../usb_wrapper.h"
#include "../core/hcd.h"
@ -20,14 +23,74 @@ extern struct pci_driver ohci_pci_driver;
extern const struct pci_device_id pci_ids[];
// This should be removed, but for testing purposes it's here
struct pci_dev *dev;
//struct pci_device_id *dev_id;
static bool xbox_workaround=false;
// data for embedded drivers
CONNECT_DATA KbdClassInformation;
CONNECT_DATA MouseClassInformation;
PDEVICE_OBJECT KeyboardFdo = NULL;
PDEVICE_OBJECT MouseFdo = NULL;
#define USB_OHCI_TAG TAG('u','s','b','o')
NTSTATUS AddDevice_Keyboard(PDRIVER_OBJECT DriverObject, PDEVICE_OBJECT pdo)
{
UNICODE_STRING DeviceName = RTL_CONSTANT_STRING(L"\\Device\\KeyboardClass0");
PDEVICE_OBJECT fdo;
NTSTATUS Status;
Status = IoCreateDevice(DriverObject,
8, // debug
&DeviceName,
FILE_DEVICE_KEYBOARD,
FILE_DEVICE_SECURE_OPEN,
TRUE,
&fdo);
if (!NT_SUCCESS(Status))
{
DPRINT1("IoCreateDevice for usb keyboard driver failed\n");
return Status;
}
KeyboardFdo = fdo;
fdo->Flags &= ~DO_DEVICE_INITIALIZING;
DPRINT1("Created keyboard fdo: %p\n", fdo);
return STATUS_SUCCESS;
}
NTSTATUS AddDevice_Mouse(PDRIVER_OBJECT DriverObject, PDEVICE_OBJECT pdo)
{
UNICODE_STRING DeviceName = RTL_CONSTANT_STRING(L"\\Device\\PointerClass0");
PDEVICE_OBJECT fdo;
NTSTATUS Status;
Status = IoCreateDevice(DriverObject,
8, // debug
&DeviceName,
FILE_DEVICE_MOUSE,
FILE_DEVICE_SECURE_OPEN,
TRUE,
&fdo);
if (!NT_SUCCESS(Status))
{
DPRINT1("IoCreateDevice for usb mouse driver failed\n");
return Status;
}
MouseFdo = fdo;
fdo->Flags &= ~DO_DEVICE_INITIALIZING;
DPRINT1("Created mouse fdo: %p\n", fdo);
return STATUS_SUCCESS;
}
NTSTATUS STDCALL AddDevice(PDRIVER_OBJECT DriverObject, PDEVICE_OBJECT pdo)
{
PDEVICE_OBJECT fdo;
@ -40,6 +103,11 @@ NTSTATUS STDCALL AddDevice(PDRIVER_OBJECT DriverObject, PDEVICE_OBJECT pdo)
DPRINT1("ohci: AddDevice called\n");
if (xbox_workaround)
return STATUS_INSUFFICIENT_RESOURCES; // Fail for any other host controller than the first
xbox_workaround = true;
// Allocate driver extension now
DriverExtension = IoGetDriverObjectExtension(DriverObject, DriverObject);
if (DriverExtension == NULL)
@ -105,9 +173,15 @@ NTSTATUS STDCALL AddDevice(PDRIVER_OBJECT DriverObject, PDEVICE_OBJECT pdo)
}
DPRINT("Done AddDevice\n");
return STATUS_SUCCESS;
// create embedded keyboard driver
Status = AddDevice_Keyboard(DriverObject, pdo);
Status = AddDevice_Mouse(DriverObject, pdo);
return Status;
}
VOID STDCALL DriverUnload(PDRIVER_OBJECT DriverObject)
{
DPRINT1("DriverUnload()\n");
@ -196,6 +270,9 @@ OHCD_PnPStartDevice(IN PDEVICE_OBJECT DeviceObject,
NTSTATUS Status; // debug
LONGLONG delay; // debug
if (DeviceObject == KeyboardFdo || DeviceObject == MouseFdo)
return STATUS_SUCCESS;
/*
* Get the initialization data we saved in VideoPortInitialize.
*/
@ -264,10 +341,12 @@ OHCD_PnPStartDevice(IN PDEVICE_OBJECT DeviceObject,
* Init wrapper with this object
*/
//return InitLinuxWrapper(DeviceObject);
// debug wait
Status = InitLinuxWrapper(DeviceObject);
delay = -10000000*60*2; // wait 2 minutes
KeDelayExecutionThread(KernelMode, FALSE, (LARGE_INTEGER *)&delay); //wait_us(1);
//delay = -10000000*30; // wait 30 secs
//KeDelayExecutionThread(KernelMode, FALSE, (LARGE_INTEGER *)&delay); //wait_us(1);
return Status;
}
@ -280,6 +359,9 @@ NTSTATUS STDCALL DispatchPnp(PDEVICE_OBJECT DeviceObject, PIRP Irp)
IrpSp = IoGetCurrentIrpStackLocation(Irp);
DPRINT("PNP for %p, minorfunc=0x%x\n", DeviceObject, IrpSp->MinorFunction);
switch (IrpSp->MinorFunction)
{
case IRP_MN_START_DEVICE:
@ -331,16 +413,254 @@ NTSTATUS STDCALL DispatchPower(PDEVICE_OBJECT fido, PIRP Irp)
return STATUS_SUCCESS;
}
NTSTATUS STDCALL UsbCoreDispatch(PDEVICE_OBJECT DeviceObject, PIRP Irp)
{
ULONG MajorFunction = IoGetCurrentIrpStackLocation(Irp)->MajorFunction;
DPRINT("usbohci: Dispatching major function 0x%lx\n", MajorFunction);
IoCompleteRequest (Irp, IO_NO_INCREMENT);
return STATUS_SUCCESS;
}
NTSTATUS STDCALL UsbCoreInternalDeviceControl(PDEVICE_OBJECT DeviceObject, PIRP Irp)
{
NTSTATUS Status = STATUS_INVALID_DEVICE_REQUEST;
DPRINT("INT_IOCTL for %p, code=0x%x\n", DeviceObject, IoGetCurrentIrpStackLocation(Irp)->Parameters.DeviceIoControl.IoControlCode);
if (DeviceObject == KeyboardFdo)
{
// it's keyboard's IOCTL
PIO_STACK_LOCATION Stk;
Irp->IoStatus.Information = 0;
Stk = IoGetCurrentIrpStackLocation(Irp);
switch (Stk->Parameters.DeviceIoControl.IoControlCode) {
case IOCTL_INTERNAL_KEYBOARD_CONNECT:
DPRINT("IOCTL_INTERNAL_KEYBOARD_CONNECT\n");
if (Stk->Parameters.DeviceIoControl.InputBufferLength < sizeof(CONNECT_DATA)) {
DPRINT1("Keyboard IOCTL_INTERNAL_KEYBOARD_CONNECT "
"invalid buffer size\n");
Irp->IoStatus.Status = STATUS_INVALID_PARAMETER;
goto intcontfailure;
}
memcpy(&KbdClassInformation,
Stk->Parameters.DeviceIoControl.Type3InputBuffer,
sizeof(CONNECT_DATA));
Irp->IoStatus.Status = STATUS_SUCCESS;
break;
case IOCTL_INTERNAL_I8042_KEYBOARD_WRITE_BUFFER:
DPRINT("IOCTL_INTERNAL_I8042_KEYBOARD_WRITE_BUFFER\n");
if (Stk->Parameters.DeviceIoControl.InputBufferLength < 1) {
Irp->IoStatus.Status = STATUS_INVALID_PARAMETER;
goto intcontfailure;
}
/* if (!DevExt->KeyboardInterruptObject) {
Irp->IoStatus.Status = STATUS_DEVICE_NOT_READY;
goto intcontfailure;
}*/
Irp->IoStatus.Status = STATUS_SUCCESS;
break;
case IOCTL_KEYBOARD_QUERY_ATTRIBUTES:
DPRINT("IOCTL_KEYBOARD_QUERY_ATTRIBUTES\n");
if (Stk->Parameters.DeviceIoControl.OutputBufferLength <
sizeof(KEYBOARD_ATTRIBUTES)) {
DPRINT("Keyboard IOCTL_KEYBOARD_QUERY_ATTRIBUTES "
"invalid buffer size\n");
Irp->IoStatus.Status = STATUS_BUFFER_TOO_SMALL;
goto intcontfailure;
}
/*memcpy(Irp->AssociatedIrp.SystemBuffer,
&DevExt->KeyboardAttributes,
sizeof(KEYBOARD_ATTRIBUTES));*/
Irp->IoStatus.Status = STATUS_SUCCESS;
break;
case IOCTL_KEYBOARD_QUERY_INDICATORS:
DPRINT("IOCTL_KEYBOARD_QUERY_INDICATORS\n");
if (Stk->Parameters.DeviceIoControl.OutputBufferLength <
sizeof(KEYBOARD_INDICATOR_PARAMETERS)) {
DPRINT("Keyboard IOCTL_KEYBOARD_QUERY_INDICATORS "
"invalid buffer size\n");
Irp->IoStatus.Status = STATUS_BUFFER_TOO_SMALL;
goto intcontfailure;
}
/*memcpy(Irp->AssociatedIrp.SystemBuffer,
&DevExt->KeyboardIndicators,
sizeof(KEYBOARD_INDICATOR_PARAMETERS));*/
Irp->IoStatus.Status = STATUS_SUCCESS;
break;
case IOCTL_KEYBOARD_QUERY_TYPEMATIC:
DPRINT("IOCTL_KEYBOARD_QUERY_TYPEMATIC\n");
if (Stk->Parameters.DeviceIoControl.OutputBufferLength <
sizeof(KEYBOARD_TYPEMATIC_PARAMETERS)) {
DPRINT("Keyboard IOCTL_KEYBOARD_QUERY_TYPEMATIC "
"invalid buffer size\n");
Irp->IoStatus.Status = STATUS_BUFFER_TOO_SMALL;
goto intcontfailure;
}
/*memcpy(Irp->AssociatedIrp.SystemBuffer,
&DevExt->KeyboardTypematic,
sizeof(KEYBOARD_TYPEMATIC_PARAMETERS));*/
Irp->IoStatus.Status = STATUS_SUCCESS;
break;
case IOCTL_KEYBOARD_SET_INDICATORS:
DPRINT("IOCTL_KEYBOARD_SET_INDICATORS\n");
if (Stk->Parameters.DeviceIoControl.InputBufferLength <
sizeof(KEYBOARD_INDICATOR_PARAMETERS)) {
DPRINT("Keyboard IOCTL_KEYBOARD_SET_INDICTATORS "
"invalid buffer size\n");
Irp->IoStatus.Status = STATUS_BUFFER_TOO_SMALL;
goto intcontfailure;
}
/*memcpy(&DevExt->KeyboardIndicators,
Irp->AssociatedIrp.SystemBuffer,
sizeof(KEYBOARD_INDICATOR_PARAMETERS));*/
//DPRINT("%x\n", DevExt->KeyboardIndicators.LedFlags);
Irp->IoStatus.Status = STATUS_SUCCESS;
break;
case IOCTL_KEYBOARD_SET_TYPEMATIC:
DPRINT("IOCTL_KEYBOARD_SET_TYPEMATIC\n");
if (Stk->Parameters.DeviceIoControl.InputBufferLength <
sizeof(KEYBOARD_TYPEMATIC_PARAMETERS)) {
DPRINT("Keyboard IOCTL_KEYBOARD_SET_TYPEMATIC "
"invalid buffer size\n");
Irp->IoStatus.Status = STATUS_BUFFER_TOO_SMALL;
goto intcontfailure;
}
/*memcpy(&DevExt->KeyboardTypematic,
Irp->AssociatedIrp.SystemBuffer,
sizeof(KEYBOARD_TYPEMATIC_PARAMETERS));*/
Irp->IoStatus.Status = STATUS_SUCCESS;
break;
case IOCTL_KEYBOARD_QUERY_INDICATOR_TRANSLATION:
/* We should check the UnitID, but it's kind of pointless as
* all keyboards are supposed to have the same one
*/
#if 0
if (Stk->Parameters.DeviceIoControl.OutputBufferLength <
sizeof(LOCAL_KEYBOARD_INDICATOR_TRANSLATION)) {
DPRINT("IOCTL_KEYBOARD_QUERY_INDICATOR_TRANSLATION: "
"invalid buffer size (expected)\n");
/* It's to query the buffer size */
Irp->IoStatus.Status = STATUS_BUFFER_TOO_SMALL;
goto intcontfailure;
}
Irp->IoStatus.Information =
sizeof(LOCAL_KEYBOARD_INDICATOR_TRANSLATION);
#endif
/*memcpy(Irp->AssociatedIrp.SystemBuffer,
&IndicatorTranslation,
sizeof(LOCAL_KEYBOARD_INDICATOR_TRANSLATION));*/
Irp->IoStatus.Status = STATUS_SUCCESS;
break;
case IOCTL_INTERNAL_I8042_HOOK_KEYBOARD:
/* Nothing to do here */
Irp->IoStatus.Status = STATUS_SUCCESS;
break;
default:
Irp->IoStatus.Status = STATUS_INVALID_DEVICE_REQUEST;
break;
}
intcontfailure:
Status = Irp->IoStatus.Status;
}
else if (DeviceObject == MouseFdo)
{
// it's mouse's IOCTL
PIO_STACK_LOCATION Stk;
Irp->IoStatus.Information = 0;
Stk = IoGetCurrentIrpStackLocation(Irp);
switch (Stk->Parameters.DeviceIoControl.IoControlCode) {
case IOCTL_INTERNAL_MOUSE_CONNECT:
DPRINT("IOCTL_INTERNAL_MOUSE_CONNECT\n");
if (Stk->Parameters.DeviceIoControl.InputBufferLength < sizeof(CONNECT_DATA)) {
DPRINT1("Mouse IOCTL_INTERNAL_MOUSE_CONNECT "
"invalid buffer size\n");
Irp->IoStatus.Status = STATUS_INVALID_PARAMETER;
goto intcontfailure2;
}
memcpy(&MouseClassInformation,
Stk->Parameters.DeviceIoControl.Type3InputBuffer,
sizeof(CONNECT_DATA));
Irp->IoStatus.Status = STATUS_SUCCESS;
break;
default:
Irp->IoStatus.Status = STATUS_SUCCESS;//STATUS_INVALID_DEVICE_REQUEST;
break;
}
intcontfailure2:
Status = Irp->IoStatus.Status;
}
else
{
DPRINT("We got IOCTL for UsbCore\n");
IoCompleteRequest(Irp, IO_NO_INCREMENT);
return STATUS_SUCCESS;
}
if (Status == STATUS_INVALID_DEVICE_REQUEST) {
DPRINT1("Invalid internal device request!\n");
}
if (Status != STATUS_PENDING)
IoCompleteRequest(Irp, IO_NO_INCREMENT);
return Status;
}
/*
* Standard DriverEntry method.
*/
NTSTATUS STDCALL
DriverEntry(IN PDRIVER_OBJECT DriverObject, IN PUNICODE_STRING RegPath)
{
int i;
USBPORT_INTERFACE UsbPortInterface;
DriverObject->DriverUnload = DriverUnload;
DriverObject->DriverExtension->AddDevice = AddDevice;
for (i = 0; i < IRP_MJ_MAXIMUM_FUNCTION; i++)
DriverObject->MajorFunction[i] = UsbCoreDispatch;
DriverObject->MajorFunction[IRP_MJ_PNP] = DispatchPnp;
DriverObject->MajorFunction[IRP_MJ_POWER] = DispatchPower;
DriverObject->MajorFunction[IRP_MJ_INTERNAL_DEVICE_CONTROL] = UsbCoreInternalDeviceControl;
// Register in usbcore.sys
UsbPortInterface.KbdConnectData = &KbdClassInformation;
UsbPortInterface.MouseConnectData = &MouseClassInformation;
KbdClassInformation.ClassService = NULL;
KbdClassInformation.ClassDeviceObject = NULL;
MouseClassInformation.ClassService = NULL;
MouseClassInformation.ClassDeviceObject = NULL;
RegisterPortDriver(DriverObject, &UsbPortInterface);
return STATUS_SUCCESS;
}

View file

@ -62,5 +62,7 @@ typedef struct _OHCI_DEVICE_EXTENSTION
PDEVICE_OBJECT RootHubPdo;
} OHCI_DEVICE_EXTENSION, *POHCI_DEVICE_EXTENSION;
#define IOCTL_INTERNAL_KEYBOARD_CONNECT \
CTL_CODE(FILE_DEVICE_KEYBOARD, 0x0080, METHOD_NEITHER, FILE_ANY_ACCESS)
#endif

View file

@ -703,13 +703,12 @@ extern struct list_head interrupt_list;
/*------------------------------------------------------------------------*/
void STDCALL usb_hcd_pci_remove (struct pci_dev *dev);
#define my_wait_ms(x) wait_ms(x)
#define my_wait_ms(x) wait_ms(x) // milliseconds
#define my_udelay(x) wait_ms(x)
#define udelay(x) my_udelay(x)
#define udelay(x) my_udelay(x) // microseconds
#define my_mdelay(x) wait_ms(1+x/1000);
#define mdelay(x) my_mdelay(x);
#define mdelay(x) my_mdelay(x); // milliseconds = udelay(1000*x)
#define pci_find_slot(a,b) my_pci_find_slot(a,b)
struct pci_dev *my_pci_find_slot(int a,int b);
@ -851,3 +850,7 @@ void do_all_timers(void);
int my_pci_write_config_word(struct pci_dev *, int, u16);
void UsbKeyBoardInit(void);
void UsbKeyBoardRemove(void);
void UsbMouseInit(void);
void UsbMouseRemove(void);

View file

@ -258,7 +258,7 @@ int my_schedule_timeout(int x)
x+=5; // safety
x = x*1000; // to us format
*/
x = 300; // it's enough for most purposes
x = 50; // it's enough for most purposes
while(x>0)
{
@ -701,7 +701,7 @@ void * my_pci_pool_alloc(struct pci_pool * pool, int mem_flags, dma_addr_t *dma_
if ((i + block) < pool->blocks_per_page)
{
DPRINT("pci_pool_alloc(): Allocating block %p:%d:%d:%d\n", pool, page, map, block);
//DPRINT("pci_pool_alloc(): Allocating block %p:%d:%d:%d\n", pool, page, map, block);
clear_bit(block, &pool->pages[page].bitmap[map]);
offset = (BITS_PER_LONG * map) + block;
offset *= pool->size;
@ -763,7 +763,7 @@ void my_pci_pool_free (struct pci_pool * pool, void * vaddr, dma_addr_t dma)
set_bit (block, &pool->pages[page].bitmap[map]);
pool->blocks_allocated--;
DPRINT("pci_pool_free(): alloc'd: %d\n", pool->blocks_allocated);
//DPRINT("pci_pool_free(): alloc'd: %d\n", pool->blocks_allocated);
}
/*

View file

@ -5,6 +5,20 @@ void wait_ms(int mils)
{
LARGE_INTEGER Interval;
Interval.QuadPart = -mils*10;
DPRINT1("wait_ms(%d)\n", mils);
Interval.QuadPart = -(mils+1)*10000;
KeDelayExecutionThread(KernelMode, FALSE, &Interval);
// schedule_timeout(1 + mils * HZ / 1000);
}
void my_udelay(int us)
{
LARGE_INTEGER Interval;
DPRINT1("udelay(%d)\n", us);
Interval.QuadPart = -us*10;
KeDelayExecutionThread(KernelMode, FALSE, &Interval);
}

View file

@ -1,9 +1,9 @@
#include "../usb_wrapper.h"
#define keyboarddebug 0
#define keyboarddebug 1
#if keyboarddebug
extern int printe(const char *szFormat, ...);
//extern int printk(const char *szFormat, ...);
int ycoffset = 0;
#endif
@ -28,7 +28,7 @@ struct usb_kbd_info {
static void usb_kbd_irq(struct urb *urb, struct pt_regs *regs)
{
struct usb_kbd_info *kbd = urb->context;
int i;
//int i;
if (urb->status) return;
@ -38,11 +38,11 @@ static void usb_kbd_irq(struct urb *urb, struct pt_regs *regs)
#if keyboarddebug
ycoffset += 15;
ycoffset = ycoffset % 600;
VIDEO_CURSOR_POSX=20;
VIDEO_CURSOR_POSY=ycoffset;
printe(" -%02x %02x %02x %02x %02x %02x\n",kbd->kbd_pkt[0],kbd->kbd_pkt[1],kbd->kbd_pkt[2],kbd->kbd_pkt[3],kbd->kbd_pkt[4],kbd->kbd_pkt[5]);
//ycoffset += 15;
//ycoffset = ycoffset % 600;
//VIDEO_CURSOR_POSX=20;
//VIDEO_CURSOR_POSY=ycoffset;
printk(" -%02x %02x %02x %02x %02x %02x\n",kbd->kbd_pkt[0],kbd->kbd_pkt[1],kbd->kbd_pkt[2],kbd->kbd_pkt[3],kbd->kbd_pkt[4],kbd->kbd_pkt[5]);
#endif
usb_submit_urb(urb,GFP_ATOMIC);
@ -54,11 +54,11 @@ static int usb_kbd_probe(struct usb_interface *intf, const struct usb_device_id
struct urb *urb;
struct usb_device *udev = interface_to_usbdev (intf);
struct usb_endpoint_descriptor *ep_irq_in;
struct usb_endpoint_descriptor *ep_irq_out;
//struct usb_endpoint_descriptor *ep_irq_out;
struct usb_kbd_info *usbk;
int i, pipe, maxp;
char *buf;
//int i, pipe, maxp;
//char *buf;
usbk=(struct usb_kbd_info *)kmalloc(sizeof(struct usb_kbd_info),0);
if (!usbk) return -1;
@ -77,8 +77,10 @@ static int usb_kbd_probe(struct usb_interface *intf, const struct usb_device_id
usb_submit_urb(urb,GFP_ATOMIC);
usb_set_intfdata(intf,usbk);
#if keyboarddebug
printe("USB Keyboard Connected\n");
printk("USB Keyboard Connected\n");
#endif
return 0;
}
@ -107,12 +109,11 @@ static struct usb_driver usb_kbd_driver = {
void UsbKeyBoardInit(void)
{
//current_remote_key=0;
//sbprintk("Keyboard probe %p ",xremote_probe);
if (usb_register(&usb_kbd_driver) < 0) {
#if keyboarddebug
printe("Unable to register Keyboard driver");
printk("Unable to register Keyboard driver");
#endif
return;
}

View file

@ -1,12 +1,30 @@
//#include <stdlib.h>
//#include <ntos/types.h>
//#include <ddk/extypes.h>
/*
TODO: Do a major cleanup of this file!
Lots of definitions should go to corresponding files
*/
#include <ddk/ntddk.h>
#include <ddk/kbdmou.h>
#include <debug.h>
#define TAG(A, B, C, D) (ULONG)(((A)<<0) + ((B)<<8) + ((C)<<16) + ((D)<<24))
void wait_ms(int mils);
void my_udelay(int us);
// For now this is needed only for correct operation of embedded keyboard and mouse drvs
typedef struct _USBPORT_INTERFACE
{
PCONNECT_DATA KbdConnectData;
PCONNECT_DATA MouseConnectData;
} USBPORT_INTERFACE, *PUSBPORT_INTERFACE;
// Register in usbcore.sys
void STDCALL RegisterPortDriver(PDRIVER_OBJECT, PUSBPORT_INTERFACE);
#ifndef _snprintf
int _snprintf(char * buf, size_t cnt, const char *fmt, ...);