added lsusb and some more config stuff. except of some (simple) setter
[ppcskel.git] / usb / core / usb.c
index 0b127b5b2d5e1d98f57bd4a1855af13ec2d6bf96..6a7562e60a90afdbe84b46ffc3331e59dfed2586 100644 (file)
  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */
 
-//wtf??!
-//#ifndef _USB_H_
-//#define _USB_H_
-
-//#include <stdlib.h>
-
 #include "usb.h"
 #include "core.h"
 #include "../host/host.h"
 #include "../usbspec/usb11spec.h"
 #include "../../malloc.h"
+#include "../../string.h"
 
+#define cleargbuf() memset(gbuf, 0, 0xffff)
+/* internal global buffer */
+static u8 gbuf[0xffff];
 
 /******************* Device Operations **********************/
-
 /**
  * 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;
-  while(iterator != NULL) {
-    dev = (usb_device*)iterator->data;
-    
-    if(dev->idVendor==vendor_id&&dev->idProduct==product_id)
-      return dev;
-
-    iterator=iterator->next;
-  }
-
-  return NULL;
+       struct usb_device* dev;
+       struct element * iterator = core.devices->head;
+       while(iterator != NULL) {
+               dev = (struct usb_device*)iterator->data;
+               
+               if(dev->idVendor==vendor_id&&dev->idProduct==product_id)
+                       return dev;
+
+               iterator=iterator->next;
+       }
+
+       return NULL;
 }
 
 
 /**
  * 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;
-  while(iterator != NULL) {
-    dev = (usb_device*)iterator->data;
-    
-    if(dev->bDeviceClass==class)
-      return dev;
-
-    iterator=iterator->next;
-  }
-  return NULL;
+       struct usb_device* dev;
+       struct element * iterator = core.devices->head;
+       while(iterator != NULL) {
+               dev = (struct usb_device*)iterator->data;
+               
+               if(dev->bDeviceClass==class)
+                       return dev;
+
+               iterator=iterator->next;
+       }
+       return NULL;
 }
 
-/**
- * Close device after a communication.
+/* Close device after a communication.
  */
-u8 usb_close(usb_device *dev)
+s8 usb_close(struct usb_device *dev)
 {
 
-  return 0;
+       return 0;
 }
 
-u8 usb_get_device_descriptor(usb_device *dev, char *buf,u8 size)
+s8 usb_reset(struct usb_device *dev)
 {
 
-  return 0;
+
+       return 0;
 }
 
-u8 usb_set_address(usb_device *dev, u8 address)
-{
 
-  return 0;
-}
+/******************* Control Transfer **********************/
 
-u8 usb_set_configuration(usb_device *dev, u8 configuration)
+/**
+ * Create a control transfer.
+ */
+s8 usb_control_msg(struct usb_device *dev, u8 requesttype, u8 request,
+               u16 value, u16 index, u16 length, u8 *buf, u16 timeout)
 {
+       struct usb_irp *irp = (struct usb_irp*)malloc(sizeof(struct usb_irp));
+       irp->dev = dev;
+       irp->endpoint = 0;
+       
+       irp->epsize = dev->bMaxPacketSize0;
+       irp->type = USB_CTRL;
+
+       buf[0]=(u8)requesttype;
+       buf[1]=(u8)request;
+       buf[2]=(u8)(value);
+       buf[3]=(u8)(value >> 8);
+       buf[4]=(u8)(index);
+       buf[5]=(u8)(index >> 8);
+       buf[6]=(u8)(length);
+       buf[7]=(u8)(length >> 8);
+
+       irp->buffer = buf;
+       irp->len = length;
+       irp->timeout = timeout;
+
+       usb_submit_irp(irp);
+       free(irp);
+
+       return 0;
+}
 
-  return 0;
+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;
 }
 
-u8 usb_set_altinterface(usb_device *dev, u8 alternate)
+s8 usb_get_string(struct usb_device *dev, u8 index, u8 langid)
 {
 
-  return 0;
+       return 0;
 }
 
