m00h @ previous commit: using wTotalLenght of CONFIGURATION you get
[ppcskel.git] / usb / core / usb.c
index 0fd585bb82f28672cc0907ad7d750a742c6465ff..95110672b1142f434950153ec4f9cec8c7b7dd97 100644 (file)
 /**
  * Open a device with verndor- and product-id for a communication.
  */
-usb_device *usb_open(u32 vendor_id, u32 product_id)
+struct usb_device *usb_open(u32 vendor_id, u32 product_id)
 {
-       usb_device* dev;
-       element * iterator = core.devices->head;
+       struct usb_device* dev;
+       struct element * iterator = core.devices->head;
        while(iterator != NULL) {
-               dev = (usb_device*)iterator->data;
+               dev = (struct usb_device*)iterator->data;
                
                if(dev->idVendor==vendor_id&&dev->idProduct==product_id)
                        return dev;
@@ -67,12 +67,12 @@ usb_device *usb_open(u32 vendor_id, u32 product_id)
 /**
  * Open a device with an class code for a communication.
  */
-usb_device *usb_open_class(u8 class)
+struct usb_device *usb_open_class(u8 class)
 {
-       usb_device* dev;
-       element * iterator = core.devices->head;
+       struct usb_device* dev;
+       struct element * iterator = core.devices->head;
        while(iterator != NULL) {
-               dev = (usb_device*)iterator->data;
+               dev = (struct usb_device*)iterator->data;
                
                if(dev->bDeviceClass==class)
                        return dev;
@@ -84,51 +84,13 @@ usb_device *usb_open_class(u8 class)
 
 /* Close device after a communication.
  */
-s8 usb_close(usb_device *dev)
+s8 usb_close(struct usb_device *dev)
 {
 
        return 0;
 }
 
-/* ask first 8 bytes of device descriptor with this special 
- * GET Descriptor Request, when device address = 0
- */
-s8 usb_get_dev_desc_simple(usb_device *dev, u8 *buf, u8 size)
-{
-       if(size < 8) {
-               return -1;
-       }
-       usb_get_descriptor(dev, DEVICE, 0, buf, 8);
-       return 0;
-}
-
-s8 usb_get_dev_desc(usb_device *dev, u8 *buf, u8 size, u8 dev_desc_size)
-{
-       printf("WTF SIZE: 0x%X\n", size>= dev_desc_size ? dev_desc_size : size);
-       usb_get_descriptor(dev, DEVICE, 0, buf, size >= dev_desc_size ? dev_desc_size : size);
-       return 0;
-}
-
-s8 usb_set_address(usb_device *dev, u8 address)
-{
-       u8 buf[64];
-       usb_control_msg(dev, 0x00, SET_ADDRESS, address, 0, 0, buf, 0);
-       return 0;
-}
-
-s8 usb_set_configuration(usb_device *dev, u8 configuration)
-{
-
-       return 0;
-}
-
-s8 usb_set_altinterface(usb_device *dev, u8 alternate)
-{
-
-       return 0;
-}
-
-s8 usb_reset(usb_device *dev)
+s8 usb_reset(struct usb_device *dev)
 {
 
 
@@ -141,10 +103,10 @@ s8 usb_reset(usb_device *dev)
 /**
  * Create a control transfer.
  */
-s8 usb_control_msg(usb_device *dev, u8 requesttype, u8 request,
+s8 usb_control_msg(struct usb_device *dev, u8 requesttype, u8 request,
                u16 value, u16 index, u16 length, u8 *buf, u16 timeout)
 {
-       usb_irp *irp = (usb_irp*)malloc(sizeof(usb_irp));
+       struct usb_irp *irp = (struct usb_irp*)malloc(sizeof(struct usb_irp));
        irp->dev = dev;
        irp->endpoint = 0;
        
@@ -171,35 +133,142 @@ s8 usb_control_msg(usb_device *dev, u8 requesttype, u8 request,
 }
 
 
-s8 usb_get_string(usb_device *dev, u8 index, u8 langid, u8 *buf, u8 buflen)
+s8 usb_get_string(struct usb_device *dev, u8 index, u8 langid, u8 *buf, u8 buflen)
 {
 
        return 0;
 }
 
 
-s8 usb_get_string_simple(usb_device *dev, u8 index, u8 *buf, u8 size)
+char *usb_get_string_simple(struct usb_device *dev, u8 index, u8 *buf, u8 size)
 {
+       if(size < 8) {
+               return (char*) -1;
+       }
        usb_get_descriptor(dev, STRING, index, buf, (u8) 8);
-       usb_get_descriptor(dev, STRING, index, buf, size >= buf[0] ? (u8) buf[0] : size);
-       return 0;
+       size = size >= (buf[0]) ? (buf[0]) : size;
+       usb_get_descriptor(dev, STRING, index, buf, size);
+
+       char *str = (char*)malloc((size/2));
+       memset(str, '\0', (size/2));
+
+       u16 i;
+       for(i=0; i<(size/2)-1; i++) {
+               str[i] = buf[2+(i*2)];
+               printf("%c", str[i]);
+       }
+       printf("\n");
+
+       return str;
 }
 
-s8 usb_get_descriptor(usb_device *dev, u8 type, u8 index, u8 *buf, u8 size)
+s8 usb_get_descriptor(struct usb_device *dev, u8 type, u8 index, u8 *buf, u8 size)
 {
        usb_control_msg(dev, 0x80, GET_DESCRIPTOR, (type << 8) | index, 0, size, buf, 0);
        return 0;
 }
 
+/* ask first 8 bytes of device descriptor with this special 
+ * GET Descriptor Request, when device address = 0
+ */
+s8 usb_get_desc_dev_simple(struct usb_device *dev, u8 *buf, u8 size)
+{
+       if(size < 8) {
+               return -1;
+       }
+       usb_get_descriptor(dev, DEVICE, 0, buf, 8);
+
+       if(!buf[7]) {
+               printf("FU: %d\n", buf[7]);
+               return -2;
+       }
+       dev->bMaxPacketSize0 = buf[7];
+       return 0;
+}
+
+s8 usb_get_desc_dev(struct usb_device *dev, u8 *buf, u8 size)
+{
+       if (size < 0x12 || usb_get_desc_dev_simple(dev, buf, size) < 0) {
+               return -1;
+       }
+       usb_get_descriptor(dev, DEVICE, 0, buf, size >= buf[0] ? buf[0] : size);
+
+       dev->bLength = buf[0];
+       dev->bDescriptorType = buf[1];
+       dev->bcdUSB = (u16) (buf[3] << 8 | buf[2]);
+       dev->bDeviceClass = buf[4];
+       dev->bDeviceSubClass = buf[5];
+       dev->bDeviceProtocoll = buf[6];
+       dev->idVendor = (u16) (buf[9] << 8) | (buf[8]);
+       dev->idProduct = (u16) (buf[11] << 8) | (buf[10]);
+       dev->bcdDevice = (u16) (buf[13] << 8) | (buf[12]);
+       dev->iManufacturer = buf[14];
+       dev->iProduct = buf[15];
+       dev->iSerialNumber = buf[16];
+       dev->bNumConfigurations = buf[17];
+
+       return 0;
+}
+
+s8 usb_get_desc_configuration(struct usb_device *dev, u8 index, u8 *buf, u8 size)
+{
+       if(size < 9) {
+               return -1;
+       }
+       usb_get_descriptor(dev, CONFIGURATION, index, buf, 8);
+       usb_get_descriptor(dev, CONFIGURATION, index, buf, size >= buf[0] ? buf[0] : size);
+
+       dev->conf->bLength = buf[0];
+       dev->conf->bDescriptorType = buf[1];
+       dev->conf->wTotalLength = (u16) (buf[3] << 8 | buf[2]);
+       dev->conf->bNumInterfaces = buf[4];
+       dev->conf->bConfigurationValue = buf[5];
+       dev->conf->iConfiguration = buf[6];
+       dev->conf->bmAttributes = buf[7];
+       dev->conf->bMaxPower = buf[8];
+       return 0;
+}
+
+s8 usb_get_desc_interface(struct usb_device *dev, u8 index, u8 *buf, u8 size)
+{
+       if(size < 9) {
+               return -1;
+       }
+       usb_get_descriptor(dev, INTERFACE, index, buf, 9);
+
+       return 0;
+}
+
+s8 usb_set_address(struct usb_device *dev, u8 address)
+{
+       u8 buf[64];
+       usb_control_msg(dev, 0x00, SET_ADDRESS, address, 0, 0, buf, 0);
+       return 0;
+}
+
+s8 usb_set_configuration(struct usb_device *dev, u8 configuration)
+{
+       u8 buf[64];
+       usb_control_msg(dev, 0x00, SET_CONFIGURATION, configuration, 0, 0, buf, 0);
+       return 0;
+}
+
+s8 usb_set_altinterface(struct usb_device *dev, u8 alternate)
+{
+
+       return 0;
+}
+
+
 
 /******************* Bulk Transfer **********************/
 
 /**
  * Write to an a bulk endpoint.
  */
-s8 usb_bulk_write(usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
+s8 usb_bulk_write(struct usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 {
-       usb_irp * irp = (usb_irp*)malloc(sizeof(usb_irp));
+       struct usb_irp * irp = (struct usb_irp*)malloc(sizeof(struct usb_irp));
        irp->dev = dev;
        //irp->devaddress = dev->address;
        
@@ -220,9 +289,9 @@ s8 usb_bulk_write(usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 /**
  * Read from an bulk endpoint.
  */
-s8 usb_bulk_read(usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
+s8 usb_bulk_read(struct usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 {
-       usb_irp * irp = (usb_irp*)malloc(sizeof(usb_irp));
+       struct usb_irp * irp = (struct usb_irp*)malloc(sizeof(struct usb_irp));
        //irp->devaddress = dev->address;
        irp->dev = dev;
        
@@ -245,7 +314,7 @@ s8 usb_bulk_read(usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 /**
  * Write to an interrupt endpoint.
  */
-s8 usb_interrupt_write(usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
+s8 usb_interrupt_write(struct usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 {
 
        return 0;
@@ -254,7 +323,7 @@ s8 usb_interrupt_write(usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 /**
  * Read from an interrupt endpoint.
  */
-s8 usb_interrupt_read(usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
+s8 usb_interrupt_read(struct usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 {
 
        return 0;
@@ -266,7 +335,7 @@ s8 usb_interrupt_read(usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 /**
  * Write to an isochron endpoint.
  */
-s8 usb_isochron_write(usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
+s8 usb_isochron_write(struct usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 {
 
        return 0;
@@ -275,7 +344,7 @@ s8 usb_isochron_write(usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 /**
  * Read from an isochron endpoint.
  */
-s8 usb_isochron_read(usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
+s8 usb_isochron_read(struct usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 {