public unsafe IUSBDriver Load(USBDevice device)
{
USBInterfaceDescriptor *desc = device.InterfaceDesc;
if (!(desc->Class == (byte)USBClassCodes.HID &&
desc->SubClass == 0x01 &&
desc->Protocol == 0x02))
{
return(null);
}
device.Classifier = USBDeviceClassifier.FUNCTION;
mTransfer = (USBTransfer *)Heap.Alloc(sizeof(USBTransfer));
mLocation = (MouseLocation *)Heap.Alloc(sizeof(MouseLocation));
/**
* Prepare poll transfer
*/
mTransfer->Data = (byte *)mLocation;
mTransfer->Length = 3;
mTransfer->Executed = false;
mTransfer->Success = false;
mTransfer->ID = 2;
//device.PrepareInterrupt(device, mTransfer);
return(this);
}
public unsafe IUSBDriver Load(USBDevice device)
{
USBInterfaceDescriptor *desc = device.InterfaceDesc;
if (!(desc->Class == (byte)USBClassCodes.HID &&
desc->SubClass == 0x01 &&
desc->Protocol == 0x01))
{
return(null);
}
device.Classifier = USBDeviceClassifier.FUNCTION;
USBHIDKeyboard kb = new USBHIDKeyboard();
kb.initDevice(device);
return(kb);
}
/// <summary>
/// Initalize device
/// </summary>
/// <returns>Success?</returns>
public unsafe bool Init()
{
byte *data = (byte *)Heap.Alloc(sizeof(USBDeviceDescriptor));
for (int i = 0; i < sizeof(USBDeviceDescriptor); i++)
{
data[i] = 0x1;
}
/**
* Get max packet size
*/
USBDeviceDescriptor *descriptor = (USBDeviceDescriptor *)data;
if (!Request(TYPE_DEVICETOHOST, REQ_GET_DESCRIPTOR, (DESC_DEVICE << 8) | 0, 0, 8, data))
{
return(false);
}
MaxPacketSize = descriptor->MaxpacketSize0;
/**
* Set new address
*/
ushort tempAdr = ++NextAddress;
if (!Request(TYPE_HOSTTODEVICE, REQ_SET_ADDR, tempAdr, 0, 0, null))
{
return(false);
}
Address = tempAdr;
Tasking.CurrentTask.CurrentThread.Sleep(0, 20000);
/**
* Get descriptor
*/
if (!Request(TYPE_DEVICETOHOST, REQ_GET_DESCRIPTOR, (DESC_DEVICE << 8) | 0, 0, (ushort)sizeof(USBDeviceDescriptor), data))
{
return(false);
}
/**
* Load languages and set default
*/
LoadLanguages();
if (NumLanguages > 0)
{
Manfacturer = GetString(Languages[0], descriptor->ManufacturerIndex);
Product = GetString(Languages[0], descriptor->ProductIndex);
SerialNumber = GetString(Languages[0], descriptor->SerialNumberIndex);
}
/**
* Get configurations
*/
byte[] buffer = new byte[512];
byte * ptrToBuf = (byte *)Util.ObjectToVoidPtr(buffer);
USBConfigurationDescriptor *descBuf = (USBConfigurationDescriptor *)ptrToBuf;
for (int i = 0; i < descriptor->NumConfigurations; i++)
{
if (!Request(TYPE_DEVICETOHOST, REQ_GET_DESCRIPTOR, (ushort)((DESC_CONFIGURATION << 8) | i), 0, 4, (byte *)Util.ObjectToVoidPtr(buffer)))
{
continue;
}
if (!Request(TYPE_DEVICETOHOST, REQ_GET_DESCRIPTOR, (ushort)((DESC_CONFIGURATION << 8) | i), 0, descBuf->TotalLength, (byte *)Util.ObjectToVoidPtr(buffer)))
{
continue;
}
// Prevent overflow
if (descBuf->TotalLength > 512)
{
continue;
}
ConfigValue = descBuf->ConfigurationValue;
int remaining = descBuf->TotalLength - descBuf->Length;
byte *dataStart = ptrToBuf + descBuf->Length;
while (remaining > 0)
{
int len = dataStart[0];
int type = dataStart[1];
if (type == DESC_INTERFACE)
{
InterfaceDesc = (USBInterfaceDescriptor *)dataStart;
}
else if (type == DESC_ENDPOINT)
{
EndPointDesc = (USBEndpointDescriptor *)dataStart;
}
dataStart += len;
remaining -= len;
}
}
if (ConfigValue != 0 && InterfaceDesc != null && EndPointDesc != null)
{
if (!Request(TYPE_HOSTTODEVICE, REQ_SET_CONFIGURATION, ConfigValue, 0, 0, null))
{
return(false);
}
/**
* Init driver here
*/
State = USBDeviceState.CONFIGURED;
IUSBDriver result = USBDrivers.LoadDriver(this);
if (result == null)
{
Console.Write("[USB] No driver found for device with name ");
Console.WriteLine(Product);
return(false);
}
Console.Write("[USB] Device configured with name ");
Console.WriteLine(Product);
USB.RegisterDevice(this);
Driver = result;
}
return(true);
}
