| /* ---------------------------------------------------------------------------- |
| * ATMEL Microcontroller Software Support |
| * ---------------------------------------------------------------------------- |
| * Copyright (c) 2009, Atmel Corporation |
| * |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions are met: |
| * |
| * - Redistributions of source code must retain the above copyright notice, |
| * this list of conditions and the disclaimer below. |
| * |
| * Atmel's name may not be used to endorse or promote products derived from |
| * this software without specific prior written permission. |
| * |
| * DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR |
| * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF |
| * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE |
| * DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT, |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT |
| * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, |
| * OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF |
| * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING |
| * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, |
| * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| * ---------------------------------------------------------------------------- |
| */ |
| |
| /*---------------------------------------------------------------------------- |
| * Headers |
| *----------------------------------------------------------------------------*/ |
| |
| #include "board.h" |
| |
| /*------------------------------------------------------------------------------ |
| * USB String descriptors |
| *------------------------------------------------------------------------------*/ |
| |
| const unsigned char productStringDescriptor[] = { |
| |
| USBStringDescriptor_LENGTH(8), |
| USBGenericDescriptor_STRING, |
| USBStringDescriptor_UNICODE('S'), |
| USBStringDescriptor_UNICODE('I'), |
| USBStringDescriptor_UNICODE('M'), |
| USBStringDescriptor_UNICODE('t'), |
| USBStringDescriptor_UNICODE('r'), |
| USBStringDescriptor_UNICODE('a'), |
| USBStringDescriptor_UNICODE('c'), |
| USBStringDescriptor_UNICODE('e'), |
| }; |
| |
| const unsigned char snifferConfigStringDescriptor[] = { |
| |
| USBStringDescriptor_LENGTH(15), |
| USBGenericDescriptor_STRING, |
| USBStringDescriptor_UNICODE('S'), |
| USBStringDescriptor_UNICODE('I'), |
| USBStringDescriptor_UNICODE('M'), |
| USBStringDescriptor_UNICODE('t'), |
| USBStringDescriptor_UNICODE('r'), |
| USBStringDescriptor_UNICODE('a'), |
| USBStringDescriptor_UNICODE('c'), |
| USBStringDescriptor_UNICODE('e'), |
| USBStringDescriptor_UNICODE('S'), |
| USBStringDescriptor_UNICODE('n'), |
| USBStringDescriptor_UNICODE('i'), |
| USBStringDescriptor_UNICODE('f'), |
| USBStringDescriptor_UNICODE('f'), |
| USBStringDescriptor_UNICODE('e'), |
| USBStringDescriptor_UNICODE('r'), |
| }; |
| |
| const unsigned char CCIDConfigStringDescriptor[] = { |
| |
| USBStringDescriptor_LENGTH(12), |
| USBGenericDescriptor_STRING, |
| USBStringDescriptor_UNICODE('S'), |
| USBStringDescriptor_UNICODE('I'), |
| USBStringDescriptor_UNICODE('M'), |
| USBStringDescriptor_UNICODE('t'), |
| USBStringDescriptor_UNICODE('r'), |
| USBStringDescriptor_UNICODE('a'), |
| USBStringDescriptor_UNICODE('c'), |
| USBStringDescriptor_UNICODE('e'), |
| USBStringDescriptor_UNICODE('C'), |
| USBStringDescriptor_UNICODE('C'), |
| USBStringDescriptor_UNICODE('I'), |
| USBStringDescriptor_UNICODE('D'), |
| }; |
| |
| const unsigned char phoneConfigStringDescriptor[] = { |
| |
| USBStringDescriptor_LENGTH(13), |
| USBGenericDescriptor_STRING, |
| USBStringDescriptor_UNICODE('S'), |
| USBStringDescriptor_UNICODE('I'), |
| USBStringDescriptor_UNICODE('M'), |
| USBStringDescriptor_UNICODE('t'), |
| USBStringDescriptor_UNICODE('r'), |
| USBStringDescriptor_UNICODE('a'), |
| USBStringDescriptor_UNICODE('c'), |
| USBStringDescriptor_UNICODE('e'), |
| USBStringDescriptor_UNICODE('P'), |
| USBStringDescriptor_UNICODE('h'), |
| USBStringDescriptor_UNICODE('o'), |
| USBStringDescriptor_UNICODE('n'), |
| USBStringDescriptor_UNICODE('e'), |
| }; |
| |
| |
| const unsigned char MITMConfigStringDescriptor[] = { |
| |
| USBStringDescriptor_LENGTH(12), |
| USBGenericDescriptor_STRING, |
| USBStringDescriptor_UNICODE('S'), |
| USBStringDescriptor_UNICODE('I'), |
| USBStringDescriptor_UNICODE('M'), |
| USBStringDescriptor_UNICODE('t'), |
| USBStringDescriptor_UNICODE('r'), |
| USBStringDescriptor_UNICODE('a'), |
| USBStringDescriptor_UNICODE('c'), |
| USBStringDescriptor_UNICODE('e'), |
| USBStringDescriptor_UNICODE('M'), |
| USBStringDescriptor_UNICODE('I'), |
| USBStringDescriptor_UNICODE('T'), |
| USBStringDescriptor_UNICODE('M'), |
| }; |
| |
| enum strDescNum { |
| PRODUCT_STRING = 1, SNIFFER_CONF_STR, CCID_CONF_STR, PHONE_CONF_STR, MITM_CONF_STR, STRING_DESC_CNT |
| }; |
| |
| /** List of string descriptors used by the device */ |
| const unsigned char *stringDescriptors[] = { |
| /* FIXME: Is it true that I can't use the string desc #0, |
| * because 0 also stands for "no string desc"? |
| * on the other hand, dmesg output: |
| * "string descriptor 0 malformed (err = -61), defaulting to 0x0409" */ |
| 0, |
| productStringDescriptor, |
| snifferConfigStringDescriptor, |
| CCIDConfigStringDescriptor, |
| phoneConfigStringDescriptor, |
| MITMConfigStringDescriptor |
| }; |
| |
| /* Endpoint numbers */ |
| #define DATAOUT 1 |
| #define DATAIN 2 |
| |
| /*------------------------------------------------------------------------------ |
| * USB Device descriptors |
| *------------------------------------------------------------------------------*/ |
| |
| typedef struct _SIMTraceDriverConfigurationDescriptorSniffer { |
| |
| /** Standard configuration descriptor. */ |
| USBConfigurationDescriptor configuration; |
| USBInterfaceDescriptor sniffer; |
| USBEndpointDescriptor sniffer_dataOut; |
| USBEndpointDescriptor sniffer_dataIn; |
| |
| } __attribute__ ((packed)) SIMTraceDriverConfigurationDescriptorSniffer; |
| |
| const SIMTraceDriverConfigurationDescriptorSniffer configurationDescriptorSniffer = { |
| /* Standard configuration descriptor */ |
| { |
| sizeof(USBConfigurationDescriptor), |
| USBGenericDescriptor_CONFIGURATION, |
| sizeof(SIMTraceDriverConfigurationDescriptorSniffer), |
| 1, /* There is one interface in this configuration */ |
| 1, /* This is configuration #1 */ |
| SNIFFER_CONF_STR, /* string descriptor for this configuration */ |
| USBD_BMATTRIBUTES, |
| USBConfigurationDescriptor_POWER(100) |
| }, |
| /* Communication class interface standard descriptor */ |
| { |
| sizeof(USBInterfaceDescriptor), |
| USBGenericDescriptor_INTERFACE, |
| 0, /* This is interface #0 */ |
| 0, /* This is alternate setting #0 for this interface */ |
| 2, /* This interface uses 2 endpoints */ |
| 0xff, /* Descriptor Class: Vendor specific */ |
| 0, /* No subclass */ |
| 0, /* No l */ |
| SNIFFER_CONF_STR /* Third in string descriptor for this interface */ |
| }, |
| /* Bulk-OUT endpoint standard descriptor */ |
| { |
| sizeof(USBEndpointDescriptor), |
| USBGenericDescriptor_ENDPOINT, |
| USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_OUT, |
| DATAOUT), |
| USBEndpointDescriptor_BULK, |
| MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(DATAOUT), |
| USBEndpointDescriptor_MAXBULKSIZE_FS), |
| 0 /* Must be 0 for full-speed bulk endpoints */ |
| }, |
| /* Bulk-IN endpoint descriptor */ |
| { |
| sizeof(USBEndpointDescriptor), |
| USBGenericDescriptor_ENDPOINT, |
| USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN, |
| DATAIN), |
| USBEndpointDescriptor_BULK, |
| MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(DATAIN), |
| USBEndpointDescriptor_MAXBULKSIZE_FS), |
| 0 /* Must be 0 for full-speed bulk endpoints */ |
| } |
| }; |
| |
| /* FIXME: CCID descriptor: External C file */ |
| typedef struct { |
| |
| USBConfigurationDescriptor configuration; |
| USBInterfaceDescriptor interface; |
| CCIDDescriptor ccid; |
| USBEndpointDescriptor bulkOut; |
| USBEndpointDescriptor bulkIn; |
| USBEndpointDescriptor interruptIn; |
| } __attribute__ ((packed)) CCIDDriverConfigurationDescriptorsCCID; |
| |
| const CCIDDriverConfigurationDescriptorsCCID configurationDescriptorCCID = { 0 }; |
| |
| /* SIM card emulator */ |
| typedef struct _SIMTraceDriverConfigurationDescriptorPhone { |
| |
| /** Standard configuration descriptor. */ |
| USBConfigurationDescriptor configuration; |
| USBInterfaceDescriptor sniffer; |
| USBEndpointDescriptor sniffer_dataOut; |
| USBEndpointDescriptor sniffer_dataIn; |
| |
| } __attribute__ ((packed)) SIMTraceDriverConfigurationDescriptorPhone; |
| |
| const SIMTraceDriverConfigurationDescriptorPhone configurationDescriptorPhone = { |
| /* Standard configuration descriptor */ |
| { |
| sizeof(USBConfigurationDescriptor), |
| USBGenericDescriptor_CONFIGURATION, |
| sizeof(SIMTraceDriverConfigurationDescriptorSniffer), |
| 1, /* There is one interface in this configuration */ |
| 2, /* This is configuration #2 */ |
| PHONE_CONF_STR, /* string descriptor for this configuration */ |
| USBD_BMATTRIBUTES, |
| USBConfigurationDescriptor_POWER(100) |
| }, |
| /* Communication class interface standard descriptor */ |
| { |
| sizeof(USBInterfaceDescriptor), |
| USBGenericDescriptor_INTERFACE, |
| 0, /* This is interface #0 */ |
| 0, /* This is alternate setting #0 for this interface */ |
| 2, /* This interface uses 2 endpoints */ |
| 0xff, /* Descriptor Class: Vendor specific */ |
| 0, /* No subclass */ |
| 0, /* No l */ |
| PHONE_CONF_STR /* Third in string descriptor for this interface */ |
| }, |
| /* Bulk-OUT endpoint standard descriptor */ |
| { |
| sizeof(USBEndpointDescriptor), |
| USBGenericDescriptor_ENDPOINT, |
| USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_OUT, |
| DATAOUT), |
| USBEndpointDescriptor_BULK, |
| MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(DATAOUT), |
| USBEndpointDescriptor_MAXBULKSIZE_FS), |
| 0 /* Must be 0 for full-speed bulk endpoints */ |
| }, |
| /* Bulk-IN endpoint descriptor */ |
| { |
| sizeof(USBEndpointDescriptor), |
| USBGenericDescriptor_ENDPOINT, |
| USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN, |
| DATAIN), |
| USBEndpointDescriptor_BULK, |
| MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(DATAIN), |
| USBEndpointDescriptor_MAXBULKSIZE_FS), |
| 0 /* Must be 0 for full-speed bulk endpoints */ |
| } |
| }; |
| |
| |
| typedef struct _SIMTraceDriverConfigurationDescriptorMITM { |
| |
| /** Standard configuration descriptor. */ |
| USBConfigurationDescriptor configuration; |
| USBInterfaceDescriptor simcard; |
| USBEndpointDescriptor simcard_dataOut; |
| USBEndpointDescriptor simcard_dataIn; |
| USBInterfaceDescriptor phone; |
| USBEndpointDescriptor phone_dataOut; |
| USBEndpointDescriptor phone_dataIn; |
| |
| } __attribute__ ((packed)) SIMTraceDriverConfigurationDescriptorMITM; |
| |
| const SIMTraceDriverConfigurationDescriptorMITM configurationDescriptorMITM = { |
| /* Standard configuration descriptor */ |
| { |
| sizeof(USBConfigurationDescriptor), |
| USBGenericDescriptor_CONFIGURATION, |
| sizeof(SIMTraceDriverConfigurationDescriptorMITM), |
| 2, /* There are two interfaces in this configuration */ |
| 3, /* This is configuration #3 */ |
| MITM_CONF_STR, /* string descriptor for this configuration */ |
| USBD_BMATTRIBUTES, |
| USBConfigurationDescriptor_POWER(100) |
| }, |
| /* Communication class interface standard descriptor */ |
| { |
| sizeof(USBInterfaceDescriptor), |
| USBGenericDescriptor_INTERFACE, |
| 0, /* This is interface #0 */ |
| 0, /* This is alternate setting #0 for this interface */ |
| 2, /* This interface uses 2 endpoints */ |
| //CDCCommunicationInterfaceDescriptor_CLASS, |
| 0xff, |
| // CDCCommunicationInterfaceDescriptor_ABSTRACTCONTROLMODEL, |
| 0, |
| // CDCCommunicationInterfaceDescriptor_NOPROTOCOL, |
| 0, |
| MITM_CONF_STR /* string descriptor for this interface */ |
| }, |
| /* Bulk-OUT endpoint standard descriptor */ |
| { |
| sizeof(USBEndpointDescriptor), |
| USBGenericDescriptor_ENDPOINT, |
| USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_OUT, |
| DATAOUT), |
| USBEndpointDescriptor_BULK, |
| MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(DATAOUT), |
| USBEndpointDescriptor_MAXBULKSIZE_FS), |
| 0 /* Must be 0 for full-speed bulk endpoints */ |
| }, |
| /* Bulk-IN endpoint descriptor */ |
| { |
| sizeof(USBEndpointDescriptor), |
| USBGenericDescriptor_ENDPOINT, |
| USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN, |
| DATAIN), |
| USBEndpointDescriptor_BULK, |
| MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(DATAIN), |
| USBEndpointDescriptor_MAXBULKSIZE_FS), |
| 0 /* Must be 0 for full-speed bulk endpoints */ |
| }, |
| /* Communication class interface standard descriptor */ |
| { |
| sizeof(USBInterfaceDescriptor), |
| USBGenericDescriptor_INTERFACE, |
| 1, /* This is interface #1 */ |
| 0, /* This is alternate setting #0 for this interface */ |
| 2, /* This interface uses 2 endpoints */ |
| 0xff, |
| 0, |
| 0, |
| 0, /* FIXME: string descriptor for this interface */ |
| }, |
| /* Bulk-OUT endpoint standard descriptor */ |
| { |
| sizeof(USBEndpointDescriptor), |
| USBGenericDescriptor_ENDPOINT, |
| USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_OUT, |
| DATAOUT), |
| USBEndpointDescriptor_BULK, |
| MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(DATAOUT), |
| USBEndpointDescriptor_MAXBULKSIZE_FS), |
| 0 /* Must be 0 for full-speed bulk endpoints */ |
| }, |
| /* Bulk-IN endpoint descriptor */ |
| { |
| sizeof(USBEndpointDescriptor), |
| USBGenericDescriptor_ENDPOINT, |
| USBEndpointDescriptor_ADDRESS(USBEndpointDescriptor_IN, |
| DATAIN), |
| USBEndpointDescriptor_BULK, |
| MIN(BOARD_USB_ENDPOINTS_MAXPACKETSIZE(DATAIN), |
| USBEndpointDescriptor_MAXBULKSIZE_FS), |
| 0 /* Must be 0 for full-speed bulk endpoints */ |
| } |
| }; |
| |
| |
| /** Standard USB device descriptor for the CDC serial driver */ |
| const USBDeviceDescriptor deviceDescriptor = { |
| |
| sizeof(USBDeviceDescriptor), |
| USBGenericDescriptor_DEVICE, |
| USBDeviceDescriptor_USB2_00, |
| 0xff, |
| // CDCDeviceDescriptor_CLASS, |
| 0xff, |
| // CDCDeviceDescriptor_SUBCLASS, |
| 0xff, |
| // CDCDeviceDescriptor_PROTOCOL, |
| BOARD_USB_ENDPOINTS_MAXPACKETSIZE(0), |
| ATMEL_VENDOR_ID, |
| SIMTRACE_PRODUCT_ID, |
| 1, /* Release number */ |
| 0, /* No string descriptor for manufacturer */ |
| PRODUCT_STRING, /* Index of product string descriptor */ |
| 0, /* No string descriptor for serial number */ |
| 3 /* Device has 4 possible configurations */ |
| }; |
| |
| const USBConfigurationDescriptor *configurationDescriptorsArr[] = { |
| &configurationDescriptorSniffer, |
| //&configurationDescriptorCCID, |
| &configurationDescriptorPhone, |
| &configurationDescriptorMITM, |
| }; |
| |
| |
| /* AT91SAM3S does only support full speed, but not high speed USB */ |
| const USBDDriverDescriptors driverDescriptors = { |
| &deviceDescriptor, |
| (USBConfigurationDescriptor **) &(configurationDescriptorsArr), /* first full-speed configuration descriptor */ |
| 0, /* No full-speed device qualifier descriptor */ |
| 0, /* No full-speed other speed configuration */ |
| 0, /* No high-speed device descriptor */ |
| 0, /* No high-speed configuration descriptor */ |
| 0, /* No high-speed device qualifier descriptor */ |
| 0, /* No high-speed other speed configuration descriptor */ |
| stringDescriptors, |
| STRING_DESC_CNT /* cnt string descriptors in list */ |
| }; |
| |
| /*---------------------------------------------------------------------------- |
| * Functions |
| *----------------------------------------------------------------------------*/ |
| |
| /** |
| * \brief Configure 48MHz Clock for USB |
| */ |
| static void _ConfigureUsbClock(void) |
| { |
| /* Enable PLLB for USB */ |
| // FIXME: are these the dividers I actually need? |
| // FIXME: I could just use PLLA, since it has a frequ of 48Mhz anyways? |
| PMC->CKGR_PLLBR = CKGR_PLLBR_DIVB(5) |
| | CKGR_PLLBR_MULB(0xc) /* MULT+1=0xd*/ |
| | CKGR_PLLBR_PLLBCOUNT_Msk; |
| while((PMC->PMC_SR & PMC_SR_LOCKB) == 0); |
| /* USB Clock uses PLLB */ |
| PMC->PMC_USB = PMC_USB_USBDIV(0) /* /1 (no divider) */ |
| | PMC_USB_USBS; /* PLLB */ |
| } |
| |
| |
| void SIMtrace_USB_Initialize( void ) |
| { |
| _ConfigureUsbClock(); |
| // Get std USB driver |
| USBDDriver *pUsbd = USBD_GetDriver(); |
| |
| TRACE_DEBUG("."); |
| |
| // Initialize standard USB driver |
| USBDDriver_Initialize(pUsbd, |
| &driverDescriptors, |
| // FIXME: 2 interface settings supported in MITM mode |
| 0); // Multiple interface settings not supported |
| |
| USBD_Init(); |
| |
| USBD_Connect(); |
| |
| NVIC_EnableIRQ( UDP_IRQn ); |
| } |