2012-12-05 07:41:54 +08:00
|
|
|
|
/*
|
|
|
|
|
* at91sam7s USB CDC device implementation
|
|
|
|
|
*
|
|
|
|
|
* Copyright (c) 2012, Roel Verdult
|
|
|
|
|
* All rights reserved.
|
|
|
|
|
*
|
|
|
|
|
* Redistribution and use in source and binary forms, with or without
|
|
|
|
|
* modification, are permitted provided that the following conditions are met:
|
|
|
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
|
|
|
* notice, this list of conditions and the following disclaimer.
|
|
|
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
|
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
|
|
|
* documentation and/or other materials provided with the distribution.
|
|
|
|
|
* 3. Neither the name of the copyright holders nor the
|
|
|
|
|
* names of its contributors may be used to endorse or promote products
|
|
|
|
|
* derived from this software without specific prior written permission.
|
|
|
|
|
*
|
|
|
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS ''AS IS'' AND ANY
|
|
|
|
|
* EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
|
|
|
|
|
* WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
|
|
|
|
* DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDERS 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.
|
|
|
|
|
*
|
|
|
|
|
* based on the "Basic USB Example" from ATMEL (doc6123.pdf)
|
|
|
|
|
*
|
|
|
|
|
* @file usb_cdc.c
|
|
|
|
|
* @brief
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
#include "usb_cdc.h"
|
|
|
|
|
|
2017-10-11 16:15:41 +08:00
|
|
|
|
/*
|
|
|
|
|
AT91SAM7S256 USB Device Port
|
|
|
|
|
• Embedded 328-byte dual-port RAM for endpoints
|
|
|
|
|
• Four endpoints
|
|
|
|
|
– Endpoint 0: 8 bytes
|
|
|
|
|
– Endpoint 1 and 2: 64 bytes ping-pong
|
|
|
|
|
– Endpoint 3: 64 bytes
|
|
|
|
|
– Ping-pong Mode (two memory banks) for bulk endpoints
|
|
|
|
|
*/
|
|
|
|
|
|
2017-10-10 21:06:17 +08:00
|
|
|
|
#define AT91C_EP_CONTROL 0
|
2017-10-11 16:15:41 +08:00
|
|
|
|
#define AT91C_EP_CONTROL_SIZE 0x08
|
2017-10-10 21:06:17 +08:00
|
|
|
|
|
2012-12-05 07:41:54 +08:00
|
|
|
|
#define AT91C_EP_IN 2
|
2017-10-11 16:15:41 +08:00
|
|
|
|
#define AT91C_EP_IN_SIZE 0x40
|
2017-10-10 21:06:17 +08:00
|
|
|
|
|
|
|
|
|
#define AT91C_EP_OUT 1
|
2017-10-11 16:15:41 +08:00
|
|
|
|
#define AT91C_EP_OUT_SIZE 0x40
|
2017-10-10 21:06:17 +08:00
|
|
|
|
|
|
|
|
|
// Section: USB Descriptors
|
|
|
|
|
#define USB_DESCRIPTOR_DEVICE 0x01 // bDescriptorType for a Device Descriptor.
|
|
|
|
|
#define USB_DESCRIPTOR_CONFIGURATION 0x02 // bDescriptorType for a Configuration Descriptor.
|
|
|
|
|
#define USB_DESCRIPTOR_STRING 0x03 // bDescriptorType for a String Descriptor.
|
|
|
|
|
#define USB_DESCRIPTOR_INTERFACE 0x04 // bDescriptorType for an Interface Descriptor.
|
|
|
|
|
#define USB_DESCRIPTOR_ENDPOINT 0x05 // bDescriptorType for an Endpoint Descriptor.
|
|
|
|
|
#define USB_DESCRIPTOR_DEVICE_QUALIFIER 0x06 // bDescriptorType for a Device Qualifier.
|
|
|
|
|
#define USB_DESCRIPTOR_OTHER_SPEED 0x07 // bDescriptorType for a Other Speed Configuration.
|
|
|
|
|
#define USB_DESCRIPTOR_INTERFACE_POWER 0x08 // bDescriptorType for Interface Power.
|
|
|
|
|
#define USB_DESCRIPTOR_OTG 0x09 // bDescriptorType for an OTG Descriptor.
|
|
|
|
|
|
|
|
|
|
/* Configuration Attributes */
|
|
|
|
|
#define _DEFAULT (0x01<<7) //Default Value (Bit 7 is set)
|
|
|
|
|
#define _SELF (0x01<<6) //Self-powered (Supports if set)
|
|
|
|
|
#define _RWU (0x01<<5) //Remote Wakeup (Supports if set)
|
|
|
|
|
#define _HNP (0x01 << 1) //HNP (Supports if set)
|
|
|
|
|
#define _SRP (0x01) //SRP (Supports if set)
|
|
|
|
|
|
|
|
|
|
/* Endpoint Transfer Type */
|
|
|
|
|
#define _CTRL 0x00 //Control Transfer
|
|
|
|
|
#define _ISO 0x01 //Isochronous Transfer
|
|
|
|
|
#define _BULK 0x02 //Bulk Transfer
|
|
|
|
|
#define _INTERRUPT 0x03 //Interrupt Transfer
|
|
|
|
|
|
|
|
|
|
// (bit7 | 0 = OUT, 1 = IN)
|
|
|
|
|
#define _EP_IN 0x80
|
|
|
|
|
#define _EP_OUT 0x00
|
|
|
|
|
#define _EP01_OUT 0x01
|
|
|
|
|
#define _EP01_IN 0x81
|
|
|
|
|
#define _EP02_OUT 0x02
|
|
|
|
|
#define _EP02_IN 0x82
|
|
|
|
|
#define _EP03_OUT 0x03
|
|
|
|
|
#define _EP03_IN 0x83
|
|
|
|
|
|
2012-12-05 07:41:54 +08:00
|
|
|
|
|
2017-07-05 02:07:45 +08:00
|
|
|
|
/* WCID specific Request Code */
|
2017-09-29 05:14:51 +08:00
|
|
|
|
#define MS_OS_DESCRIPTOR_INDEX 0xEE
|
2017-07-05 02:07:45 +08:00
|
|
|
|
#define MS_VENDOR_CODE 0x1C
|
2017-09-29 05:14:51 +08:00
|
|
|
|
#define MS_EXTENDED_COMPAT_ID 0x04
|
|
|
|
|
#define MS_EXTENDED_PROPERTIES 0x05
|
2017-10-11 16:15:41 +08:00
|
|
|
|
#define MS_WCID_GET_DESCRIPTOR 0xC0
|
|
|
|
|
#define MS_WCID_GET_FEATURE_DESCRIPTOR 0xC1
|
2017-07-05 02:07:45 +08:00
|
|
|
|
|
|
|
|
|
static const char devDescriptor[] = {
|
2012-12-05 07:41:54 +08:00
|
|
|
|
/* Device descriptor */
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0x12, // Length
|
|
|
|
|
0x01, // Descriptor Type (DEVICE)
|
|
|
|
|
0x00,0x02, // Complies with USB Spec. Release (0200h = release 2.00) 0210 == release 2.10
|
|
|
|
|
0x02, // Device Class: CDC class code
|
|
|
|
|
0x02, // Device Subclass: CDC class sub code ACM [ice 0x02 = win10 virtual comport :) ]
|
|
|
|
|
0x00, // Device Protocol: CDC Device protocol
|
2017-10-11 16:15:41 +08:00
|
|
|
|
AT91C_EP_CONTROL_SIZE, // MaxPacketSize0
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0xc4,0x9a, // Vendor ID [0x9ac4 = J. Westhues]
|
|
|
|
|
0x8f,0x4b, // Product ID [0x4b8f = Proxmark-3 RFID Instrument]
|
2012-12-05 07:41:54 +08:00
|
|
|
|
0x01,0x00, // Device release number (0001)
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0x01, // index Manufacturer
|
|
|
|
|
0x02, // index Product
|
|
|
|
|
0x03, // index SerialNumber
|
|
|
|
|
0x01 // Number of Configs
|
2012-12-05 07:41:54 +08:00
|
|
|
|
};
|
|
|
|
|
|
2017-07-05 02:07:45 +08:00
|
|
|
|
static const char cfgDescriptor[] = {
|
2012-12-05 07:41:54 +08:00
|
|
|
|
/* ============== CONFIGURATION 1 =========== */
|
|
|
|
|
/* Configuration 1 descriptor */
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0x09, // Length
|
|
|
|
|
USB_DESCRIPTOR_CONFIGURATION, // Descriptor Type
|
|
|
|
|
0x43,0x00, // Total Length 2 EP + Control
|
|
|
|
|
0x02, // Number of Interfaces
|
|
|
|
|
0x01, // Index value of this Configuration
|
|
|
|
|
0x00, // Configuration string index
|
2017-10-11 16:15:41 +08:00
|
|
|
|
_DEFAULT, // Attributes 0xA0
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0xFA, // Max Power consumption
|
2012-12-05 07:41:54 +08:00
|
|
|
|
|
|
|
|
|
/* Communication Class Interface Descriptor Requirement */
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0x09, // Length
|
|
|
|
|
USB_DESCRIPTOR_INTERFACE, // Descriptor Type
|
|
|
|
|
0x00, // Interface Number
|
|
|
|
|
0x00, // Alternate Setting
|
|
|
|
|
0x01, // Number of Endpoints in this interface
|
|
|
|
|
0x02, // Interface Class code (CDC)
|
|
|
|
|
0x02, // Interface Subclass code (ACM)
|
|
|
|
|
0x01, // InterfaceProtocol (rfidler 0x00, pm3 0x01 == VT25)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
0x00, // iInterface
|
|
|
|
|
|
|
|
|
|
/* Header Functional Descriptor */
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0x05, // Function Length
|
|
|
|
|
0x24, // Descriptor type: CS_INTERFACE
|
|
|
|
|
0x00, // Descriptor subtype: Header Func Desc
|
|
|
|
|
0x10,0x01, // bcd CDC:1.1
|
2012-12-05 07:41:54 +08:00
|
|
|
|
|
|
|
|
|
/* ACM Functional Descriptor */
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0x04, // Function Length
|
|
|
|
|
0x24, // Descriptor Type: CS_INTERFACE
|
|
|
|
|
0x02, // Descriptor Subtype: ACM Func Desc
|
2017-10-11 16:15:41 +08:00
|
|
|
|
0x02, // Capabilities (rfidler 0x04, pm3 0x02, zero should also work )
|
2012-12-05 07:41:54 +08:00
|
|
|
|
|
|
|
|
|
/* Union Functional Descriptor */
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0x05, // Function Length
|
|
|
|
|
0x24, // Descriptor Type: CS_INTERFACE
|
|
|
|
|
0x06, // Descriptor Subtype: Union Func Desc
|
|
|
|
|
0x00, // MasterInterface: Communication Class Interface
|
|
|
|
|
0x01, // SlaveInterface0: Data Class Interface
|
2012-12-05 07:41:54 +08:00
|
|
|
|
|
|
|
|
|
/* Call Management Functional Descriptor */
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0x05, // Function Length
|
|
|
|
|
0x24, // Descriptor Type: CS_INTERFACE
|
|
|
|
|
0x01, // Descriptor Subtype: Call Management Func Desc
|
2017-10-11 16:15:41 +08:00
|
|
|
|
0x00, // Capabilities: D1 + D0 (ice 0x03, pm3 0x00, rfidler 0x00)
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0x01, // Data Interface: Data Class Interface 1
|
|
|
|
|
|
|
|
|
|
/* Endpoint descriptor */
|
|
|
|
|
0x07, // Length
|
|
|
|
|
USB_DESCRIPTOR_ENDPOINT, // Descriptor Type
|
|
|
|
|
_EP03_IN, // EndpointAddress, Endpoint 03-IN
|
|
|
|
|
_INTERRUPT, // Attributes
|
2017-10-11 16:15:41 +08:00
|
|
|
|
0x40, 0x00, // MaxPacket Size (ice 0x200, pm3 0x08)
|
2017-10-11 18:46:38 +08:00
|
|
|
|
0xFF, // Interval polling (rfidler 0x02, pm3 0xff)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
|
|
|
|
|
/* Data Class Interface Descriptor Requirement */
|
2017-10-10 21:06:17 +08:00
|
|
|
|
0x09, // Length
|
|
|
|
|
USB_DESCRIPTOR_INTERFACE, // Descriptor Type
|
|
|
|
|
0x01, // Interface Number
|
|
|
|
|
0x00, // Alternate Setting
|
|
|
|
|
0x02, // Number of Endpoints
|
|
|
|
|
0x0A, // Interface Class ( Data interface class )
|
|
|
|
|
0x00, // Interface Subclass
|
|
|
|
|
0x00, // Interface Protocol
|
|
|
|
|
0x00, // Interface - no string descriptor
|
|
|
|
|
|
|
|
|
|
/* Endpoint descriptor */
|
|
|
|
|
0x07, // Length
|
|
|
|
|
USB_DESCRIPTOR_ENDPOINT, // Descriptor Type
|
|
|
|
|
_EP01_OUT, // Endpoint Address, Endpoint 01-OUT
|
|
|
|
|
_BULK, // Attributes BULK
|
2017-10-11 16:15:41 +08:00
|
|
|
|
0x40, 0x00, // MaxPacket Size
|
2017-10-11 18:46:38 +08:00
|
|
|
|
0x00, // Interval (ignored for bulk)
|
2017-10-10 21:06:17 +08:00
|
|
|
|
|
|
|
|
|
/* Endpoint descriptor */
|
|
|
|
|
0x07, // Length
|
|
|
|
|
USB_DESCRIPTOR_ENDPOINT, // DescriptorType
|
|
|
|
|
_EP02_IN, // Endpoint Address, Endpoint 02-IN
|
|
|
|
|
_BULK, // Attributes BULK
|
2017-10-11 16:15:41 +08:00
|
|
|
|
0x40, 0x00, // MaxPacket Size
|
2017-10-11 18:46:38 +08:00
|
|
|
|
0x00 // Interval (ignored for bulk)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
};
|
|
|
|
|
|
2017-07-05 02:07:45 +08:00
|
|
|
|
// Microsoft OS Extended Configuration Compatible ID Descriptor
|
2017-10-10 21:06:17 +08:00
|
|
|
|
static const char CompatIDFeatureDescriptor[] = {
|
|
|
|
|
0x28, 0x00, 0x00, 0x00, // Descriptor Length 40bytes (0x28)
|
|
|
|
|
0x00, 0x01, // Version ('1.0')
|
|
|
|
|
MS_EXTENDED_COMPAT_ID, 0x00, // Compatibility ID Descriptor Index 0x0004
|
|
|
|
|
0x01, // Number of sections. 0x1
|
|
|
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // Reserved (7bytes)
|
|
|
|
|
//-----function section 1------
|
|
|
|
|
0x00, // Interface Number #0
|
|
|
|
|
0x01, // reserved
|
|
|
|
|
0x57, 0x49, 0x4E, 0x55, 0x53, 0x42, 0x00, 0x00, // Compatible ID ('WINUSB\0\0') (8bytes)
|
|
|
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, // Sub-Compatible ID (8byte)
|
|
|
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00 // Reserved (6bytes)
|
2017-07-05 02:07:45 +08:00
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
// Microsoft Extended Properties Feature Descriptor
|
|
|
|
|
const g_sOSProperties OSPropertyDescriptor = {
|
|
|
|
|
.dwLength = sizeof(g_pOSProperties),
|
|
|
|
|
.bcdVersion = 0x0100,
|
2017-10-10 21:06:17 +08:00
|
|
|
|
.wIndex = MS_EXTENDED_PROPERTIES, // (see MS_EXTENDED_PROPERTIES)
|
|
|
|
|
.wCount = 3, // three sections below
|
|
|
|
|
|
|
|
|
|
//-----property section 1------
|
|
|
|
|
// (iceman) With modem manager GUID, it gets install but doesn't get a COMport assigned.
|
|
|
|
|
// "{4D36E978-E325-11CE-BFC1-08002BE10318}"
|
|
|
|
|
// *HACK* instead of generating unique GUID we use standard GUID for COM & LPT ports to get installed as a COM port
|
|
|
|
|
// "{4d36e978-e325-11ce-bfc1-08002be10318}"
|
|
|
|
|
//.dwSize = sizeof(L"DeviceInterfaceGUID") + sizeof(L"{4D36E978-E325-11CE-BFC1-08002BE10318}") + 14,
|
|
|
|
|
.dwSize = 40 + 78 + 14,
|
2017-07-05 02:07:45 +08:00
|
|
|
|
.dwPropertyDataType = 1, //(Unicode string
|
2017-10-10 21:06:17 +08:00
|
|
|
|
//.wPropertyNameLength = sizeof(L"DeviceInterfaceGUID"),
|
|
|
|
|
.wPropertyNameLength = 40,
|
2017-07-05 02:07:45 +08:00
|
|
|
|
.bPropertyName = L"DeviceInterfaceGUID",
|
2017-10-10 21:06:17 +08:00
|
|
|
|
//.dwPropertyDataLength = sizeof(L"{4D36E978-E325-11CE-BFC1-08002BE10318}"),
|
|
|
|
|
.dwPropertyDataLength = 78,
|
|
|
|
|
.bPropertyData = L"{4D36E978-E325-11CE-BFC1-08002BE10318}",
|
2017-07-05 02:07:45 +08:00
|
|
|
|
|
2017-10-10 21:06:17 +08:00
|
|
|
|
//-----property section 2------
|
|
|
|
|
//.dwSize2 = sizeof(L"Label") + sizeof(L"Awesome PM3 Device") + 14,
|
|
|
|
|
.dwSize2 = 12 + 38 + 14,
|
2017-07-05 02:07:45 +08:00
|
|
|
|
.dwPropertyDataType2 = 1, //(Unicode string
|
2017-10-10 21:06:17 +08:00
|
|
|
|
//.wPropertyNameLength2 = sizeof(L"Label"),
|
|
|
|
|
.wPropertyNameLength2 = 12,
|
2017-07-05 02:07:45 +08:00
|
|
|
|
.bPropertyName2 = L"Label",
|
2017-10-10 21:06:17 +08:00
|
|
|
|
//.dwPropertyDataLength2 = sizeof(L"Awesome PM3 Device"),
|
|
|
|
|
.dwPropertyDataLength2 = 38,
|
2017-07-05 02:07:45 +08:00
|
|
|
|
.bPropertyData2 = L"Awesome PM3 Device",
|
|
|
|
|
|
2017-10-10 21:06:17 +08:00
|
|
|
|
//-----property section 3------
|
|
|
|
|
//.dwSize3 = sizeof(L"Icons") + sizeof(L"%SystemRoot%\\system32\\Shell32.dll,-13") + 14,
|
|
|
|
|
.dwSize3 = 12 + 76 + 14,
|
2017-07-05 02:07:45 +08:00
|
|
|
|
.dwPropertyDataType3 = 2, //Unicode string with environment variables
|
2017-10-10 21:06:17 +08:00
|
|
|
|
//.wPropertyNameLength3 = sizeof(L"Icons"),
|
|
|
|
|
.wPropertyNameLength3 = 12,
|
2017-07-05 02:07:45 +08:00
|
|
|
|
.bPropertyName3 = L"Icons",
|
2017-10-10 21:06:17 +08:00
|
|
|
|
//.dwPropertyDataLength3 = sizeof(L"%SystemRoot%\\system32\\Shell32.dll,-13"),
|
|
|
|
|
.dwPropertyDataLength3 = 76,
|
|
|
|
|
.bPropertyData3 = L"%SystemRoot%\\system32\\Shell32.dll,-13"
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
static const char OSprop[] = {
|
|
|
|
|
// u32 Descriptor Length (10+132+64+102 == 308
|
|
|
|
|
0x34, 0x01, 0, 0,
|
|
|
|
|
// u16 Version ('1.0')
|
|
|
|
|
0, 1,
|
|
|
|
|
// u16 wIndex
|
|
|
|
|
MS_EXTENDED_PROPERTIES, 0,
|
|
|
|
|
// u16 wCount -- three sections
|
|
|
|
|
3, 0,
|
|
|
|
|
|
|
|
|
|
//-----property section 1------
|
|
|
|
|
// u32 size ( 14+40+78 == 132)
|
|
|
|
|
132, 0, 0, 0,
|
|
|
|
|
// u32 type
|
|
|
|
|
1, 0, 0, 0, // unicode string
|
|
|
|
|
// u16 namelen (20*2 = 40)
|
|
|
|
|
40, 0,
|
|
|
|
|
// name DeviceInterfaceGUID
|
|
|
|
|
'D',0,'e',0,'v',0,'i',0,'c',0,'e',0,'I',0,'n',0,'t',0,'e',0,'r',0,'f',0,'a',0,'c',0,'e',0,'G',0,'U',0,'I',0,'D',0,0,0,
|
|
|
|
|
// u32 datalen (39*2 = 78)
|
|
|
|
|
78, 0, 0, 0,
|
|
|
|
|
// data {4D36E978-E325-11CE-BFC1-08002BE10318}
|
|
|
|
|
'{',0,'4',0,'D',0,'3',0,'6',0,'E',0,'9',0,'7',0,'8',0,'-',0,'E',0,'3',0,'2',0,'5',0,
|
|
|
|
|
'-',0,'1',0,'1',0,'C',0,'E',0,'-',0,'B',0,'F',0,'C',0,'1',0,'-',0,'0',0,'8',0,'0',0,
|
|
|
|
|
'0',0,'2',0,'B',0,'E',0,'1',0,'0',0,'3',0,'1',0,'8',0,'}',0,0,0,
|
|
|
|
|
|
|
|
|
|
//-----property section 2------
|
|
|
|
|
// u32 size ( 14+12+38 == 64)
|
|
|
|
|
64, 0, 0, 0,
|
|
|
|
|
// u32 type
|
|
|
|
|
1, 0, 0, 0, // unicode string
|
|
|
|
|
// u16 namelen (12)
|
|
|
|
|
12, 0,
|
|
|
|
|
// name Label
|
|
|
|
|
'L',0,'a',0,'b',0,'e',0,'l',0,0,0,
|
|
|
|
|
// u32 datalen ( 19*2 = 38 )
|
|
|
|
|
38, 0, 0, 0,
|
|
|
|
|
// data 'Awesome PM3 Device'
|
|
|
|
|
'A',0,'w',0,'e',0,'s',0,'o',0,'m',0,'e',0,' ',0,'P',0,'M',0,'3',0,' ',0,'D',0,'e',0,'v',0,'i',0,'c',0,'e',0,0,0,
|
|
|
|
|
|
|
|
|
|
//-----property section 3------
|
|
|
|
|
// u32 size ( 14+12+76 == 102)
|
|
|
|
|
102, 0, 0, 0,
|
|
|
|
|
// u32 type
|
|
|
|
|
2, 0, 0, 0, //Unicode string with environment variables
|
|
|
|
|
// u16 namelen (12)
|
|
|
|
|
12, 0,
|
|
|
|
|
// name Icons
|
|
|
|
|
'I',0,'c',0,'o',0,'n',0,'s',0,0,0,
|
|
|
|
|
// u32 datalen ( 38*2 == 76)
|
|
|
|
|
76, 0, 0, 0,
|
|
|
|
|
// data '%SystemRoot%\\system32\\Shell32.dll,-13'
|
|
|
|
|
'%',0,'S',0,'y',0,'s',0,'t',0,'e',0,'m',0,'R',0,'o',0,'o',0,'t',0,'%',0,
|
|
|
|
|
'\\',0,'s',0,'y',0,'s',0,'t',0,'e',0,'m',0,'3',0,'2',0,'\\',0,
|
|
|
|
|
'S',0,'h',0,'e',0,'l',0,'l',0,'3',0,'2',0,'.',0,'d',0,'l',0,'l',0,',',0,
|
|
|
|
|
'-',0,'1',0,'3',0,0,0
|
2017-07-05 02:07:45 +08:00
|
|
|
|
};
|
|
|
|
|
|
2017-10-10 21:06:17 +08:00
|
|
|
|
static const char StrLanguageCodes[] = {
|
2017-07-05 02:07:45 +08:00
|
|
|
|
4, // Length
|
|
|
|
|
0x03, // Type is string
|
|
|
|
|
0x09, 0x04 // supported language Code 0 = 0x0409 (English)
|
|
|
|
|
};
|
|
|
|
|
|
2017-10-10 21:06:17 +08:00
|
|
|
|
static const char StrManufacturer[] = {
|
2016-08-26 22:22:56 +08:00
|
|
|
|
26, // Length
|
2012-12-05 07:41:54 +08:00
|
|
|
|
0x03, // Type is string
|
2017-10-10 21:06:17 +08:00
|
|
|
|
'p',0,'r',0,'o',0,'x',0,'m',0,'a',0,'r',0,'k',0,'.',0,'o',0,'r',0,'g',0,
|
2012-12-05 07:41:54 +08:00
|
|
|
|
};
|
|
|
|
|
|
2017-10-10 21:06:17 +08:00
|
|
|
|
static const char StrProduct[] = {
|
|
|
|
|
22, // Length
|
|
|
|
|
0x03, // Type is string
|
|
|
|
|
'P',0,'M',0,'3',0,' ',0,'D',0,'e',0,'v',0,'i',0,'c',0,'e',0
|
2017-07-05 02:07:45 +08:00
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
static const char StrSerialNumber[] = {
|
|
|
|
|
18, // Length
|
|
|
|
|
0x03, // Type is string
|
2017-10-10 21:06:17 +08:00
|
|
|
|
'8',0,'8',0,'8',0,'8',0,'8',0,'8',0,'8',0,'8',0
|
2017-07-05 02:07:45 +08:00
|
|
|
|
};
|
|
|
|
|
|
2017-10-10 21:06:17 +08:00
|
|
|
|
// size inkluderar sitt egna fält.
|
|
|
|
|
static const char StrMS_OSDescriptor[] = {
|
|
|
|
|
18, // length 0x12
|
2017-07-05 02:07:45 +08:00
|
|
|
|
0x03, // Type is string
|
2017-10-10 21:06:17 +08:00
|
|
|
|
'M',0,'S',0,'F',0,'T',0,'1',0,'0',0,'0',0,MS_VENDOR_CODE,0
|
2017-07-05 02:07:45 +08:00
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
const char* getStringDescriptor(uint8_t idx) {
|
|
|
|
|
switch(idx) {
|
2017-10-10 21:06:17 +08:00
|
|
|
|
case 0: return StrLanguageCodes;
|
|
|
|
|
case 1: return StrManufacturer;
|
|
|
|
|
case 2: return StrProduct;
|
|
|
|
|
case 3: return StrSerialNumber;
|
|
|
|
|
case MS_OS_DESCRIPTOR_INDEX: return StrMS_OSDescriptor;
|
2017-07-05 02:07:45 +08:00
|
|
|
|
default:
|
|
|
|
|
return(NULL);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Bitmap for all status bits in CSR which must be written as 1 to cause no effect
|
2016-08-26 22:22:56 +08:00
|
|
|
|
#define REG_NO_EFFECT_1_ALL AT91C_UDP_RX_DATA_BK0 | AT91C_UDP_RX_DATA_BK1 \
|
|
|
|
|
|AT91C_UDP_STALLSENT | AT91C_UDP_RXSETUP \
|
|
|
|
|
|AT91C_UDP_TXCOMP
|
|
|
|
|
|
|
|
|
|
// Clear flags in the UDP_CSR register and waits for synchronization
|
|
|
|
|
#define UDP_CLEAR_EP_FLAGS(endpoint, flags) { \
|
|
|
|
|
volatile unsigned int reg; \
|
2016-09-26 18:30:34 +08:00
|
|
|
|
reg = pUdp->UDP_CSR[(endpoint)]; \
|
2016-08-26 22:22:56 +08:00
|
|
|
|
reg |= REG_NO_EFFECT_1_ALL; \
|
|
|
|
|
reg &= ~(flags); \
|
2016-09-26 18:30:34 +08:00
|
|
|
|
pUdp->UDP_CSR[(endpoint)] = reg; \
|
2017-10-10 21:06:17 +08:00
|
|
|
|
while ( (pUdp->UDP_CSR[(endpoint)] & (flags)) == (flags)) {}; \
|
2016-09-26 18:30:34 +08:00
|
|
|
|
} \
|
2016-08-26 22:22:56 +08:00
|
|
|
|
|
|
|
|
|
// reset flags in the UDP_CSR register and waits for synchronization
|
|
|
|
|
#define UDP_SET_EP_FLAGS(endpoint, flags) { \
|
|
|
|
|
volatile unsigned int reg; \
|
2016-09-26 18:30:34 +08:00
|
|
|
|
reg = pUdp->UDP_CSR[(endpoint)]; \
|
2016-08-26 22:22:56 +08:00
|
|
|
|
reg |= REG_NO_EFFECT_1_ALL; \
|
|
|
|
|
reg |= (flags); \
|
2016-09-26 18:30:34 +08:00
|
|
|
|
pUdp->UDP_CSR[(endpoint)] = reg; \
|
2017-10-10 21:06:17 +08:00
|
|
|
|
while ( ( pUdp->UDP_CSR[(endpoint)] & (flags)) != (flags)) {}; \
|
2016-09-26 18:30:34 +08:00
|
|
|
|
} \
|
2012-12-05 07:41:54 +08:00
|
|
|
|
|
2016-08-26 22:22:56 +08:00
|
|
|
|
|
2012-12-05 07:41:54 +08:00
|
|
|
|
/* USB standard request code */
|
|
|
|
|
#define STD_GET_STATUS_ZERO 0x0080
|
|
|
|
|
#define STD_GET_STATUS_INTERFACE 0x0081
|
|
|
|
|
#define STD_GET_STATUS_ENDPOINT 0x0082
|
|
|
|
|
|
|
|
|
|
#define STD_CLEAR_FEATURE_ZERO 0x0100
|
|
|
|
|
#define STD_CLEAR_FEATURE_INTERFACE 0x0101
|
|
|
|
|
#define STD_CLEAR_FEATURE_ENDPOINT 0x0102
|
|
|
|
|
|
|
|
|
|
#define STD_SET_FEATURE_ZERO 0x0300
|
|
|
|
|
#define STD_SET_FEATURE_INTERFACE 0x0301
|
|
|
|
|
#define STD_SET_FEATURE_ENDPOINT 0x0302
|
|
|
|
|
|
|
|
|
|
#define STD_SET_ADDRESS 0x0500
|
|
|
|
|
#define STD_GET_DESCRIPTOR 0x0680
|
|
|
|
|
#define STD_SET_DESCRIPTOR 0x0700
|
|
|
|
|
#define STD_GET_CONFIGURATION 0x0880
|
|
|
|
|
#define STD_SET_CONFIGURATION 0x0900
|
|
|
|
|
#define STD_GET_INTERFACE 0x0A81
|
|
|
|
|
#define STD_SET_INTERFACE 0x0B01
|
|
|
|
|
#define STD_SYNCH_FRAME 0x0C82
|
|
|
|
|
|
|
|
|
|
/* CDC Class Specific Request Code */
|
|
|
|
|
#define GET_LINE_CODING 0x21A1
|
|
|
|
|
#define SET_LINE_CODING 0x2021
|
|
|
|
|
#define SET_CONTROL_LINE_STATE 0x2221
|
|
|
|
|
|
|
|
|
|
typedef struct {
|
|
|
|
|
unsigned int dwDTERRate;
|
|
|
|
|
char bCharFormat;
|
|
|
|
|
char bParityType;
|
|
|
|
|
char bDataBits;
|
|
|
|
|
} AT91S_CDC_LINE_CODING, *AT91PS_CDC_LINE_CODING;
|
|
|
|
|
|
|
|
|
|
AT91S_CDC_LINE_CODING line = {
|
|
|
|
|
115200, // baudrate
|
|
|
|
|
0, // 1 Stop Bit
|
|
|
|
|
0, // None Parity
|
|
|
|
|
8}; // 8 Data bits
|
|
|
|
|
|
|
|
|
|
AT91PS_UDP pUdp = AT91C_BASE_UDP;
|
2017-10-11 16:15:41 +08:00
|
|
|
|
uint16_t btConfiguration = 0;
|
|
|
|
|
uint16_t btConnection = 0;
|
2012-12-05 07:41:54 +08:00
|
|
|
|
byte_t btReceiveBank = AT91C_UDP_RX_DATA_BK0;
|
|
|
|
|
|
2012-12-06 00:14:10 +08:00
|
|
|
|
//*----------------------------------------------------------------------------
|
2013-02-27 21:23:38 +08:00
|
|
|
|
//* \fn usb_disable
|
2012-12-06 00:14:10 +08:00
|
|
|
|
//* \brief This function deactivates the USB device
|
|
|
|
|
//*----------------------------------------------------------------------------
|
|
|
|
|
void usb_disable() {
|
2016-08-26 22:22:56 +08:00
|
|
|
|
// Disconnect the USB device
|
|
|
|
|
AT91C_BASE_PIOA->PIO_ODR = GPIO_USB_PU;
|
|
|
|
|
|
|
|
|
|
// Clear all lingering interrupts
|
2017-10-11 16:15:41 +08:00
|
|
|
|
if (pUdp->UDP_ISR & AT91C_UDP_ENDBUSRES) {
|
2016-08-26 22:22:56 +08:00
|
|
|
|
pUdp->UDP_ICR = AT91C_UDP_ENDBUSRES;
|
|
|
|
|
}
|
2012-12-06 00:14:10 +08:00
|
|
|
|
}
|
|
|
|
|
|
2012-12-05 07:41:54 +08:00
|
|
|
|
//*----------------------------------------------------------------------------
|
2013-02-27 21:23:38 +08:00
|
|
|
|
//* \fn usb_enable
|
2012-12-05 07:41:54 +08:00
|
|
|
|
//* \brief This function Activates the USB device
|
|
|
|
|
//*----------------------------------------------------------------------------
|
2012-12-06 00:14:10 +08:00
|
|
|
|
void usb_enable() {
|
2015-07-31 16:37:24 +08:00
|
|
|
|
// Set the PLL USB Divider
|
|
|
|
|
AT91C_BASE_CKGR->CKGR_PLLR |= AT91C_CKGR_USBDIV_1 ;
|
|
|
|
|
|
|
|
|
|
// Specific Chip USB Initialisation
|
|
|
|
|
// Enables the 48MHz USB clock UDPCK and System Peripheral USB Clock
|
|
|
|
|
AT91C_BASE_PMC->PMC_SCER = AT91C_PMC_UDP;
|
|
|
|
|
AT91C_BASE_PMC->PMC_PCER = (1 << AT91C_ID_UDP);
|
|
|
|
|
|
|
|
|
|
// Enable UDP PullUp (USB_DP_PUP) : enable & Clear of the corresponding PIO
|
|
|
|
|
// Set in PIO mode and Configure in Output
|
|
|
|
|
AT91C_BASE_PIOA->PIO_PER = GPIO_USB_PU; // Set in PIO mode
|
2013-02-27 21:23:38 +08:00
|
|
|
|
AT91C_BASE_PIOA->PIO_OER = GPIO_USB_PU; // Configure as Output
|
2015-07-31 16:37:24 +08:00
|
|
|
|
|
|
|
|
|
// Clear for set the Pullup resistor
|
2013-02-27 21:23:38 +08:00
|
|
|
|
AT91C_BASE_PIOA->PIO_CODR = GPIO_USB_PU;
|
2012-12-06 00:14:10 +08:00
|
|
|
|
|
2015-07-31 16:37:24 +08:00
|
|
|
|
// Disconnect and reconnect USB controller for 100ms
|
|
|
|
|
usb_disable();
|
|
|
|
|
|
|
|
|
|
// Wait for a short while
|
2017-09-29 05:14:51 +08:00
|
|
|
|
for (volatile size_t i=0; i<0x100000; i++) {};
|
2015-07-31 16:37:24 +08:00
|
|
|
|
|
|
|
|
|
// Reconnect USB reconnect
|
|
|
|
|
AT91C_BASE_PIOA->PIO_SODR = GPIO_USB_PU;
|
|
|
|
|
AT91C_BASE_PIOA->PIO_OER = GPIO_USB_PU;
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
//*----------------------------------------------------------------------------
|
2013-02-27 21:23:38 +08:00
|
|
|
|
//* \fn usb_check
|
2012-12-05 07:41:54 +08:00
|
|
|
|
//* \brief Test if the device is configured and handle enumeration
|
|
|
|
|
//*----------------------------------------------------------------------------
|
2017-10-10 21:06:17 +08:00
|
|
|
|
static int usb_reconnect = 0;
|
|
|
|
|
static int usb_configured = 0;
|
|
|
|
|
void SetUSBreconnect(int value) {
|
|
|
|
|
usb_reconnect = value;
|
|
|
|
|
}
|
|
|
|
|
int GetUSBreconnect(void) {
|
|
|
|
|
return usb_reconnect;
|
|
|
|
|
}
|
|
|
|
|
void SetUSBconfigured(int value) {
|
|
|
|
|
usb_configured = value;
|
|
|
|
|
}
|
|
|
|
|
int GetUSBconfigured(void){
|
|
|
|
|
return usb_configured;
|
|
|
|
|
}
|
|
|
|
|
|
2012-12-06 00:14:10 +08:00
|
|
|
|
bool usb_check() {
|
2017-10-10 21:06:17 +08:00
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
// reconnected ONCE and
|
|
|
|
|
if ( !USB_ATTACHED() ){
|
|
|
|
|
usb_reconnect = 1;
|
|
|
|
|
LED_C_INV();
|
|
|
|
|
LED_C_INV();
|
|
|
|
|
LED_C_INV();
|
|
|
|
|
LED_C_INV();
|
|
|
|
|
LED_C_INV();
|
|
|
|
|
LED_C_INV();
|
|
|
|
|
return false;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// only one time after USB been disengaged and re-engaged
|
|
|
|
|
if ( USB_ATTACHED() && usb_reconnect == 1 ) {
|
|
|
|
|
|
|
|
|
|
if ( usb_configured == 0) {
|
|
|
|
|
// blink
|
|
|
|
|
LED_D_INV();
|
|
|
|
|
LED_D_INV();
|
|
|
|
|
LED_D_INV();
|
|
|
|
|
LED_D_INV();
|
|
|
|
|
LED_D_INV();
|
|
|
|
|
LED_D_INV();
|
|
|
|
|
LED_D_INV();
|
|
|
|
|
LED_D_INV();
|
|
|
|
|
LED_D_INV();
|
|
|
|
|
LED_D_INV();
|
|
|
|
|
|
|
|
|
|
usb_disable();
|
|
|
|
|
usb_enable();
|
|
|
|
|
|
|
|
|
|
AT91F_CDC_Enumerate();
|
|
|
|
|
|
|
|
|
|
usb_configured = 1;
|
|
|
|
|
return false;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
*/
|
|
|
|
|
|
2017-10-11 16:15:41 +08:00
|
|
|
|
WDT_HIT();
|
|
|
|
|
|
2017-10-10 21:06:17 +08:00
|
|
|
|
// interrupt status register
|
2012-12-05 07:41:54 +08:00
|
|
|
|
AT91_REG isr = pUdp->UDP_ISR;
|
|
|
|
|
|
2017-10-10 21:06:17 +08:00
|
|
|
|
// end of bus reset
|
2012-12-05 07:41:54 +08:00
|
|
|
|
if (isr & AT91C_UDP_ENDBUSRES) {
|
|
|
|
|
pUdp->UDP_ICR = AT91C_UDP_ENDBUSRES;
|
|
|
|
|
// reset all endpoints
|
|
|
|
|
pUdp->UDP_RSTEP = (unsigned int)-1;
|
|
|
|
|
pUdp->UDP_RSTEP = 0;
|
|
|
|
|
// Enable the function
|
|
|
|
|
pUdp->UDP_FADDR = AT91C_UDP_FEN;
|
2017-10-11 16:15:41 +08:00
|
|
|
|
// Configure endpoint 0 (enable control endpoint)
|
2017-09-29 05:14:51 +08:00
|
|
|
|
UDP_SET_EP_FLAGS(AT91C_EP_CONTROL, (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_CTRL));
|
|
|
|
|
// clear it
|
|
|
|
|
pUdp->UDP_ICR |= AT91C_UDP_ENDBUSRES;
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
|
|
|
|
else if (isr & AT91C_UDP_EPINT0) {
|
|
|
|
|
pUdp->UDP_ICR = AT91C_UDP_EPINT0;
|
|
|
|
|
AT91F_CDC_Enumerate();
|
2017-09-29 05:14:51 +08:00
|
|
|
|
// clear it?
|
|
|
|
|
pUdp->UDP_ICR |= AT91C_UDP_EPINT0;
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
|
|
|
|
return (btConfiguration) ? true : false;
|
|
|
|
|
}
|
|
|
|
|
|
2017-09-29 05:14:51 +08:00
|
|
|
|
bool usb_poll() {
|
2016-08-24 18:35:24 +08:00
|
|
|
|
if (!usb_check()) return false;
|
|
|
|
|
return (pUdp->UDP_CSR[AT91C_EP_OUT] & btReceiveBank);
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
|
|
|
|
|
2015-07-23 05:00:52 +08:00
|
|
|
|
/**
|
|
|
|
|
In github PR #129, some users appears to get a false positive from
|
|
|
|
|
usb_poll, which returns true, but the usb_read operation
|
|
|
|
|
still returns 0.
|
|
|
|
|
This check is basically the same as above, but also checks
|
|
|
|
|
that the length available to read is non-zero, thus hopefully fixes the
|
|
|
|
|
bug.
|
|
|
|
|
**/
|
2017-09-29 05:14:51 +08:00
|
|
|
|
bool usb_poll_validate_length() {
|
2015-07-23 05:00:52 +08:00
|
|
|
|
if (!usb_check()) return false;
|
|
|
|
|
if (!(pUdp->UDP_CSR[AT91C_EP_OUT] & btReceiveBank)) return false;
|
|
|
|
|
return (pUdp->UDP_CSR[AT91C_EP_OUT] >> 16) > 0;
|
|
|
|
|
}
|
|
|
|
|
|
2012-12-05 07:41:54 +08:00
|
|
|
|
//*----------------------------------------------------------------------------
|
2013-02-27 21:23:38 +08:00
|
|
|
|
//* \fn usb_read
|
2012-12-05 07:41:54 +08:00
|
|
|
|
//* \brief Read available data from Endpoint OUT
|
|
|
|
|
//*----------------------------------------------------------------------------
|
2012-12-06 00:14:10 +08:00
|
|
|
|
uint32_t usb_read(byte_t* data, size_t len) {
|
2015-08-01 00:48:58 +08:00
|
|
|
|
byte_t bank = btReceiveBank;
|
2012-12-05 07:41:54 +08:00
|
|
|
|
uint32_t packetSize, nbBytesRcv = 0;
|
2015-08-01 00:48:58 +08:00
|
|
|
|
uint32_t time_out = 0;
|
2012-12-05 07:41:54 +08:00
|
|
|
|
|
2015-01-08 03:40:22 +08:00
|
|
|
|
while (len) {
|
2012-12-05 07:41:54 +08:00
|
|
|
|
if (!usb_check()) break;
|
|
|
|
|
|
|
|
|
|
if ( pUdp->UDP_CSR[AT91C_EP_OUT] & bank ) {
|
|
|
|
|
packetSize = MIN(pUdp->UDP_CSR[AT91C_EP_OUT] >> 16, len);
|
2015-08-01 00:48:58 +08:00
|
|
|
|
len -= packetSize;
|
2017-10-11 16:15:41 +08:00
|
|
|
|
while (packetSize--)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
data[nbBytesRcv++] = pUdp->UDP_FDR[AT91C_EP_OUT];
|
2016-08-26 22:22:56 +08:00
|
|
|
|
|
|
|
|
|
UDP_CLEAR_EP_FLAGS(AT91C_EP_OUT, bank)
|
|
|
|
|
|
2015-08-01 00:48:58 +08:00
|
|
|
|
if (bank == AT91C_UDP_RX_DATA_BK0)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
bank = AT91C_UDP_RX_DATA_BK1;
|
2015-08-01 00:48:58 +08:00
|
|
|
|
else
|
|
|
|
|
bank = AT91C_UDP_RX_DATA_BK0;
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
2015-08-01 00:48:58 +08:00
|
|
|
|
if (time_out++ == 0x1fff) break;
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
btReceiveBank = bank;
|
|
|
|
|
return nbBytesRcv;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
//*----------------------------------------------------------------------------
|
2013-02-27 21:23:38 +08:00
|
|
|
|
//* \fn usb_write
|
2012-12-05 07:41:54 +08:00
|
|
|
|
//* \brief Send through endpoint 2
|
|
|
|
|
//*----------------------------------------------------------------------------
|
2012-12-06 00:14:10 +08:00
|
|
|
|
uint32_t usb_write(const byte_t* data, const size_t len) {
|
2017-09-29 05:14:51 +08:00
|
|
|
|
|
|
|
|
|
if (!len) return 0;
|
|
|
|
|
if (!usb_check()) return 0;
|
|
|
|
|
|
2015-08-01 00:48:58 +08:00
|
|
|
|
size_t length = len;
|
2012-12-05 07:41:54 +08:00
|
|
|
|
uint32_t cpt = 0;
|
2017-10-10 21:06:17 +08:00
|
|
|
|
|
2012-12-05 07:41:54 +08:00
|
|
|
|
// Send the first packet
|
|
|
|
|
cpt = MIN(length, AT91C_EP_IN_SIZE-1);
|
|
|
|
|
length -= cpt;
|
|
|
|
|
while (cpt--) pUdp->UDP_FDR[AT91C_EP_IN] = *data++;
|
2016-08-26 22:22:56 +08:00
|
|
|
|
|
|
|
|
|
UDP_SET_EP_FLAGS(AT91C_EP_IN, AT91C_UDP_TXPKTRDY)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
|
|
|
|
|
while (length) {
|
|
|
|
|
// Fill the second bank
|
|
|
|
|
cpt = MIN(length, AT91C_EP_IN_SIZE-1);
|
|
|
|
|
length -= cpt;
|
|
|
|
|
while (cpt--) pUdp->UDP_FDR[AT91C_EP_IN] = *data++;
|
2016-02-12 14:37:10 +08:00
|
|
|
|
// Wait for the first bank to be sent
|
2012-12-05 07:41:54 +08:00
|
|
|
|
while (!(pUdp->UDP_CSR[AT91C_EP_IN] & AT91C_UDP_TXCOMP)) {
|
|
|
|
|
if (!usb_check()) return length;
|
2015-08-01 00:48:58 +08:00
|
|
|
|
}
|
|
|
|
|
|
2016-08-26 22:22:56 +08:00
|
|
|
|
UDP_CLEAR_EP_FLAGS(AT91C_EP_IN, AT91C_UDP_TXCOMP)
|
2017-10-10 21:06:17 +08:00
|
|
|
|
|
2016-08-26 22:22:56 +08:00
|
|
|
|
UDP_SET_EP_FLAGS(AT91C_EP_IN, AT91C_UDP_TXPKTRDY)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Wait for the end of transfer
|
|
|
|
|
while (!(pUdp->UDP_CSR[AT91C_EP_IN] & AT91C_UDP_TXCOMP)) {
|
|
|
|
|
if (!usb_check()) return length;
|
2015-08-01 00:48:58 +08:00
|
|
|
|
}
|
2016-08-26 22:22:56 +08:00
|
|
|
|
|
|
|
|
|
UDP_CLEAR_EP_FLAGS(AT91C_EP_IN, AT91C_UDP_TXCOMP)
|
2017-07-05 02:07:45 +08:00
|
|
|
|
|
2012-12-05 07:41:54 +08:00
|
|
|
|
return length;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
//*----------------------------------------------------------------------------
|
|
|
|
|
//* \fn AT91F_USB_SendData
|
|
|
|
|
//* \brief Send Data through the control endpoint
|
|
|
|
|
//*----------------------------------------------------------------------------
|
2017-09-29 05:14:51 +08:00
|
|
|
|
void AT91F_USB_SendData(AT91PS_UDP pUdp, const char *pData, uint32_t length) {
|
2012-12-05 07:41:54 +08:00
|
|
|
|
uint32_t cpt = 0;
|
|
|
|
|
|
|
|
|
|
do {
|
2017-10-11 16:17:01 +08:00
|
|
|
|
cpt = MIN(length, AT91C_EP_CONTROL_SIZE);
|
2012-12-05 07:41:54 +08:00
|
|
|
|
length -= cpt;
|
|
|
|
|
|
|
|
|
|
while (cpt--)
|
|
|
|
|
pUdp->UDP_FDR[0] = *pData++;
|
|
|
|
|
|
2017-07-05 02:07:45 +08:00
|
|
|
|
if (pUdp->UDP_CSR[AT91C_EP_CONTROL] & AT91C_UDP_TXCOMP) {
|
2016-08-26 22:22:56 +08:00
|
|
|
|
|
2017-07-05 02:07:45 +08:00
|
|
|
|
UDP_CLEAR_EP_FLAGS(AT91C_EP_CONTROL, AT91C_UDP_TXCOMP)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
|
|
|
|
|
2017-07-05 02:07:45 +08:00
|
|
|
|
UDP_SET_EP_FLAGS(AT91C_EP_CONTROL, AT91C_UDP_TXPKTRDY)
|
|
|
|
|
|
2012-12-05 07:41:54 +08:00
|
|
|
|
do {
|
|
|
|
|
// Data IN stage has been stopped by a status OUT
|
2017-10-11 16:15:41 +08:00
|
|
|
|
if ( pUdp->UDP_CSR[AT91C_EP_CONTROL] & AT91C_UDP_RX_DATA_BK0) {
|
2016-08-26 22:22:56 +08:00
|
|
|
|
|
2017-07-05 02:07:45 +08:00
|
|
|
|
UDP_CLEAR_EP_FLAGS(AT91C_EP_CONTROL, AT91C_UDP_RX_DATA_BK0)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
return;
|
|
|
|
|
}
|
2017-10-11 16:15:41 +08:00
|
|
|
|
} while ( !( pUdp->UDP_CSR[AT91C_EP_CONTROL] & AT91C_UDP_TXCOMP) );
|
2012-12-05 07:41:54 +08:00
|
|
|
|
|
|
|
|
|
} while (length);
|
|
|
|
|
|
2017-07-05 02:07:45 +08:00
|
|
|
|
if (pUdp->UDP_CSR[AT91C_EP_CONTROL] & AT91C_UDP_TXCOMP) {
|
2016-08-26 22:22:56 +08:00
|
|
|
|
|
2017-07-05 02:07:45 +08:00
|
|
|
|
UDP_CLEAR_EP_FLAGS(AT91C_EP_CONTROL, AT91C_UDP_TXCOMP)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
//*----------------------------------------------------------------------------
|
|
|
|
|
//* \fn AT91F_USB_SendZlp
|
|
|
|
|
//* \brief Send zero length packet through the control endpoint
|
|
|
|
|
//*----------------------------------------------------------------------------
|
2012-12-06 00:14:10 +08:00
|
|
|
|
void AT91F_USB_SendZlp(AT91PS_UDP pUdp) {
|
2017-10-10 21:06:17 +08:00
|
|
|
|
UDP_SET_EP_FLAGS(AT91C_EP_CONTROL, AT91C_UDP_TXPKTRDY);
|
|
|
|
|
UDP_CLEAR_EP_FLAGS(AT91C_EP_CONTROL, AT91C_UDP_TXCOMP);
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
//*----------------------------------------------------------------------------
|
|
|
|
|
//* \fn AT91F_USB_SendStall
|
|
|
|
|
//* \brief Stall the control endpoint
|
|
|
|
|
//*----------------------------------------------------------------------------
|
2012-12-06 00:14:10 +08:00
|
|
|
|
void AT91F_USB_SendStall(AT91PS_UDP pUdp) {
|
2017-07-05 02:07:45 +08:00
|
|
|
|
UDP_SET_EP_FLAGS(AT91C_EP_CONTROL, AT91C_UDP_FORCESTALL);
|
2017-10-11 16:15:41 +08:00
|
|
|
|
while ( !(pUdp->UDP_CSR[AT91C_EP_CONTROL] & AT91C_UDP_ISOERROR) );
|
2017-10-10 21:06:17 +08:00
|
|
|
|
UDP_CLEAR_EP_FLAGS(AT91C_EP_CONTROL, (AT91C_UDP_FORCESTALL | AT91C_UDP_ISOERROR));
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
//*----------------------------------------------------------------------------
|
|
|
|
|
//* \fn AT91F_CDC_Enumerate
|
|
|
|
|
//* \brief This function is a callback invoked when a SETUP packet is received
|
|
|
|
|
//*----------------------------------------------------------------------------
|
2012-12-06 00:14:10 +08:00
|
|
|
|
void AT91F_CDC_Enumerate() {
|
2012-12-05 07:41:54 +08:00
|
|
|
|
byte_t bmRequestType, bRequest;
|
|
|
|
|
uint16_t wValue, wIndex, wLength, wStatus;
|
|
|
|
|
|
2017-07-05 02:07:45 +08:00
|
|
|
|
if ( !(pUdp->UDP_CSR[AT91C_EP_CONTROL] & AT91C_UDP_RXSETUP) )
|
2012-12-05 07:41:54 +08:00
|
|
|
|
return;
|
|
|
|
|
|
|
|
|
|
bmRequestType = pUdp->UDP_FDR[0];
|
|
|
|
|
bRequest = pUdp->UDP_FDR[0];
|
|
|
|
|
wValue = (pUdp->UDP_FDR[0] & 0xFF);
|
|
|
|
|
wValue |= (pUdp->UDP_FDR[0] << 8);
|
|
|
|
|
wIndex = (pUdp->UDP_FDR[0] & 0xFF);
|
|
|
|
|
wIndex |= (pUdp->UDP_FDR[0] << 8);
|
|
|
|
|
wLength = (pUdp->UDP_FDR[0] & 0xFF);
|
|
|
|
|
wLength |= (pUdp->UDP_FDR[0] << 8);
|
|
|
|
|
|
|
|
|
|
if (bmRequestType & 0x80) {
|
2017-07-05 02:07:45 +08:00
|
|
|
|
UDP_SET_EP_FLAGS(AT91C_EP_CONTROL, AT91C_UDP_DIR)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
}
|
2017-07-05 02:07:45 +08:00
|
|
|
|
UDP_CLEAR_EP_FLAGS(AT91C_EP_CONTROL, AT91C_UDP_RXSETUP)
|
2012-12-05 07:41:54 +08:00
|
|
|
|
|
2017-10-11 16:15:41 +08:00
|
|
|
|
if ( bRequest == MS_VENDOR_CODE) {
|
|
|
|
|
if ( bmRequestType == MS_WCID_GET_DESCRIPTOR ) { // C0
|
|
|
|
|
if ( wIndex == MS_EXTENDED_COMPAT_ID ) { // 4
|
|
|
|
|
AT91F_USB_SendData(pUdp, CompatIDFeatureDescriptor, MIN(sizeof(CompatIDFeatureDescriptor), wLength));
|
2017-10-11 18:46:38 +08:00
|
|
|
|
return;
|
|
|
|
|
}
|
2017-10-11 16:15:41 +08:00
|
|
|
|
}
|
|
|
|
|
if ( bmRequestType == MS_WCID_GET_FEATURE_DESCRIPTOR ) { //C1
|
|
|
|
|
if ( wIndex == MS_EXTENDED_PROPERTIES ) { // 5
|
|
|
|
|
AT91F_USB_SendData(pUdp, (char *)&OSPropertyDescriptor, MIN(sizeof(OSPropertyDescriptor), wLength));
|
2017-10-11 18:46:38 +08:00
|
|
|
|
//AT91F_USB_SendData(pUdp, OSprop, MIN(sizeof(OSprop), wLength));
|
|
|
|
|
return;
|
|
|
|
|
}
|
2017-10-11 16:15:41 +08:00
|
|
|
|
}
|
|
|
|
|
}
|
2012-12-05 07:41:54 +08:00
|
|
|
|
// Handle supported standard device request Cf Table 9-3 in USB specification Rev 1.1
|
|
|
|
|
switch ((bRequest << 8) | bmRequestType) {
|
|
|
|
|
case STD_GET_DESCRIPTOR:
|
|
|
|
|
if (wValue == 0x100) // Return Device Descriptor
|
|
|
|
|
AT91F_USB_SendData(pUdp, devDescriptor, MIN(sizeof(devDescriptor), wLength));
|
|
|
|
|
else if (wValue == 0x200) // Return Configuration Descriptor
|
|
|
|
|
AT91F_USB_SendData(pUdp, cfgDescriptor, MIN(sizeof(cfgDescriptor), wLength));
|
2017-07-05 02:07:45 +08:00
|
|
|
|
else if ((wValue & 0x300) == 0x300) { // Return String Descriptor
|
|
|
|
|
|
|
|
|
|
const char *strDescriptor = getStringDescriptor(wValue & 0xff);
|
|
|
|
|
if (strDescriptor != NULL) {
|
|
|
|
|
AT91F_USB_SendData(pUdp, strDescriptor, MIN(strDescriptor[0], wLength));
|
|
|
|
|
} else {
|
|
|
|
|
AT91F_USB_SendStall(pUdp);
|
|
|
|
|
}
|
|
|
|
|
}
|
2012-12-05 07:41:54 +08:00
|
|
|
|
else
|
|
|
|
|
AT91F_USB_SendStall(pUdp);
|
|
|
|
|
break;
|
|
|
|
|
case STD_SET_ADDRESS:
|
|
|
|
|
AT91F_USB_SendZlp(pUdp);
|
|
|
|
|
pUdp->UDP_FADDR = (AT91C_UDP_FEN | wValue);
|
|
|
|
|
pUdp->UDP_GLBSTATE = (wValue) ? AT91C_UDP_FADDEN : 0;
|
|
|
|
|
break;
|
|
|
|
|
case STD_SET_CONFIGURATION:
|
|
|
|
|
btConfiguration = wValue;
|
|
|
|
|
AT91F_USB_SendZlp(pUdp);
|
|
|
|
|
pUdp->UDP_GLBSTATE = (wValue) ? AT91C_UDP_CONFG : AT91C_UDP_FADDEN;
|
2017-10-11 16:15:41 +08:00
|
|
|
|
|
|
|
|
|
UDP_SET_EP_FLAGS(1, (wValue) ? (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_BULK_OUT) : 0 );
|
|
|
|
|
UDP_SET_EP_FLAGS(2, (wValue) ? (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_BULK_IN) : 0 );
|
|
|
|
|
UDP_SET_EP_FLAGS(3, (wValue) ? (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_INT_IN) : 0 );
|
|
|
|
|
// pUdp->UDP_CSR[1] = (wValue) ? (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_BULK_OUT) : 0;
|
|
|
|
|
// pUdp->UDP_CSR[2] = (wValue) ? (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_BULK_IN) : 0;
|
|
|
|
|
// pUdp->UDP_CSR[3] = (wValue) ? (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_INT_IN) : 0;
|
2012-12-05 07:41:54 +08:00
|
|
|
|
break;
|
|
|
|
|
case STD_GET_CONFIGURATION:
|
|
|
|
|
AT91F_USB_SendData(pUdp, (char *) &(btConfiguration), sizeof(btConfiguration));
|
|
|
|
|
break;
|
|
|
|
|
case STD_GET_STATUS_ZERO:
|
|
|
|
|
wStatus = 0;
|
|
|
|
|
AT91F_USB_SendData(pUdp, (char *) &wStatus, sizeof(wStatus));
|
|
|
|
|
break;
|
|
|
|
|
case STD_GET_STATUS_INTERFACE:
|
|
|
|
|
wStatus = 0;
|
|
|
|
|
AT91F_USB_SendData(pUdp, (char *) &wStatus, sizeof(wStatus));
|
|
|
|
|
break;
|
|
|
|
|
case STD_GET_STATUS_ENDPOINT:
|
|
|
|
|
wStatus = 0;
|
|
|
|
|
wIndex &= 0x0F;
|
|
|
|
|
if ((pUdp->UDP_GLBSTATE & AT91C_UDP_CONFG) && (wIndex <= 3)) {
|
|
|
|
|
wStatus = (pUdp->UDP_CSR[wIndex] & AT91C_UDP_EPEDS) ? 0 : 1;
|
|
|
|
|
AT91F_USB_SendData(pUdp, (char *) &wStatus, sizeof(wStatus));
|
|
|
|
|
}
|
|
|
|
|
else if ((pUdp->UDP_GLBSTATE & AT91C_UDP_FADDEN) && (wIndex == 0)) {
|
|
|
|
|
wStatus = (pUdp->UDP_CSR[wIndex] & AT91C_UDP_EPEDS) ? 0 : 1;
|
|
|
|
|
AT91F_USB_SendData(pUdp, (char *) &wStatus, sizeof(wStatus));
|
2017-09-29 05:14:51 +08:00
|
|
|
|
} else {
|
2012-12-05 07:41:54 +08:00
|
|
|
|
AT91F_USB_SendStall(pUdp);
|
2017-09-29 05:14:51 +08:00
|
|
|
|
}
|
2012-12-05 07:41:54 +08:00
|
|
|
|
break;
|
|
|
|
|
case STD_SET_FEATURE_ZERO:
|
|
|
|
|
AT91F_USB_SendStall(pUdp);
|
|
|
|
|
break;
|
|
|
|
|
case STD_SET_FEATURE_INTERFACE:
|
|
|
|
|
AT91F_USB_SendZlp(pUdp);
|
|
|
|
|
break;
|
|
|
|
|
case STD_SET_FEATURE_ENDPOINT:
|
|
|
|
|
wIndex &= 0x0F;
|
|
|
|
|
if ((wValue == 0) && wIndex && (wIndex <= 3)) {
|
|
|
|
|
pUdp->UDP_CSR[wIndex] = 0;
|
|
|
|
|
AT91F_USB_SendZlp(pUdp);
|
2017-09-29 05:14:51 +08:00
|
|
|
|
} else {
|
2012-12-05 07:41:54 +08:00
|
|
|
|
AT91F_USB_SendStall(pUdp);
|
2017-09-29 05:14:51 +08:00
|
|
|
|
}
|
2012-12-05 07:41:54 +08:00
|
|
|
|
break;
|
|
|
|
|
case STD_CLEAR_FEATURE_ZERO:
|
|
|
|
|
AT91F_USB_SendStall(pUdp);
|
|
|
|
|
break;
|
|
|
|
|
case STD_CLEAR_FEATURE_INTERFACE:
|
|
|
|
|
AT91F_USB_SendZlp(pUdp);
|
|
|
|
|
break;
|
|
|
|
|
case STD_CLEAR_FEATURE_ENDPOINT:
|
|
|
|
|
wIndex &= 0x0F;
|
|
|
|
|
if ((wValue == 0) && wIndex && (wIndex <= 3)) {
|
2017-10-11 16:15:41 +08:00
|
|
|
|
if (wIndex == 1) {
|
|
|
|
|
//pUdp->UDP_CSR[1] = (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_BULK_OUT);
|
|
|
|
|
UDP_SET_EP_FLAGS(1, (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_BULK_OUT) );
|
|
|
|
|
}
|
|
|
|
|
else if (wIndex == 2) {
|
|
|
|
|
//pUdp->UDP_CSR[2] = (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_BULK_IN);
|
|
|
|
|
UDP_SET_EP_FLAGS(2, (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_BULK_IN) );
|
|
|
|
|
}
|
|
|
|
|
else if (wIndex == 3) {
|
|
|
|
|
//pUdp->UDP_CSR[3] = (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_ISO_IN);
|
|
|
|
|
UDP_SET_EP_FLAGS(3, (AT91C_UDP_EPEDS | AT91C_UDP_EPTYPE_ISO_IN) );
|
|
|
|
|
}
|
2012-12-05 07:41:54 +08:00
|
|
|
|
AT91F_USB_SendZlp(pUdp);
|
2017-09-29 05:14:51 +08:00
|
|
|
|
} else {
|
2012-12-05 07:41:54 +08:00
|
|
|
|
AT91F_USB_SendStall(pUdp);
|
2017-09-29 05:14:51 +08:00
|
|
|
|
}
|
2012-12-05 07:41:54 +08:00
|
|
|
|
break;
|
|
|
|
|
|
|
|
|
|
// handle CDC class requests
|
|
|
|
|
case SET_LINE_CODING:
|
2017-10-11 16:15:41 +08:00
|
|
|
|
// ignor SET_LINE_CODING...
|
2017-07-05 02:07:45 +08:00
|
|
|
|
while ( !(pUdp->UDP_CSR[AT91C_EP_CONTROL] & AT91C_UDP_RX_DATA_BK0) );
|
2017-10-10 21:06:17 +08:00
|
|
|
|
UDP_CLEAR_EP_FLAGS(AT91C_EP_CONTROL, AT91C_UDP_RX_DATA_BK0);
|
2012-12-05 07:41:54 +08:00
|
|
|
|
AT91F_USB_SendZlp(pUdp);
|
|
|
|
|
break;
|
|
|
|
|
case GET_LINE_CODING:
|
|
|
|
|
AT91F_USB_SendData(pUdp, (char *) &line, MIN(sizeof(line), wLength));
|
|
|
|
|
break;
|
|
|
|
|
case SET_CONTROL_LINE_STATE:
|
|
|
|
|
btConnection = wValue;
|
|
|
|
|
AT91F_USB_SendZlp(pUdp);
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
AT91F_USB_SendStall(pUdp);
|
|
|
|
|
break;
|
|
|
|
|
}
|
2017-09-29 05:14:51 +08:00
|
|
|
|
}
|