[cdi-devel] [PATCH v3 4/5] USB 1.1
Kevin Wolf ·
From: Max Reitz <max at tyndur.org> + Added USB 1.1 bus driver Signed-off-by: Max Reitz <max at tyndur.org> Signed-off-by: Kevin Wolf <kevin at tyndur.org> --- usb11/control.c | 252 +++++++++++++++++++++++++++++++++++++++++++ usb11/include/control.h | 31 ++++++ usb11/include/transfer.h | 38 +++++++ usb11/include/usb-structs.h | 184 +++++++++++++++++++++++++++++++ usb11/include/usb11.h | 41 +++++++ usb11/main.c | 58 ++++++++++ usb11/transfer.c | 223 ++++++++++++++++++++++++++++++++++++++ 7 files changed, 827 insertions(+), 0 deletions(-) create mode 100644 usb11/control.c create mode 100644 usb11/include/control.h create mode 100644 usb11/include/transfer.h create mode 100644 usb11/include/usb-structs.h create mode 100644 usb11/include/usb11.h create mode 100644 usb11/main.c create mode 100644 usb11/transfer.c diff --git a/usb11/control.c b/usb11/control.c new file mode 100644 index 0000000..170341d --- /dev/null +++ b/usb11/control.c @@ -0,0 +1,252 @@ +/***************************************************************************** +* Copyright (c) 2009 Max Reitz * +* * +* Permission is hereby granted, free of charge, to any person obtaining a * +* copy of this software and associated documentation files (the "Software"), * +* to deal in the Software without restriction, including without limitation * +* the rights to use, copy, modify, merge, publish, distribute, sublicense, * +* and/or sell copies of the Software, and to permit persons to whom the * +* Software is furnished to do so, subject to the following conditions: * +* * +* The above copyright notice and this permission notice shall be included in * +* all copies or substantial portions of the Software. * +* * +* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * +* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * +* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL * +* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * +* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * +* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER * +* DEALINGS IN THE SOFTWARE. * +*****************************************************************************/ + +#include <stdlib.h> + +#include <cdi/lists.h> +#include <cdi/misc.h> +#include <cdi/usb.h> + +#include "usb11.h" +#include "usb-structs.h" +#include "transfer.h" + +static int usb_dev_ids = 1; + +static void enumerate_hub(struct cdi_usb_device *usbdev); + +static int usb11_real_enumerate(struct cdi_usb_device *device) +{ + struct endpoint_desc *ep0; + struct device_desc *dev_desc; + struct cdi_usb_hcd *hcd; + int id; + char *name; + void *position; + struct config_desc *conf_desc; + struct interface_desc *if_desc, *best_if; + + hcd = (struct cdi_usb_hcd *)device->hc->dev.driver; + + //EP0 initialisieren + device->ep0 = malloc(sizeof(*device->ep0)); + device->ep0->endpoint = malloc(sizeof(struct endpoint_desc)); + ep0 = (struct endpoint_desc *)device->ep0->endpoint; + ep0->length = sizeof(struct endpoint_desc); + ep0->descriptor_type = DESC_ENDPOINT; + ep0->endpoint_address = 0; + ep0->attributes = 0; + ep0->max_packet_size = 8; + ep0->interval = 0; + device->ep0->device = device; + device->ep0->data_toggle = 0; + + //Zurücksetzen + device->reset(device); + + //Pipe erzeugen + hcd->add_pipe(device->ep0); + + //Erste acht Bytes des Device-Descriptors abrufen und die maximale + //Paketgröße von EP0 feststellen + dev_desc = usb11_do_control(device, DEV_TO_HOST, NULL, 8, STD_REQUEST, + REC_DEVICE, GET_DESCRIPTOR, DESC_DEVICE << 8, 0); + if (dev_desc == NULL) { + return 0; + } + ep0->max_packet_size = dev_desc->max_packet_size0; + + //Nochmals zurücksetzen + device->reset(device); + + //USB-Adresse zuweisen + usb11_do_control(device, HOST_TO_DEV | NO_DATA, NULL, 0, STD_REQUEST, + REC_DEVICE, SET_ADDRESS, (id = usb_dev_ids++), 0); + device->id = id; + if (usb_dev_ids >= 128) { + d0printf("Warning: USB device ID overflow.\n"); + usb_dev_ids = 1; + } + + //So, jetzt haben wir eine Adresse, da gibts auch eine neue Pipe + hcd->add_pipe(device->ep0); + + //Den ganzen Device-Descriptor einlesen + dev_desc = usb11_do_control(device, DEV_TO_HOST, NULL, sizeof(*dev_desc), + STD_REQUEST, REC_DEVICE, GET_DESCRIPTOR, DESC_DEVICE << 8, 0); + device->device_desc = dev_desc; + device->vendor_id = dev_desc->vendor_id; + device->device_id = dev_desc->device_id; + + if (dev_desc->iManufacturer) { + name = usb11_do_control(device, DEV_TO_HOST, NULL, 64, STD_REQUEST, + REC_DEVICE, GET_DESCRIPTOR, + (DESC_STRING << 8) | dev_desc->iManufacturer, 0); + if (name == NULL) { + return 0; + } + d1printf(" -> Manufacturer: "); + for (int i = 2; i < name[0]; i += 2) { + _d1printf("%c", name[i]); + } + _d1printf("\n"); + } + if (dev_desc->iProduct) { + name = usb11_do_control(device, DEV_TO_HOST, NULL, 64, STD_REQUEST, + REC_DEVICE, GET_DESCRIPTOR, + (DESC_STRING << 8) | dev_desc->iProduct, 0); + if (name == NULL) { + return 0; + } + d1printf(" -> Product: "); + for (int i = 2; i < name[0]; i += 2) { + _d1printf("%c", name[i]); + } + _d1printf("\n"); + } + //TODO: Man kann doch nicht immer den ersten nehmen... + conf_desc = usb11_do_control(device, DEV_TO_HOST, NULL, + sizeof(struct config_desc), STD_REQUEST, REC_DEVICE, GET_DESCRIPTOR, + DESC_CONFIGURATION << 8, 0); + if (conf_desc == NULL) { + return 0; + } + conf_desc = usb11_do_control(device, DEV_TO_HOST, NULL, + conf_desc->total_length, STD_REQUEST, REC_DEVICE, GET_DESCRIPTOR, + DESC_CONFIGURATION << 8, 0); + if (conf_desc == NULL) { + return 0; + } + device->config_desc = conf_desc; + usb11_do_control(device, HOST_TO_DEV, NULL, 0, STD_REQUEST, REC_DEVICE, + SET_CONFIGURATION, conf_desc->config_value, 0); + if (conf_desc->iConfiguration) { + name = usb11_do_control(device, DEV_TO_HOST, NULL, 64, STD_REQUEST, + REC_DEVICE, GET_DESCRIPTOR, + (DESC_STRING << 8) | conf_desc->iConfiguration, 0); + if (name == NULL) { + return 0; + } + d1printf("Using configuration "); + for (int i = 2; i < name[0]; i += 2) { + _d1printf("%c", name[i]); + } + _d1printf(".\n"); + } + position = conf_desc; + position = (void *)((uintptr_t)position + sizeof(struct config_desc)); + best_if = position; //Standard-IF + for (int i = 0; i < conf_desc->num_interfaces; i++) { + if_desc = position; + //TODO MSD ist zwar hübsch. Aber andere auch ;-) + if (if_desc->interface_class == 8) { + best_if = if_desc; + break; + } + position = (void *)((uintptr_t)position + + sizeof(struct interface_desc) + + if_desc->num_endpoints * sizeof(struct endpoint_desc)); + } + usb11_do_control(device, HOST_TO_DEV, NULL, 0, STD_REQUEST, REC_DEVICE, + SET_INTERFACE, best_if->interface_number, 0); + device->interface_desc = (void *)best_if; + if (best_if->iInterface) { + name = usb11_do_control(device, DEV_TO_HOST, NULL, 64, STD_REQUEST, + REC_DEVICE, GET_DESCRIPTOR, + (DESC_STRING << 8) | best_if->iInterface, 0); + if (name == NULL) { + return 0; + } + d1printf("Using interface "); + for (int i = 2; i < name[0]; i += 2) { + _d1printf("%c", name[i]); + } + _d1printf(".\n"); + } + d1printf("Configuration: %i:%i (%i)\n", conf_desc->config_value, + best_if->interface_number, best_if->interface_class); + + if (!dev_desc->class_id) { //Composite Device + device->class_id = best_if->interface_class; + device->subclass_id = best_if->interface_subclass; + device->protocol_id = best_if->interface_protocol; + } else { + device->class_id = dev_desc->class_id; + device->subclass_id = dev_desc->subclass_id; + device->protocol_id = dev_desc->protocol_id; + } + + if (best_if->interface_class == USBDC_HUB) { + enumerate_hub(device); + } + + return 1; +} + +void usb11_enumerate(struct cdi_usb_device *device) +{ + if (!usb11_real_enumerate(device)) { + free(device->ep0->endpoint); + free(device->ep0); + } +} + +static void reset_hub_device(struct cdi_usb_device *usbdev) +{ + usb11_do_control(usbdev->hub, HOST_TO_DEV, NULL, 0, CLS_REQUEST, REC_OTHER, + SET_FEATURE, PORTF_RESET, usbdev->port + 1); + cdi_sleep_ms(20); +} + +static void enumerate_hub(struct cdi_usb_device *usbdev) +{ + struct hub_desc *hub_desc; + struct cdi_usb_device *down; + uint16_t *port_status; + int i; + + //Mehr als 8 Ports sollte es nicht geben, die Größe des Deskriptors wird + //daher wohl nicht größer als sizeof()+16 werden + hub_desc = usb11_do_control(usbdev, DEV_TO_HOST, NULL, + sizeof(*hub_desc) + 16, CLS_REQUEST, REC_DEVICE, GET_DESCRIPTOR, + DESC_DEVICE << 8, 0); + for (i = 0; i < hub_desc->nbr_ports; i++) { + port_status = usb11_do_control(usbdev, DEV_TO_HOST, NULL, 4, + CLS_REQUEST,REC_OTHER, GET_STATUS, 0, i + 1); + if (!(port_status[0] & PORT_DEVICE)) { + continue; + } + //Strom an + usb11_do_control(usbdev, HOST_TO_DEV, NULL, 0, CLS_REQUEST, REC_OTHER, + SET_FEATURE, PORTF_POWER, i + 1); + cdi_sleep_ms(hub_desc->pwron2pwrgood * 2); + down = malloc(sizeof(struct cdi_usb_device)); + down->hc = usbdev->hc; + down->hub = usbdev; + down->id = 0; + down->port = i; + down->speed = (port_status[0] & PORT_LOWSPEED) ? + CDI_USB_LOW_SPEED : CDI_USB_FULL_SPEED; + down->reset = &reset_hub_device; + cdi_usb_device_init(down); + } +} diff --git a/usb11/include/control.h b/usb11/include/control.h new file mode 100644 index 0000000..97edefc --- /dev/null +++ b/usb11/include/control.h @@ -0,0 +1,31 @@ +/***************************************************************************** +* Copyright (c) 2009 Max Reitz * +* * +* Permission is hereby granted, free of charge, to any person obtaining a * +* copy of this software and associated documentation files (the "Software"), * +* to deal in the Software without restriction, including without limitation * +* the rights to use, copy, modify, merge, publish, distribute, sublicense, * +* and/or sell copies of the Software, and to permit persons to whom the * +* Software is furnished to do so, subject to the following conditions: * +* * +* The above copyright notice and this permission notice shall be included in * +* all copies or substantial portions of the Software. * +* * +* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * +* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * +* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL * +* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * +* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * +* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER * +* DEALINGS IN THE SOFTWARE. * +*****************************************************************************/ + +#ifndef CONTROL_H +#define CONTROL_H + +#include <cdi/lists.h> +#include <cdi/usb.h> + +void usb11_enumerate(struct cdi_usb_device *device); + +#endif diff --git a/usb11/include/transfer.h b/usb11/include/transfer.h new file mode 100644 index 0000000..3b0f086 --- /dev/null +++ b/usb11/include/transfer.h @@ -0,0 +1,38 @@ +/***************************************************************************** +* Copyright (c) 2009 Max Reitz * +* * +* Permission is hereby granted, free of charge, to any person obtaining a * +* copy of this software and associated documentation files (the "Software"), * +* to deal in the Software without restriction, including without limitation * +* the rights to use, copy, modify, merge, publish, distribute, sublicense, * +* and/or sell copies of the Software, and to permit persons to whom the * +* Software is furnished to do so, subject to the following conditions: * +* * +* The above copyright notice and this permission notice shall be included in * +* all copies or substantial portions of the Software. * +* * +* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * +* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * +* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL * +* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * +* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * +* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER * +* DEALINGS IN THE SOFTWARE. * +*****************************************************************************/ + +#ifndef TRANSFER_H +#define TRANSFER_H + +#include <stddef.h> + +#include <cdi/usb.h> + +void *usb11_do_control(struct cdi_usb_device *device, int direction, + void *buffer, int length, int rtype, int recipient, int request, int value, + int index); +void *usb11_export_control(struct cdi_usb_device *device, + struct cdi_usb_control_transfer *transfer); +cdi_usb_status_t usb11_send_packets(struct cdi_usb_packet *packets, + size_t num_packets); + +#endif diff --git a/usb11/include/usb-structs.h b/usb11/include/usb-structs.h new file mode 100644 index 0000000..427d0e5 --- /dev/null +++ b/usb11/include/usb-structs.h @@ -0,0 +1,184 @@ +/***************************************************************************** +* Copyright (c) 2009 Max Reitz * +* * +* Permission is hereby granted, free of charge, to any person obtaining a * +* copy of this software and associated documentation files (the "Software"), * +* to deal in the Software without restriction, including without limitation * +* the rights to use, copy, modify, merge, publish, distribute, sublicense, * +* and/or sell copies of the Software, and to permit persons to whom the * +* Software is furnished to do so, subject to the following conditions: * +* * +* The above copyright notice and this permission notice shall be included in * +* all copies or substantial portions of the Software. * +* * +* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * +* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * +* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL * +* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * +* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * +* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER * +* DEALINGS IN THE SOFTWARE. * +*****************************************************************************/ + +#ifndef USB_STRUCTS_H +#define USB_STRUCTS_H + +#include <stdint.h> + + +#define NO_DATA 0x01 +#define DEV_TO_HOST 0x80 +#define HOST_TO_DEV 0x00 +#define STD_REQUEST 0x00 +#define CLS_REQUEST 0x20 +#define VEN_REQUEST 0x40 +#define REC_DEVICE 0x00 +#define REC_INTERFACE 0x01 +#define REC_ENDPOINT 0x02 +#define REC_OTHER 0x03 + +#define GET_STATUS 0 +#define CLEAR_FEATURE 1 +#define SET_FEATURE 3 +#define SET_ADDRESS 5 +#define GET_DESCRIPTOR 6 +#define SET_DESCRIPTOR 7 +#define GET_CONFIGURATION 8 +#define SET_CONFIGURATION 9 +#define GET_INTERFACE 10 +#define SET_INTERFACE 11 +#define SYNC_FRAME 12 + +#define PORT_DEVICE 0x0001 +#define PORT_ENABLED 0x0002 +#define PORT_SUSPENDED 0x0004 +#define PORT_OVERCURRENT 0x0008 +#define PORT_RESET 0x0010 +#define PORT_POWER 0x0100 +#define PORT_LOWSPEED 0x0200 +#define PORT_HIGHSPEED 0x0400 +#define PORT_TEST 0x0800 +#define PORT_INDICATOR 0x1000 + +#define PORTF_CONNECTION 0 +#define PORTF_ENABLE 1 +#define PORTF_SUSPEND 2 +#define PORTF_OVERCURRENT 3 +#define PORTF_RESET 4 +#define PORTF_POWER 8 +#define PORTF_LOWSPEED 9 +#define PORTF_HIGHSPEED 10 +#define PORTF_C_CONNECTION 16 +#define PORTF_C_ENABLE 17 +#define PORTF_C_SUSPEND 18 +#define PORTF_C_OVERCURRENT 19 +#define PORTF_C_RESET 20 +#define PORTF_TEST 21 +#define PORTF_INDICATOR 22 + +#define DESC_DEVICE 1 +#define DESC_CONFIGURATION 2 +#define DESC_STRING 3 +#define DESC_INTERFACE 4 +#define DESC_ENDPOINT 5 +#define DESC_DEVICE_QUALIFIER 6 +#define DESC_OTHER_SPEED_CONFIGURATION 7 +#define DESC_INTERFACE_POWER 8 + + +struct setup_packet +{ + uint8_t request_type; + uint8_t request; + uint16_t value; + uint16_t index; + uint16_t length; +} __attribute__((packed)); + +struct device_desc +{ + uint8_t length; + uint8_t descriptor_type; + uint16_t bcdUSB; + uint8_t class_id; + uint8_t subclass_id; + uint8_t protocol_id; + uint8_t max_packet_size0; + uint16_t vendor_id; + uint16_t device_id; + uint16_t bcdDevice; + uint8_t iManufacturer; + uint8_t iProduct; + uint8_t iSerialNumber; + uint8_t num_configurations; +} __attribute__((packed)); + +struct config_desc +{ + uint8_t length; + uint8_t descriptor_type; + uint16_t total_length; + uint8_t num_interfaces; + uint8_t config_value; + uint8_t iConfiguration; + uint8_t attributes; + uint8_t max_power; +} __attribute__((packed)); + +struct interface_desc +{ + uint8_t length; + uint8_t descriptor_type; + uint8_t interface_number; + uint8_t alternate_setting; + uint8_t num_endpoints; + uint8_t interface_class; + uint8_t interface_subclass; + uint8_t interface_protocol; + uint8_t iInterface; +} __attribute__((packed)); + +struct endpoint_desc +{ + uint8_t length; + uint8_t descriptor_type; + uint8_t endpoint_address; + uint8_t attributes; + uint16_t max_packet_size; + uint8_t interval; +} __attribute__((packed)); + +struct hub_desc +{ + uint8_t length; + uint8_t descriptor_type; + uint8_t nbr_ports; + uint16_t hub_characteristics; + uint8_t pwron2pwrgood; + uint8_t hub_contr_current; +} __attribute__((packed)); + +typedef enum +{ + USBDC_COMPOSITE = 0x00, + USBDC_AUDIO = 0x01, + USBDC_COMM_CDC = 0x02, + USBDC_HID = 0x03, + USBDC_PID = 0x05, + USBDC_IMAGE = 0x06, + USBDC_PRINTER = 0x07, + USBDC_MSC = 0x08, + USBDC_HUB = 0x09, + USBDC_CDC_DATA = 0x0A, + USBDC_CHIP = 0x0B, + USBDC_SECURITY = 0x0D, + USBDC_VIDEO = 0x0E, + USBDC_HEALTH = 0x0F, + USBDC_DIAGNOSIS = 0xDC, + USBDC_WIRELESS = 0xE0, + USBDC_MISC = 0xEF, + USBDC_SOFT_SPEC = 0xFE, + USBDC_VENDOR_SPEC = 0xFF +} usb_class_t; + +#endif diff --git a/usb11/include/usb11.h b/usb11/include/usb11.h new file mode 100644 index 0000000..77634e9 --- /dev/null +++ b/usb11/include/usb11.h @@ -0,0 +1,41 @@ +/***************************************************************************** +* Copyright (c) 2009 Max Reitz * +* * +* Permission is hereby granted, free of charge, to any person obtaining a * +* copy of this software and associated documentation files (the "Software"), * +* to deal in the Software without restriction, including without limitation * +* the rights to use, copy, modify, merge, publish, distribute, sublicense, * +* and/or sell copies of the Software, and to permit persons to whom the * +* Software is furnished to do so, subject to the following conditions: * +* * +* The above copyright notice and this permission notice shall be included in * +* all copies or substantial portions of the Software. * +* * +* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * +* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * +* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL * +* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * +* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * +* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER * +* DEALINGS IN THE SOFTWARE. * +*****************************************************************************/ + +#ifndef USB11_H +#define USB11_H + +#include <stdio.h> + +//#define DEBUG + +#ifdef DEBUG +#define d1printf(...) printf("[usb 1.1] " __VA_ARGS__) +#define _d1printf(...) printf(__VA_ARGS__) +#else +#define d1printf(...) +#define _d1printf(...) +#endif + +#define d0printf(...) printf("[usb 1.1] " __VA_ARGS__) +#define _d0printf(...) printf(__VA_ARGS__) + +#endif diff --git a/usb11/main.c b/usb11/main.c new file mode 100644 index 0000000..e381062 --- /dev/null +++ b/usb11/main.c @@ -0,0 +1,58 @@ +/***************************************************************************** +* Copyright (c) 2009 Max Reitz * +* * +* Permission is hereby granted, free of charge, to any person obtaining a * +* copy of this software and associated documentation files (the "Software"), * +* to deal in the Software without restriction, including without limitation * +* the rights to use, copy, modify, merge, publish, distribute, sublicense, * +* and/or sell copies of the Software, and to permit persons to whom the * +* Software is furnished to do so, subject to the following conditions: * +* * +* The above copyright notice and this permission notice shall be included in * +* all copies or substantial portions of the Software. * +* * +* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * +* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * +* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL * +* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * +* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * +* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER * +* DEALINGS IN THE SOFTWARE. * +*****************************************************************************/ + +#include <cdi/misc.h> +#include <cdi/usb.h> + +#include "control.h" +#include "transfer.h" + +#define DRIVER_NAME "USB 1.1" + +int init_usb11(void); + +static struct cdi_usb_driver driver = { + .drv = { + .type = CDI_USB, + .name = DRIVER_NAME, + .devices = NULL, + .init_device = NULL, + .remove_device = NULL, + .init = &init_usb11, + .destroy = NULL + }, + .speeds = CDI_USB_LOW_SPEED | CDI_USB_FULL_SPEED, + .enumerate_device = &usb11_enumerate, + .send_packets = &usb11_send_packets, + .do_control = &usb11_export_control +}; + +CDI_DRIVER(DRIVER_NAME, driver) + +int init_usb11() +{ + cdi_init(); + + cdi_usb_driver_init(&driver); + + return 0; +} diff --git a/usb11/transfer.c b/usb11/transfer.c new file mode 100644 index 0000000..eb4f949 --- /dev/null +++ b/usb11/transfer.c @@ -0,0 +1,223 @@ +/***************************************************************************** +* Copyright (c) 2009 Max Reitz * +* * +* Permission is hereby granted, free of charge, to any person obtaining a * +* copy of this software and associated documentation files (the "Software"), * +* to deal in the Software without restriction, including without limitation * +* the rights to use, copy, modify, merge, publish, distribute, sublicense, * +* and/or sell copies of the Software, and to permit persons to whom the * +* Software is furnished to do so, subject to the following conditions: * +* * +* The above copyright notice and this permission notice shall be included in * +* all copies or substantial portions of the Software. * +* * +* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * +* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, * +* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL * +* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER * +* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING * +* FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER * +* DEALINGS IN THE SOFTWARE. * +*****************************************************************************/ + +#include <stddef.h> +#include <stdlib.h> + +#include <cdi/usb.h> + +#include "transfer.h" +#include "usb11.h" +#include "usb-structs.h" + +#define MIN(a, b) ((a) < (b) ? (a) : (b)) + +/** + * Verarbeitet USB-Pakete. + * + * @param packet Die Paketliste + * @param num_packets Anzahl der Pakete + * + * @return Status + */ + +cdi_usb_status_t usb11_send_packets(struct cdi_usb_packet *packets, + size_t num_packets) +{ + cdi_usb_status_t error = CDI_USB_NAK; + int i = 0, mps; + int num_out_packets; + struct cdi_usb_pipe *pipe; + struct cdi_usb_device *device; + struct cdi_usb_packet *out_packets; + struct endpoint_desc *ep; + struct cdi_usb_hcd *hcd; + + if (num_packets < 1) { + return CDI_USB_TRIVIAL_ERROR; + } + + // Alle Pakete muessen dieselbe Pipe benutzen + pipe = packets[0].pipe; + for (i = 1; i < (int)num_packets; i++) { + if (packets[i].pipe != pipe) { + return CDI_USB_TRIVIAL_ERROR; + } + } + + device = pipe->device; + hcd = (struct cdi_usb_hcd *)device->hc->dev.driver; + ep = (struct endpoint_desc *)pipe->endpoint; + + // Pruefen, wie viele Pakete wir draus machen muessen + mps = ep->max_packet_size; + num_out_packets = 0; + for (i = 0; i < (int)num_packets; i++) { + int num = (packets[i].length + mps - 1) / mps; + if (num > 0) { + num_out_packets += num; + } else { + // Pakete ohne Daten wollen auch gesendet werden + num_out_packets++; + } + } + + // Ggf. Pakete kopieren und splitten + if (num_out_packets == (int)num_packets) { + out_packets = packets; + } else { + int j; + int cur = 0; + + out_packets = calloc(num_out_packets, sizeof(*out_packets)); + for (i = 0; i < (int)num_packets; i++) { + int num = (packets[i].length + mps - 1) / mps; + if (num == 0) { + num = 1; + } + + for (j = 0; j < num; j++) { + out_packets[cur].pipe = pipe; + out_packets[cur].type = packets[i].type; + out_packets[cur].data = packets[i].data; + out_packets[cur].length = MIN((int)packets[i].length, mps); + out_packets[cur].condition = CDI_USB_NAK; + + packets[i].data = (void *)((uintptr_t)packets[i].data + + out_packets[cur].length); + packets[i].length -= out_packets[cur].length; + cur++; + } + } + } + + error = hcd->send_packets(out_packets, num_out_packets); + if (error & CDI_USB_STALLED) { + d0printf("ENDPOINT 0x%02X OF DEVICE %i STALLED!\n", + ep->endpoint_address, device->id); + usb11_do_control(device, HOST_TO_DEV | NO_DATA, NULL, 0, STD_REQUEST, + REC_ENDPOINT, CLEAR_FEATURE, 0, ep->endpoint_address); + } else if (error & CDI_USB_NAK) { + // Nicht angenommene Pakete (FIXME: einzeln) senden + for (i = 0; i < num_out_packets; i++) { + if (!(out_packets[i].condition & CDI_USB_NAK)) { + continue; + } + error = CDI_USB_NAK; + while (error & CDI_USB_NAK) { + error = hcd->send_packets(&out_packets[i], 1); + if (error & CDI_USB_NAK) { + cdi_sleep_ms(5); + } + } + } + } + + if (out_packets != packets) { + free(out_packets); + } + + return error; +} + +void *usb11_do_control(struct cdi_usb_device *device, int direction, + void *buffer, int length, int rtype, int recipient, int request, int value, + int index) +{ + int no_data, alloced_here = 0; + cdi_usb_status_t rval; + struct setup_packet _setup; + struct setup_packet *setup = &_setup; + + no_data = direction & NO_DATA; + direction &= 0x80; + + setup->request_type = direction | (rtype & 0x60) | (recipient & 0x1F); + setup->request = request; + setup->value = value; + setup->index = index; + setup->length = length; + + struct cdi_usb_packet setup_packet = { + .pipe = device->ep0, + .type = CDI_USB_PACKET_SETUP, + .data = setup, + .length = sizeof(*setup), + .use_toggle = TOGGLE_UNSPECIFIC + }; + + if (usb11_send_packets(&setup_packet, 1)) { + return NULL; + } + + if (no_data) { + rval = CDI_USB_NO_ERROR; + buffer = (void *)0xFFFFFFFF; //Kein Fehler, aber auch keine Daten + } else { + if ((direction != HOST_TO_DEV) || (length && (buffer == NULL))) { + buffer = malloc(length); + alloced_here = 1; + } + + struct cdi_usb_packet data_packet = { + .pipe = device->ep0, + .type = (direction == DEV_TO_HOST ? + CDI_USB_PACKET_IN : CDI_USB_PACKET_OUT), + .data = buffer, + .length = length, + .use_toggle = TOGGLE_UNSPECIFIC + }; + + rval = usb11_send_packets(&data_packet, 1); + } + + if (rval == CDI_USB_NO_ERROR) { + struct cdi_usb_packet ack_packet = { + .pipe = device->ep0, + .data = NULL, + .length = 0, + .use_toggle = TOGGLE_1 + }; + + if (no_data || (direction == HOST_TO_DEV)) { + ack_packet.type = CDI_USB_PACKET_IN; + } else { + ack_packet.type = CDI_USB_PACKET_OUT; + } + + rval = usb11_send_packets(&ack_packet, 1); + } + + if ((rval != CDI_USB_NO_ERROR) && alloced_here) { + free(buffer); + } + + return (rval == CDI_USB_NO_ERROR) ? buffer : NULL; +} + +void *usb11_export_control(struct cdi_usb_device *device, + struct cdi_usb_control_transfer *transfer) +{ + return usb11_do_control(device, transfer->direction, transfer->buffer, + transfer->length, transfer->rtype, transfer->recipient, + transfer->request, transfer->value, transfer->index); +} -- 1.6.0.2