-u8 usb_reset(usb_device *dev)
+char *usb_get_string_simple(struct usb_device *dev, u8 index)
 {
+       cleargbuf();
+       usb_get_descriptor(dev, STRING, index, gbuf, (u8) 8);
+       usb_get_descriptor(dev, STRING, index, gbuf, gbuf[0]);
 
+       char *str = (char*)malloc((gbuf[0]/2));
+       memset(str, '\0', (gbuf[0]/2));
 
-  return 0;
-}
-
+       u16 i;
+       for(i=0; i<(gbuf[0]/2)-1; i++) {
+               str[i] = gbuf[2+(i*2)];
+       }
 
-/******************* Control Transfer **********************/
+       return str;
+}
 
-/**
- * Create a control transfer.
+/* ask first 8 bytes of device descriptor with this special 
+ * GET Descriptor Request, when device address = 0
  */
-u8 usb_control_msg(usb_device *dev, u8 requesttype, u8 request, u16 value, u16 index, u16 length,char *buf, u16 size, u16 timeout)
+s8 usb_get_desc_dev_simple(struct usb_device *dev)
 {
-  usb_irp *irp = (usb_irp*)malloc(sizeof(usb_irp));
-  irp->dev = dev;
-  //irp->devaddress = dev->address;
-  irp->endpoint = 0;
-  
-  irp->epsize = dev->bMaxPacketSize0;
-  irp->type = USB_CTRL;
-
-  buf[0]=(char)requesttype;
-  buf[1]=(char)request;           
-  buf[2]=(char)(value >> 8);
-  buf[3]=(char)(value);          
-  buf[4]=(char)(index >> 8);
-  buf[5]=(char)(index);        
-  // lenght buf are the only where the order is inverted
-  buf[6]=(char)(length);
-  buf[7]=(char)(length >> 8);
-
-  irp->buffer = buf;
-  irp->len = length;
-  irp->timeout = timeout;
-
-  usb_submit_irp(irp);
-  free(irp);
-
-  return 0;
+       cleargbuf();
+       usb_get_descriptor(dev, DEVICE, 0, gbuf, 8);
+
+       if(!gbuf[7]) {
+               printf("FU: %d\n", gbuf[7]);
+               return -2;
+       }
+       dev->bMaxPacketSize0 = gbuf[7];
+       return 0;
 }
 
-
-u8 usb_get_string(usb_device *dev, u8 index, u8 langid, char *buf, u8 buflen)
+s8 usb_get_desc_dev(struct usb_device *dev)
 {
+       cleargbuf();
+       if (usb_get_desc_dev_simple(dev) < 0) {
+               return -1;
+       }
+       usb_get_descriptor(dev, DEVICE, 0, gbuf, gbuf[0]);
+
+       dev->bLength = gbuf[0];
+       dev->bDescriptorType = gbuf[1];
+       dev->bcdUSB = (u16) (gbuf[3] << 8 | gbuf[2]);
+       dev->bDeviceClass = gbuf[4];
+       dev->bDeviceSubClass = gbuf[5];
+       dev->bDeviceProtocoll = gbuf[6];
+       dev->idVendor = (u16) (gbuf[9] << 8) | (gbuf[8]);
+       dev->idProduct = (u16) (gbuf[11] << 8) | (gbuf[10]);
+       dev->bcdDevice = (u16) (gbuf[13] << 8) | (gbuf[12]);
+       dev->iManufacturer = gbuf[14];
+       dev->iProduct = gbuf[15];
+       dev->iSerialNumber = gbuf[16];
+       dev->bNumConfigurations = gbuf[17];
+
+       u8 i;
+       struct usb_conf *conf = dev->conf = (struct usb_conf*) malloc(sizeof(struct usb_conf));
+       for(i=0; i <= dev->bNumConfigurations; i++) {
+               if(i!=0) {
+                       conf = (struct usb_conf*) malloc(sizeof(struct usb_conf));
+               }
+               usb_get_desc_config_ext(dev, i, conf);
+       }
+
+       return 0;
+}
 
