ctrltransfer.c

Go to the documentation of this file.
00001 /*
00002  * Copyright (c) 2011 Vojtech Horky
00003  * All rights reserved.
00004  *
00005  * Redistribution and use in source and binary forms, with or without
00006  * modification, are permitted provided that the following conditions
00007  * are met:
00008  *
00009  * - Redistributions of source code must retain the above copyright
00010  *   notice, this list of conditions and the following disclaimer.
00011  * - Redistributions in binary form must reproduce the above copyright
00012  *   notice, this list of conditions and the following disclaimer in the
00013  *   documentation and/or other materials provided with the distribution.
00014  * - The name of the author may not be used to endorse or promote products
00015  *   derived from this software without specific prior written permission.
00016  *
00017  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
00018  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
00019  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
00020  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
00021  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
00022  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
00023  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
00024  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
00025  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
00026  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
00027  */
00028 
00035 #include "private.h"
00036 #include <usb/dev/request.h>
00037 #include <usb/debug.h>
00038 #include <assert.h>
00039 #include <errno.h>
00040 
00051 int process_control_transfer(usbvirt_device_t *dev,
00052     usbvirt_control_request_handler_t *control_handlers,
00053     usb_device_request_setup_packet_t *setup,
00054     uint8_t *data, size_t *data_sent_size)
00055 {
00056         assert(dev);
00057         assert(setup);
00058 
00059         if (control_handlers == NULL) {
00060                 return EFORWARD;
00061         }
00062 
00063         usb_direction_t direction = setup->request_type & 128 ?
00064             USB_DIRECTION_IN : USB_DIRECTION_OUT;
00065         usb_request_recipient_t req_recipient = setup->request_type & 31;
00066         usb_request_type_t req_type = (setup->request_type >> 5) & 3;
00067 
00068         usbvirt_control_request_handler_t *handler = control_handlers;
00069         while (handler->callback != NULL) {
00070                 if (handler->req_direction != direction) {
00071                         goto next;
00072                 }
00073                 if (handler->req_recipient != req_recipient) {
00074                         goto next;
00075                 }
00076                 if (handler->req_type != req_type) {
00077                         goto next;
00078                 }
00079                 if (handler->request != setup->request) {
00080                         goto next;
00081                 }
00082 
00083                 usb_log_debug("Control transfer: %s(%s)\n", handler->name,
00084                     usb_debug_str_buffer((uint8_t*) setup, sizeof(*setup), 0));
00085                 int rc = handler->callback(dev, setup, data, data_sent_size);
00086                 if (rc == EFORWARD) {
00087                         goto next;
00088                 }
00089 
00090                 return rc;
00091 
00092 next:
00093                 handler++;
00094         }
00095 
00096         return EFORWARD;
00097 }
00098 
00099 

Generated on Thu Jun 2 07:45:49 2011 for HelenOS/USB by  doxygen 1.4.7