Changeset 4971812 in mainline for uspace/lib/usbvirt/ctrlpipe.c

Timestamp:

2010-10-10T21:20:02Z (14 years ago)

Author:

Vojtech Horky <vojtechhorky@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

0e41957

Parents:

6c1315b

Message:

Standard requests in virtual USB device

The virtual USB device framework can handle some standard requests
alone. Again, this is more about bones than about meat. Meat will
come later.

Update `vuk' app to provide standard device descriptor.

File:

• uspace/lib/usbvirt/ctrlpipe.c (modified) (1 diff)

uspace/lib/usbvirt/ctrlpipe.c

@@ -37 +37 @@
 #include "private.h"
 
+#define REQUEST_TYPE_STANDARD 0 
+#define REQUEST_TYPE_CLASS 1
+
+#define GET_MIDBITS_MASK(size, shift) \
+        (((1 << size) - 1) << shift)
+#define GET_MIDBITS(value, size, shift) \
+        ((value & GET_MIDBITS_MASK(size, shift)) >> shift)
+
+static usb_direction_t request_get_direction(uint8_t request_type)
+{
+        int bit7 = GET_MIDBITS(request_type, 1, 7);
+        return bit7 ? USB_DIRECTION_IN : USB_DIRECTION_OUT;
+}
+
+static int request_get_type(uint8_t request_type)
+{
+        return GET_MIDBITS(request_type, 2, 5);
+}
+
+static int request_get_recipient(uint8_t request_type)
+{
+        return GET_MIDBITS(request_type, 5, 0);
+}
+
+
+typedef struct {
+        uint8_t request_type;
+        uint8_t request;
+        uint16_t value;
+        uint16_t index;
+        uint16_t length;
+} __attribute__ ((packed)) devreq_setup_packet_t;
+
 int control_pipe(void *buffer, size_t size)
 {
-        // TODO
+        if (size < sizeof(devreq_setup_packet_t)) {
+                return ENOMEM;
+        }
+        
+        devreq_setup_packet_t *request = (devreq_setup_packet_t *) buffer;
+        uint8_t *remaining_data = ((uint8_t *) request) + sizeof(devreq_setup_packet_t);
+        
+        usb_direction_t direction = request_get_direction(request->request_type);
+        int type = request_get_type(request->request_type);
+        int recipient = request_get_recipient(request->request_type);
+        
+        
+        switch (type) {
+                case REQUEST_TYPE_STANDARD:
+                        return handle_std_request(direction, recipient,
+                            request->request, request->value,
+                            request->index, request->length,
+                            remaining_data);
+                        break;
+                case REQUEST_TYPE_CLASS:
+                        if (DEVICE_HAS_OP(device, on_devreq_class)) {
+                                return device->ops->on_devreq_class(device,
+                                    direction, recipient,
+                                    request->request, request->value,
+                                    request->index, request->length,
+                                    remaining_data);
+                        }
+                        break;
+                default:
+                        break;
+        }
+        
         return EOK;
 }