-  return 0;
+s8 usb_get_desc_configuration(struct usb_device *dev, u8 index, struct usb_conf *conf)
+{
+       cleargbuf();
+       usb_get_descriptor(dev, CONFIGURATION, index, gbuf, 8);
+       usb_get_descriptor(dev, CONFIGURATION, index, gbuf, gbuf[0]);
+
+       conf->bLength = gbuf[0];
+       conf->bDescriptorType = gbuf[1];
+       conf->wTotalLength = (u16) (gbuf[3] << 8 | gbuf[2]);
+       conf->bNumInterfaces = gbuf[4];
+       conf->bConfigurationValue = gbuf[5];
+       conf->iConfiguration = gbuf[6];
+       conf->bmAttributes = gbuf[7];
+       conf->bMaxPower = gbuf[8];
+       conf->intf = NULL;
+
+       return 0;
 }
 
+/* returns more information about CONFIGURATION, including
+ * INTERFACE(s) and ENDPOINT(s)
+ * usb_get_desc_configuration() must be called for this device before
+ */
+s8 usb_get_desc_config_ext(struct usb_device *dev, u8 index, struct usb_conf *conf)
+{
+       cleargbuf();
+
+       usb_get_desc_configuration(dev, index, conf);
+       usb_get_descriptor(dev, CONFIGURATION, index, gbuf, dev->conf->wTotalLength);
+
+       u8 i,j,off=9;
+       struct usb_intf *ifs = dev->conf->intf = (struct usb_intf*) malloc(sizeof(struct usb_intf));
+       for(i=1; i <= dev->conf->bNumInterfaces; i++) {
+               if(i!=1) {
+                       ifs->next = (struct usb_intf*) malloc(sizeof(struct usb_intf));
+                       ifs = ifs->next;
+               }
+               ifs->bLength = gbuf[off+0];
+               ifs->bDescriptorType = gbuf[off+1];
+               ifs->bInterfaceNumber = gbuf[off+2];
+               ifs->bAlternateSetting = gbuf[off+3];
+               ifs->bNumEndpoints = gbuf[off+4];
+               ifs->bInterfaceClass = gbuf[off+5];
+               ifs->bInterfaceSubClass = gbuf[off+6];
+               ifs->bInterfaceProtocol = gbuf[off+7];
+               ifs->iInterface = gbuf[off+8];
+
+               off += 9;
+
+               struct usb_endp *ep = ifs->endp = (struct usb_endp*) malloc(sizeof(struct usb_endp));
+               for(j=1; j <= ifs->bNumEndpoints; j++) {
+                       /* skip HID Device Descriptor (see lsusb) */
+                       if(gbuf[off+1] == 33) {
+                               j--;
+                               off += 9;
+                               continue;
+                       }
+
+                       if(j!=1) {
+                               ep->next = (struct usb_endp*) malloc(sizeof(struct usb_endp));
+                               ep = ep->next;
+                       }
+
+                       ep->bLength = gbuf[off+0];
+                       ep->bDescriptorType = gbuf[off+1];
+                       ep->bEndpointAddress = gbuf[off+2];
+                       ep->bmAttributes = gbuf[off+3];
+                       ep->wMaxPacketSize = (u16) ((gbuf[off+5] << 8) | (gbuf[off+4]));
+                       ep->bInterval = gbuf[off+6];
+
+                       off += 7;
+               }
+       }
+
+       printf("=============\nafter usb_get_desc_config_ext:\n");
+       hexdump((void*) gbuf, dev->conf->wTotalLength);
+       return 0;
+}
 
-u8 usb_get_string_simple(usb_device *dev, u8 index, char *buf, u8 buflen)
+s8 usb_set_address(struct usb_device *dev, u8 address)
 {
+       cleargbuf();
+       usb_control_msg(dev, 0x00, SET_ADDRESS, address, 0, 0, gbuf, 0);
+       return 0;
+}
 
-  return 0;
+s8 usb_set_configuration(struct usb_device *dev, u8 configuration)
+{
+       cleargbuf();
+       usb_control_msg(dev, 0x00, SET_CONFIGURATION, configuration, 0, 0, gbuf, 0);
+       return 0;
 }
 
-u8 usb_get_descriptor(usb_device *dev, unsigned char type, unsigned char index, void *buf, u8 size)
+s8 usb_set_altinterface(struct usb_device *dev, u8 alternate)
 {
 
-  return 0;
+       return 0;
 }
 
 
+
 /******************* Bulk Transfer **********************/
 
 /**
  * Write to an a bulk endpoint.
  */
-u8 usb_bulk_write(usb_device *dev, u8 ep, char *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));
-  irp->dev = dev;
-  //irp->devaddress = dev->address;
-  
-  irp->endpoint = ep;
-  irp->epsize = dev->epSize[ep]; // ermitteln
-  irp->type = USB_BULK;
-
-  irp->buffer = buf;
-  irp->len = size;
-  irp->timeout = timeout;
-
-  usb_submit_irp(irp);
-  free(irp);
-
-  return 0;
+       struct usb_irp * irp = (struct usb_irp*)malloc(sizeof(struct usb_irp));
+       irp->dev = dev;
+       //irp->devaddress = dev->address;
+       
+       irp->endpoint = ep;
+       irp->epsize = dev->epSize[ep]; // ermitteln
+       irp->type = USB_BULK;
+
+       irp->buffer = buf;
+       irp->len = size;
+       irp->timeout = timeout;
+
+       usb_submit_irp(irp);
+       free(irp);
+
+       return 0;
 }
 
 /**
  * Read from an bulk endpoint.
  */
-u8 usb_bulk_read(usb_device *dev, u8 ep, char *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));
-  //irp->devaddress = dev->address;
-  irp->dev = dev;
-  
-  irp->endpoint = ep | 0x80;  // from device to host
-  irp->epsize = dev->epSize[ep]; // ermitteln
-  irp->type = USB_BULK;
-
-  irp->buffer = buf;
-  irp->len = size;
-  irp->timeout = timeout;
-
-  usb_submit_irp(irp);
-  free(irp);
-
-  return 0;
+       struct usb_irp * irp = (struct usb_irp*)malloc(sizeof(struct usb_irp));
+       //irp->devaddress = dev->address;
+       irp->dev = dev;
+       
+       irp->endpoint = ep | 0x80;      // from device to host
+       irp->epsize = dev->epSize[ep]; // ermitteln
+       irp->type = USB_BULK;
+
+       irp->buffer = buf;
+       irp->len = size;
+       irp->timeout = timeout;
+
+       usb_submit_irp(irp);
+       free(irp);
+
+       return 0;
 }
 
 
@@ -237,19 +367,19 @@ u8 usb_bulk_read(usb_device *dev, u8 ep, char *buf, u8 size, u8 timeout)
 /**
  * Write to an interrupt endpoint.
  */
-u8 usb_interrupt_write(usb_device *dev, u8 ep, char *buf, u8 size, u8 timeout)
+s8 usb_interrupt_write(struct usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 {
 
-  return 0;
+       return 0;
 }
 
 /**
  * Read from an interrupt endpoint.
  */
-u8 usb_interrupt_read(usb_device *dev, u8 ep, char *buf, u8 size, u8 timeout)
+s8 usb_interrupt_read(struct usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 {
 
-  return 0;
+       return 0;
 }
 
 
@@ -258,20 +388,20 @@ u8 usb_interrupt_read(usb_device *dev, u8 ep, char *buf, u8 size, u8 timeout)
 /**
  * Write to an isochron endpoint.
  */
-u8 usb_isochron_write(usb_device *dev, u8 ep, char *buf, u8 size, u8 timeout)
+s8 usb_isochron_write(struct usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 {
 
-  return 0;
+       return 0;
 }
 
 /**
  * Read from an isochron endpoint.
  */
-u8 usb_isochron_read(usb_device *dev, u8 ep, char *buf, u8 size, u8 timeout)
+s8 usb_isochron_read(struct usb_device *dev, u8 ep, u8 *buf, u8 size, u8 timeout)
 {
 
 
-  return 0;
+       return 0;
 }