mirror of
https://github.com/eddyem/stm32samples.git
synced 2025-12-06 02:35:23 +03:00
940 lines
38 KiB
C
940 lines
38 KiB
C
/*
|
|
* This file is part of the SevenCDCs project.
|
|
* Copyright 2023 Edward V. Emelianov <edward.emelianoff@gmail.com>.
|
|
*
|
|
* This program is free software: you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation, either version 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program. If not, see <http://www.gnu.org/licenses/>.
|
|
*/
|
|
|
|
#include <stdint.h>
|
|
#include "debug.h"
|
|
#ifdef EBUG
|
|
#include "strfunc.h"
|
|
#endif
|
|
#include "usart.h"
|
|
#include "usb.h"
|
|
#include "usb_lib.h"
|
|
#include "usbhw.h"
|
|
|
|
ep_t endpoints[STM32ENDPOINTS];
|
|
|
|
static uint16_t USB_Addr = 0;
|
|
uint8_t ep0databuf[EP0DATABUF_SIZE], setupdatabuf[EP0DATABUF_SIZE];
|
|
config_pack_t *setup_packet = (config_pack_t*) setupdatabuf;
|
|
|
|
volatile uint8_t usbON = 0;
|
|
|
|
// definition of parts common for USB_DeviceDescriptor & USB_DeviceQualifierDescriptor
|
|
#define bcdUSB_L 0x00
|
|
#define bcdUSB_H 0x02
|
|
// Class - Misc (EF), subclass - common (2), protocol - interface association descr (1)
|
|
#define bDeviceClass 0xEF
|
|
#define bDeviceSubClass 0x02
|
|
#define bDeviceProtocol 0x01
|
|
#define bNumConfigurations 1
|
|
|
|
static const uint8_t USB_DeviceDescriptor[] = {
|
|
18, // bLength
|
|
0x01, // bDescriptorType - Device descriptor
|
|
bcdUSB_L, // bcdUSB_L - 1.10
|
|
bcdUSB_H, // bcdUSB_H
|
|
bDeviceClass, // bDeviceClass - USB_COMM
|
|
bDeviceSubClass, // bDeviceSubClass
|
|
bDeviceProtocol, // bDeviceProtocol
|
|
USB_EP0_BUFSZ, // bMaxPacketSize
|
|
// 0483:5740 (VID:PID) - stm32 VCP
|
|
0x83, 0x04, 0x40, 0x57,
|
|
0x00, // bcdDevice_Ver_L
|
|
0x02, // bcdDevice_Ver_H
|
|
iMANUFACTURER_DESCR, // iManufacturer
|
|
iPRODUCT_DESCR, // iProduct
|
|
iSERIAL_DESCR, // iSerialNumber
|
|
bNumConfigurations // bNumConfigurations
|
|
};
|
|
|
|
static const uint8_t USB_DeviceQualifierDescriptor[] = {
|
|
10, //bLength
|
|
0x06, // bDescriptorType - Device qualifier
|
|
bcdUSB_L, // bcdUSB_L
|
|
bcdUSB_H, // bcdUSB_H
|
|
bDeviceClass, // bDeviceClass
|
|
bDeviceSubClass, // bDeviceSubClass
|
|
bDeviceProtocol, // bDeviceProtocol
|
|
USB_EP0_BUFSZ, // bMaxPacketSize0
|
|
bNumConfigurations, // bNumConfigurations
|
|
0x00 // Reserved
|
|
};
|
|
|
|
static const uint8_t USB_ConfigDescriptor[] = {
|
|
/* Configuration Descriptor*/
|
|
0x09, /* bLength: Configuration Descriptor size */
|
|
0x02, /* bDescriptorType: Configuration */
|
|
0xD7, /* wTotalLength:no of returned bytes (9+7*66=471, 0x1D7 */
|
|
0x01,
|
|
14, /* bNumInterfaces: 14 interfaces (7*2) */
|
|
0x01, /* bConfigurationValue: Configuration value */
|
|
0x00, /* iConfiguration: Index of string descriptor describing the configuration */
|
|
0x80, /* bmAttributes - Bus powered */
|
|
0x32, /* MaxPower 100 mA */
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
// IAD0 (66 bytes)
|
|
0x08, // bLength: Interface Descriptor size
|
|
0x0B, // bDescriptorType: IAD
|
|
0, // bFirstInterface
|
|
0x02, // bInterfaceCount
|
|
0x02, // bFunctionClass: CDC
|
|
0x02, // bFunctionSubClass
|
|
0x00, // bFunctionProtocol
|
|
0x00, // iFunction
|
|
/*---------------------------------------------------------------------------*/
|
|
/* Interface Descriptor */
|
|
0x09, /* bLength: Interface Descriptor size */
|
|
0x04, /* bDescriptorType: Interface */
|
|
0x00, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x01, /* bNumEndpoints: One endpoints used */
|
|
0x02, /* bInterfaceClass: Communication Interface Class */
|
|
0x02, /* bInterfaceSubClass: Abstract Control Model */
|
|
0x00, /* bInterfaceProtocol */
|
|
iINTERFACE_DESCR_CMD, /* iInterface: */
|
|
/*Header Functional Descriptor*/
|
|
0x05, /* bLength: Endpoint Descriptor size */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x00, /* bDescriptorSubtype: Header Func Desc */
|
|
0x10, /* bcdCDC: spec release number */
|
|
0x01,
|
|
/*Call Management Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x01, /* bDescriptorSubtype: Call Management Func Desc */
|
|
0x00, /* bmCapabilities: D0+D1 */
|
|
0x01, /* bDataInterface: 1 */
|
|
/*ACM Functional Descriptor*/
|
|
0x04, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x02, /* bDescriptorSubtype: Abstract Control Management desc */
|
|
0x02, /* bmCapabilities */
|
|
/*Union Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x06, /* bDescriptorSubtype: Union func desc */
|
|
0x00, /* bMasterInterface: Communication class interface */
|
|
0x01, /* bSlaveInterface0: Data Class Interface */
|
|
/*Endpoint 10 Descriptor*/
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x88, /* bEndpointAddress IN8 - non-existant! */
|
|
0x03, /* bmAttributes: Interrupt */
|
|
(USB_EP1BUFSZ & 0xff), /* wMaxPacketSize LO: */
|
|
(USB_EP1BUFSZ >> 8), /* wMaxPacketSize HI: */
|
|
0x10, /* bInterval: */
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Data class interface descriptor*/
|
|
0x09, /* bLength: Endpoint Descriptor size */
|
|
0x04, /* bDescriptorType: */
|
|
0x01, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x02, /* bNumEndpoints: Two endpoints used */
|
|
0x0A, /* bInterfaceClass: CDC */
|
|
0x02, /* bInterfaceSubClass: */
|
|
0x00, /* bInterfaceProtocol: */
|
|
0x00, /* iInterface: */
|
|
/*Endpoint IN Descriptor*/
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
0x81, /* bEndpointAddress IN1 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*Endpoint OUT Descriptor*/
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
0x01, /* bEndpointAddress OUT1 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
// IAD1: interfaces 2&3, EP2
|
|
0x08, // bLength: Interface Descriptor size
|
|
0x0B, // bDescriptorType: IAD
|
|
/**/ 2, // bFirstInterface
|
|
0x02, // bInterfaceCount
|
|
0x02, // bFunctionClass: CDC
|
|
0x02, // bFunctionSubClass
|
|
0x00, // bFunctionProtocol
|
|
0x00, // iFunction
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Interface Descriptor */
|
|
0x09, /* bLength: Interface Descriptor size */
|
|
0x04, /* bDescriptorType: Interface */
|
|
/**/ 2, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x01, /* bNumEndpoints: One endpoints used */
|
|
0x02, /* bInterfaceClass: Communication Interface Class */
|
|
0x02, /* bInterfaceSubClass: Abstract Control Model */
|
|
0x00, /* bInterfaceProtocol */
|
|
iINTERFACE_DESCR_USART1, /* iInterface: */
|
|
/*Header Functional Descriptor*/
|
|
0x05, /* bLength: Endpoint Descriptor size */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x00, /* bDescriptorSubtype: Header Func Desc */
|
|
0x10, /* bcdCDC: spec release number */
|
|
0x01,
|
|
/*Call Management Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x01, /* bDescriptorSubtype: Call Management Func Desc */
|
|
0x00, /* bmCapabilities: D0+D1 */
|
|
/**/ 3, /* bDataInterface: 3 */
|
|
/*ACM Functional Descriptor*/
|
|
0x04, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x02, /* bDescriptorSubtype: Abstract Control Management desc */
|
|
0x02, /* bmCapabilities */
|
|
/*Union Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x06, /* bDescriptorSubtype: Union func desc */
|
|
/**/ 2, /* bMasterInterface: Communication class interface */
|
|
/**/ 3, /* bSlaveInterface0: Data Class Interface */
|
|
/*Endpoint 11 Descriptor*/
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x89, /* bEndpointAddress IN9 - non-existant! */
|
|
0x03, /* bmAttributes: Interrupt */
|
|
(USB_EP1BUFSZ & 0xff), /* wMaxPacketSize LO: */
|
|
(USB_EP1BUFSZ >> 8), /* wMaxPacketSize HI: */
|
|
0x10, /* bInterval: */
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Data class interface descriptor*/
|
|
0x09, /* bLength: Endpoint Descriptor size */
|
|
0x04, /* bDescriptorType: */
|
|
/**/ 3, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x02, /* bNumEndpoints: Two endpoints used */
|
|
0x0A, /* bInterfaceClass: CDC */
|
|
0x02, /* bInterfaceSubClass: */
|
|
0x00, /* bInterfaceProtocol: */
|
|
0x00, /* iInterface: */
|
|
/*Endpoint IN Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x82, /* bEndpointAddress IN2 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*Endpoint OUT Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x02, /* bEndpointAddress OUT2 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
// IAD2: interfaces 4&5, EP3
|
|
0x08, // bLength: Interface Descriptor size
|
|
0x0B, // bDescriptorType: IAD
|
|
/**/ 4, // bFirstInterface
|
|
0x02, // bInterfaceCount
|
|
0x02, // bFunctionClass: CDC
|
|
0x02, // bFunctionSubClass
|
|
0x00, // bFunctionProtocol
|
|
0x00, // iFunction
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Interface Descriptor */
|
|
0x09, /* bLength: Interface Descriptor size */
|
|
0x04, /* bDescriptorType: Interface */
|
|
/**/ 4, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x01, /* bNumEndpoints: One endpoints used */
|
|
0x02, /* bInterfaceClass: Communication Interface Class */
|
|
0x02, /* bInterfaceSubClass: Abstract Control Model */
|
|
0x00, /* bInterfaceProtocol */
|
|
iINTERFACE_DESCR_USART2, /* iInterface: */
|
|
/*Header Functional Descriptor*/
|
|
0x05, /* bLength: Endpoint Descriptor size */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x00, /* bDescriptorSubtype: Header Func Desc */
|
|
0x10, /* bcdCDC: spec release number */
|
|
0x01,
|
|
/*Call Management Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x01, /* bDescriptorSubtype: Call Management Func Desc */
|
|
0x00, /* bmCapabilities: D0+D1 */
|
|
/**/ 5, /* bDataInterface */
|
|
/*ACM Functional Descriptor*/
|
|
0x04, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x02, /* bDescriptorSubtype: Abstract Control Management desc */
|
|
0x02, /* bmCapabilities */
|
|
/*Union Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x06, /* bDescriptorSubtype: Union func desc */
|
|
/**/ 4, /* bMasterInterface: Communication class interface */
|
|
/**/ 5, /* bSlaveInterface0: Data Class Interface */
|
|
/*Endpoint 11 Descriptor*/
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x8a, /* bEndpointAddress IN10 - non-existant! */
|
|
0x03, /* bmAttributes: Interrupt */
|
|
(USB_EP1BUFSZ & 0xff), /* wMaxPacketSize LO: */
|
|
(USB_EP1BUFSZ >> 8), /* wMaxPacketSize HI: */
|
|
0x10, /* bInterval: */
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Data class interface descriptor*/
|
|
0x09, /* bLength: Endpoint Descriptor size */
|
|
0x04, /* bDescriptorType: */
|
|
/**/ 5, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x02, /* bNumEndpoints: Two endpoints used */
|
|
0x0A, /* bInterfaceClass: CDC */
|
|
0x02, /* bInterfaceSubClass: */
|
|
0x00, /* bInterfaceProtocol: */
|
|
0x00, /* iInterface: */
|
|
/*Endpoint IN Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x83, /* bEndpointAddress IN3 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*Endpoint OUT Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x03, /* bEndpointAddress OUT3 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
// IAD3: interfaces 6&7, EP4
|
|
0x08, // bLength: Interface Descriptor size
|
|
0x0B, // bDescriptorType: IAD
|
|
/**/ 6, // bFirstInterface
|
|
0x02, // bInterfaceCount
|
|
0x02, // bFunctionClass: CDC
|
|
0x02, // bFunctionSubClass
|
|
0x00, // bFunctionProtocol
|
|
0x00, // iFunction
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Interface Descriptor */
|
|
0x09, /* bLength: Interface Descriptor size */
|
|
0x04, /* bDescriptorType: Interface */
|
|
/**/ 6, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x01, /* bNumEndpoints: One endpoints used */
|
|
0x02, /* bInterfaceClass: Communication Interface Class */
|
|
0x02, /* bInterfaceSubClass: Abstract Control Model */
|
|
0x00, /* bInterfaceProtocol */
|
|
iINTERFACE_DESCR_USART3, /* iInterface: */
|
|
/*Header Functional Descriptor*/
|
|
0x05, /* bLength: Endpoint Descriptor size */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x00, /* bDescriptorSubtype: Header Func Desc */
|
|
0x10, /* bcdCDC: spec release number */
|
|
0x01,
|
|
/*Call Management Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x01, /* bDescriptorSubtype: Call Management Func Desc */
|
|
0x00, /* bmCapabilities: D0+D1 */
|
|
/**/ 7, /* bDataInterface */
|
|
/*ACM Functional Descriptor*/
|
|
0x04, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x02, /* bDescriptorSubtype: Abstract Control Management desc */
|
|
0x02, /* bmCapabilities */
|
|
/*Union Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x06, /* bDescriptorSubtype: Union func desc */
|
|
/**/ 6, /* bMasterInterface: Communication class interface */
|
|
/**/ 7, /* bSlaveInterface0: Data Class Interface */
|
|
/* Interrupt Endpoint Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x8b, /* bEndpointAddress IN11 - non-existant! */
|
|
0x03, /* bmAttributes: Interrupt */
|
|
(USB_EP1BUFSZ & 0xff), /* wMaxPacketSize LO: */
|
|
(USB_EP1BUFSZ >> 8), /* wMaxPacketSize HI: */
|
|
0x10, /* bInterval: */
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Data class interface descriptor*/
|
|
0x09, /* bLength: Endpoint Descriptor size */
|
|
0x04, /* bDescriptorType: */
|
|
/**/ 7, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x02, /* bNumEndpoints: Two endpoints used */
|
|
0x0A, /* bInterfaceClass: CDC */
|
|
0x02, /* bInterfaceSubClass: */
|
|
0x00, /* bInterfaceProtocol: */
|
|
0x00, /* iInterface: */
|
|
/*Endpoint IN Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x84, /* bEndpointAddress IN4 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*Endpoint OUT Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x04, /* bEndpointAddress OUT4 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
// IAD4: interfaces 8&9, EP5
|
|
0x08, // bLength: Interface Descriptor size
|
|
0x0B, // bDescriptorType: IAD
|
|
/**/ 8, // bFirstInterface
|
|
0x02, // bInterfaceCount
|
|
0x02, // bFunctionClass: CDC
|
|
0x02, // bFunctionSubClass
|
|
0x00, // bFunctionProtocol
|
|
0x00, // iFunction
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Interface Descriptor */
|
|
0x09, /* bLength: Interface Descriptor size */
|
|
0x04, /* bDescriptorType: Interface */
|
|
/**/ 8, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x01, /* bNumEndpoints: One endpoints used */
|
|
0x02, /* bInterfaceClass: Communication Interface Class */
|
|
0x02, /* bInterfaceSubClass: Abstract Control Model */
|
|
iINTERFACE_DESCR_USART4, /* bInterfaceProtocol */
|
|
0x00, /* iInterface: */
|
|
/*Header Functional Descriptor*/
|
|
0x05, /* bLength: Endpoint Descriptor size */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x00, /* bDescriptorSubtype: Header Func Desc */
|
|
0x10, /* bcdCDC: spec release number */
|
|
0x01,
|
|
/*Call Management Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x01, /* bDescriptorSubtype: Call Management Func Desc */
|
|
0x00, /* bmCapabilities: D0+D1 */
|
|
/**/ 9, /* bDataInterface */
|
|
/*ACM Functional Descriptor*/
|
|
0x04, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x02, /* bDescriptorSubtype: Abstract Control Management desc */
|
|
0x02, /* bmCapabilities */
|
|
/*Union Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x06, /* bDescriptorSubtype: Union func desc */
|
|
/**/ 8, /* bMasterInterface: Communication class interface */
|
|
/**/ 9, /* bSlaveInterface0: Data Class Interface */
|
|
/* Interrupt Endpoint Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x8c, /* bEndpointAddress IN12 - non-existant! */
|
|
0x03, /* bmAttributes: Interrupt */
|
|
(USB_EP1BUFSZ & 0xff), /* wMaxPacketSize LO: */
|
|
(USB_EP1BUFSZ >> 8), /* wMaxPacketSize HI: */
|
|
0x10, /* bInterval: */
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Data class interface descriptor*/
|
|
0x09, /* bLength: Endpoint Descriptor size */
|
|
0x04, /* bDescriptorType: */
|
|
/**/ 9, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x02, /* bNumEndpoints: Two endpoints used */
|
|
0x0A, /* bInterfaceClass: CDC */
|
|
0x02, /* bInterfaceSubClass: */
|
|
0x00, /* bInterfaceProtocol: */
|
|
0x00, /* iInterface: */
|
|
/*Endpoint IN Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x85, /* bEndpointAddress IN5 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*Endpoint OUT Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x05, /* bEndpointAddress OUT5 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
// IAD5: interfaces 10&11, EP6
|
|
0x08, // bLength: Interface Descriptor size
|
|
0x0B, // bDescriptorType: IAD
|
|
/**/ 10, // bFirstInterface
|
|
0x02, // bInterfaceCount
|
|
0x02, // bFunctionClass: CDC
|
|
0x02, // bFunctionSubClass
|
|
0x00, // bFunctionProtocol
|
|
0x00, // iFunction
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Interface Descriptor */
|
|
0x09, /* bLength: Interface Descriptor size */
|
|
0x04, /* bDescriptorType: Interface */
|
|
/**/ 10, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x01, /* bNumEndpoints: One endpoints used */
|
|
0x02, /* bInterfaceClass: Communication Interface Class */
|
|
0x02, /* bInterfaceSubClass: Abstract Control Model */
|
|
0x00, /* bInterfaceProtocol */
|
|
iINTERFACE_DESCR_CAN, /* iInterface: */
|
|
/*Header Functional Descriptor*/
|
|
0x05, /* bLength: Endpoint Descriptor size */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x00, /* bDescriptorSubtype: Header Func Desc */
|
|
0x10, /* bcdCDC: spec release number */
|
|
0x01,
|
|
/*Call Management Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x01, /* bDescriptorSubtype: Call Management Func Desc */
|
|
0x00, /* bmCapabilities: D0+D1 */
|
|
/**/ 11, /* bDataInterface */
|
|
/*ACM Functional Descriptor*/
|
|
0x04, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x02, /* bDescriptorSubtype: Abstract Control Management desc */
|
|
0x02, /* bmCapabilities */
|
|
/*Union Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x06, /* bDescriptorSubtype: Union func desc */
|
|
/**/ 10, /* bMasterInterface: Communication class interface */
|
|
/**/ 11, /* bSlaveInterface0: Data Class Interface */
|
|
/* Interrupt Endpoint Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x8d, /* bEndpointAddress IN13 - non-existant! */
|
|
0x03, /* bmAttributes: Interrupt */
|
|
(USB_EP1BUFSZ & 0xff), /* wMaxPacketSize LO: */
|
|
(USB_EP1BUFSZ >> 8), /* wMaxPacketSize HI: */
|
|
0x10, /* bInterval: */
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Data class interface descriptor*/
|
|
0x09, /* bLength: Endpoint Descriptor size */
|
|
0x04, /* bDescriptorType: */
|
|
/**/ 11, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x02, /* bNumEndpoints: Two endpoints used */
|
|
0x0A, /* bInterfaceClass: CDC */
|
|
0x02, /* bInterfaceSubClass: */
|
|
0x00, /* bInterfaceProtocol: */
|
|
0x00, /* iInterface: */
|
|
/*Endpoint IN Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x86, /* bEndpointAddress IN6 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*Endpoint OUT Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x06, /* bEndpointAddress OUT6 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*---------------------------------------------------------------------------*/
|
|
|
|
/*---------------------------------------------------------------------------*/
|
|
// IAD6: interfaces 12&13, EP7
|
|
0x08, // bLength: Interface Descriptor size
|
|
0x0B, // bDescriptorType: IAD
|
|
/**/ 12, // bFirstInterface
|
|
0x02, // bInterfaceCount
|
|
0x02, // bFunctionClass: CDC
|
|
0x02, // bFunctionSubClass
|
|
0x00, // bFunctionProtocol
|
|
0x00, // iFunction
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Interface Descriptor */
|
|
0x09, /* bLength: Interface Descriptor size */
|
|
0x04, /* bDescriptorType: Interface */
|
|
/**/ 12, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x01, /* bNumEndpoints: One endpoints used */
|
|
0x02, /* bInterfaceClass: Communication Interface Class */
|
|
0x02, /* bInterfaceSubClass: Abstract Control Model */
|
|
0x00, /* bInterfaceProtocol */
|
|
iINTERFACE_DESCR_DBG, /* iInterface: */
|
|
/*Header Functional Descriptor*/
|
|
0x05, /* bLength: Endpoint Descriptor size */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x00, /* bDescriptorSubtype: Header Func Desc */
|
|
0x10, /* bcdCDC: spec release number */
|
|
0x01,
|
|
/*Call Management Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x01, /* bDescriptorSubtype: Call Management Func Desc */
|
|
0x00, /* bmCapabilities: D0+D1 */
|
|
/**/ 13, /* bDataInterface */
|
|
/*ACM Functional Descriptor*/
|
|
0x04, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x02, /* bDescriptorSubtype: Abstract Control Management desc */
|
|
0x02, /* bmCapabilities */
|
|
/*Union Functional Descriptor*/
|
|
0x05, /* bFunctionLength */
|
|
0x24, /* bDescriptorType: CS_INTERFACE */
|
|
0x06, /* bDescriptorSubtype: Union func desc */
|
|
/**/ 12, /* bMasterInterface: Communication class interface */
|
|
/**/ 13, /* bSlaveInterface0: Data Class Interface */
|
|
/* Interrupt Endpoint Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x8e, /* bEndpointAddress IN14 - non-existant! */
|
|
0x03, /* bmAttributes: Interrupt */
|
|
(USB_EP1BUFSZ & 0xff), /* wMaxPacketSize LO: */
|
|
(USB_EP1BUFSZ >> 8), /* wMaxPacketSize HI: */
|
|
0x10, /* bInterval: */
|
|
/*---------------------------------------------------------------------------*/
|
|
/*Data class interface descriptor*/
|
|
0x09, /* bLength: Endpoint Descriptor size */
|
|
0x04, /* bDescriptorType: */
|
|
/**/ 13, /* bInterfaceNumber: Number of Interface */
|
|
0x00, /* bAlternateSetting: Alternate setting */
|
|
0x02, /* bNumEndpoints: Two endpoints used */
|
|
0x0A, /* bInterfaceClass: CDC */
|
|
0x02, /* bInterfaceSubClass: */
|
|
0x00, /* bInterfaceProtocol: */
|
|
0x00, /* iInterface: */
|
|
/*Endpoint IN Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x87, /* bEndpointAddress IN7 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*Endpoint OUT Descriptor */
|
|
0x07, /* bLength: Endpoint Descriptor size */
|
|
0x05, /* bDescriptorType: Endpoint */
|
|
/**/0x07, /* bEndpointAddress OUT7 */
|
|
0x02, /* bmAttributes: Bulk */
|
|
(USB_TRBUFSZ & 0xff), /* wMaxPacketSize: 64 */
|
|
(USB_TRBUFSZ >> 8),
|
|
0x00, /* bInterval: ignore for Bulk transfer */
|
|
/*---------------------------------------------------------------------------*/
|
|
};
|
|
|
|
_USB_LANG_ID_(LD, LANG_US);
|
|
_USB_STRING_(SD, u"0.0.1");
|
|
_USB_STRING_(MD, u"Emelianov E.V.");
|
|
_USB_STRING_(PD, u"USB multiserial controller");
|
|
_USB_STRING_(ID0, u"serial-cmd");
|
|
_USB_STRING_(ID1, u"serial-usart1_");
|
|
_USB_STRING_(ID2, u"serial-usart2_");
|
|
_USB_STRING_(ID3, u"serial-usart3_");
|
|
_USB_STRING_(ID4, u"serial-usart4_");
|
|
_USB_STRING_(ID5, u"serial-can");
|
|
_USB_STRING_(ID6, u"serial-debug");
|
|
|
|
static void const *StringDescriptor[iDESCR_AMOUNT] = {
|
|
[iLANGUAGE_DESCR] = &LD,
|
|
[iMANUFACTURER_DESCR] = &MD,
|
|
[iPRODUCT_DESCR] = &PD,
|
|
[iSERIAL_DESCR] = &SD,
|
|
[iINTERFACE_DESCR_CMD] = &ID0,
|
|
[iINTERFACE_DESCR_USART1] = &ID1,
|
|
[iINTERFACE_DESCR_USART2] = &ID2,
|
|
[iINTERFACE_DESCR_USART3] = &ID3,
|
|
[iINTERFACE_DESCR_USART4] = &ID4,
|
|
[iINTERFACE_DESCR_CAN] = &ID5,
|
|
[iINTERFACE_DESCR_DBG] = &ID6
|
|
};
|
|
|
|
static void wr0(const uint8_t *buf, uint16_t size){
|
|
if(setup_packet->wLength < size) size = setup_packet->wLength; // shortened request
|
|
if(size < endpoints[0].txbufsz){
|
|
EP_WriteIRQ(0, buf, size);
|
|
return;
|
|
}
|
|
while(size){
|
|
uint16_t l = size;
|
|
if(l > endpoints[0].txbufsz) l = endpoints[0].txbufsz;
|
|
EP_WriteIRQ(0, buf, l);
|
|
buf += l;
|
|
size -= l;
|
|
uint8_t needzlp = (l == endpoints[0].txbufsz) ? 1 : 0;
|
|
if(size || needzlp){ // send last data buffer
|
|
uint16_t status = KEEP_DTOG(USB->EPnR[0]);
|
|
// keep DTOGs, clear CTR_RX,TX, set TX VALID, leave stat_Rx
|
|
USB->EPnR[0] = (status & ~(USB_EPnR_CTR_RX|USB_EPnR_CTR_TX|USB_EPnR_STAT_RX))
|
|
^ USB_EPnR_STAT_TX;
|
|
uint32_t ctr = 1000000;
|
|
while(--ctr && (USB->ISTR & USB_ISTR_CTR) == 0){IWDG->KR = IWDG_REFRESH;};
|
|
if((USB->ISTR & USB_ISTR_CTR) == 0){
|
|
return;
|
|
}
|
|
if(needzlp) EP_WriteIRQ(0, (uint8_t*)0, 0);
|
|
}
|
|
}
|
|
}
|
|
|
|
static inline void get_descriptor(){
|
|
uint8_t descrtype = setup_packet->wValue >> 8,
|
|
descridx = setup_packet->wValue & 0xff;
|
|
switch(descrtype){
|
|
case DEVICE_DESCRIPTOR:
|
|
wr0(USB_DeviceDescriptor, sizeof(USB_DeviceDescriptor));
|
|
break;
|
|
case CONFIGURATION_DESCRIPTOR:
|
|
wr0(USB_ConfigDescriptor, sizeof(USB_ConfigDescriptor));
|
|
break;
|
|
case STRING_DESCRIPTOR:
|
|
if(descridx < iDESCR_AMOUNT) wr0((const uint8_t *)StringDescriptor[descridx], *((uint8_t*)StringDescriptor[descridx]));
|
|
else EP_WriteIRQ(0, (uint8_t*)0, 0);
|
|
break;
|
|
case DEVICE_QUALIFIER_DESCRIPTOR:
|
|
wr0(USB_DeviceQualifierDescriptor, USB_DeviceQualifierDescriptor[0]);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static uint16_t configuration = 0; // reply for GET_CONFIGURATION (==1 if configured)
|
|
static inline void std_d2h_req(){
|
|
uint16_t status = 0; // bus powered
|
|
switch(setup_packet->bRequest){
|
|
case GET_DESCRIPTOR:
|
|
get_descriptor();
|
|
break;
|
|
case GET_STATUS:
|
|
EP_WriteIRQ(0, (uint8_t *)&status, 2); // send status: Bus Powered
|
|
break;
|
|
case GET_CONFIGURATION:
|
|
EP_WriteIRQ(0, (uint8_t*)&configuration, 1);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
// Rx and Tx handlers for EP1..EP7
|
|
static void rxtx_Handler(uint8_t epno){
|
|
uint8_t buf[USB_TRBUFSZ];
|
|
int idx = epno - 1;
|
|
uint16_t epstatus = KEEP_DTOG(USB->EPnR[epno]);
|
|
//uint16_t epstatus = USB->EPnR[epno];
|
|
if(RX_FLAG(epstatus)){
|
|
epstatus = (epstatus & ~(USB_EPnR_STAT_TX|USB_EPnR_CTR_RX)) ^ USB_EPnR_STAT_RX; // keep stat Tx & set valid RX, clear CTR Rx
|
|
USB->EPnR[epno] = epstatus;
|
|
//USB->EPnR[epno] = (KEEP_DTOG(epstatus) & ~USB_EPnR_CTR_RX) ^ USB_EPnR_STAT_RX;
|
|
uint8_t sz = EP_Read(epno, (uint8_t*)buf);
|
|
if(sz){
|
|
if(RB_write((ringbuffer*)&rbin[idx], buf, sz) != sz) bufovrfl[idx] = 1;
|
|
}
|
|
// set ACK Rx
|
|
USB->EPnR[epno] = (KEEP_DTOG(USB->EPnR[epno]) & ~(USB_EPnR_STAT_TX)) ^ USB_EPnR_STAT_RX;
|
|
}else{
|
|
USB->EPnR[epno] = (epstatus & ~(USB_EPnR_STAT_TX|USB_EPnR_CTR_TX)) ^ USB_EPnR_STAT_RX; // clear TX ctr
|
|
//USB->EPnR[epno] = (KEEP_DTOG_STAT(epstatus) & ~(USB_EPnR_CTR_TX)); // clear TX ctr
|
|
send_next(idx);
|
|
}
|
|
}
|
|
|
|
static inline void std_h2d_req(){
|
|
switch(setup_packet->bRequest){
|
|
case SET_ADDRESS:
|
|
// new address will be assigned later - after acknowlegement or request to host
|
|
USB_Addr = setup_packet->wValue;
|
|
break;
|
|
case SET_CONFIGURATION:
|
|
// Now device configured
|
|
configuration = setup_packet->wValue;
|
|
for(uint8_t i = 1; i <= WORK_EPs; ++i){
|
|
EP_Init(i, EP_TYPE_BULK, USB_TRBUFSZ, USB_TRBUFSZ, rxtx_Handler);
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*
|
|
bmRequestType: 76543210
|
|
7 direction: 0 - host->device, 1 - device->host
|
|
65 type: 0 - standard, 1 - class, 2 - vendor
|
|
4..0 getter: 0 - device, 1 - interface, 2 - endpoint, 3 - other
|
|
*/
|
|
/**
|
|
* Endpoint0 (control) handler
|
|
*/
|
|
void EP0_Handler(uint8_t __attribute__((unused)) epno){
|
|
uint16_t epstatus = USB->EPnR[0]; // EP0R on input -> return this value after modifications
|
|
uint8_t reqtype = setup_packet->bmRequestType & 0x7f;
|
|
uint8_t dev2host = (setup_packet->bmRequestType & 0x80) ? 1 : 0;
|
|
int rxflag = RX_FLAG(epstatus);
|
|
usb_LineCoding *lc;
|
|
// calculate iFno (EP number minus 1) by setup_packet->wIndex (bInterfaceNumber): iFno = wIndex >> 1
|
|
int iFno = setup_packet->wIndex >> 1;
|
|
DBGmesg(uhex2str(epstatus));
|
|
DBGmesg(" - "); hexdump(DBG_IDX, (uint8_t*)setup_packet, sizeof(config_pack_t));
|
|
if(rxflag && SETUP_FLAG(epstatus)){
|
|
switch(reqtype){
|
|
case STANDARD_DEVICE_REQUEST_TYPE: // standard device request
|
|
if(dev2host){
|
|
std_d2h_req();
|
|
}else{
|
|
std_h2d_req();
|
|
EP_WriteIRQ(0, (uint8_t *)0, 0);
|
|
}
|
|
break;
|
|
case STANDARD_ENDPOINT_REQUEST_TYPE: // standard endpoint request
|
|
if(setup_packet->bRequest == CLEAR_FEATURE){
|
|
EP_WriteIRQ(0, (uint8_t *)0, 0);
|
|
}
|
|
break;
|
|
case CONTROL_REQUEST_TYPE:
|
|
switch(setup_packet->bRequest){
|
|
case GET_LINE_CODING:
|
|
DBG("GLC");
|
|
lc = getLineCoding(iFno);
|
|
if(!lc) EP_WriteIRQ(0, (uint8_t *)0, 0);
|
|
else EP_WriteIRQ(0, (uint8_t*)&lc, sizeof(usb_LineCoding));
|
|
break;
|
|
case SET_LINE_CODING: // omit this for next stage, when data will come
|
|
DBG("SLC");
|
|
break;
|
|
case SET_CONTROL_LINE_STATE:
|
|
DBG("SCLS");
|
|
usbON |= 1 << iFno; // now this interface is connected
|
|
break;
|
|
case SEND_BREAK:
|
|
DBG("B");
|
|
usbON &= ~(1<<iFno); // interface is disconnected
|
|
break;
|
|
default:
|
|
DBG("U");
|
|
break;
|
|
}
|
|
if(setup_packet->bRequest != GET_LINE_CODING) EP_WriteIRQ(0, (uint8_t *)0, 0); // write acknowledgement
|
|
break;
|
|
default:
|
|
EP_WriteIRQ(0, (uint8_t *)0, 0);
|
|
}
|
|
}else if(rxflag){ // got data over EP0 or host acknowlegement
|
|
if(endpoints[0].rx_cnt){
|
|
if(setup_packet->bRequest == SET_LINE_CODING){
|
|
usart_config(iFno + 1 - USART1_EPNO, (usb_LineCoding*)ep0databuf);
|
|
}
|
|
}
|
|
} else if(TX_FLAG(epstatus)){ // package transmitted
|
|
// now we can change address after enumeration
|
|
if ((USB->DADDR & USB_DADDR_ADD) != USB_Addr){
|
|
USB->DADDR = USB_DADDR_EF | USB_Addr;
|
|
}
|
|
}
|
|
epstatus = KEEP_DTOG(USB->EPnR[0]);
|
|
if(rxflag) epstatus ^= USB_EPnR_STAT_TX; // start ZLP/data transmission
|
|
else epstatus &= ~USB_EPnR_STAT_TX; // or leave unchanged
|
|
// keep DTOGs, clear CTR_RX,TX, set RX VALID
|
|
USB->EPnR[0] = (epstatus & ~(USB_EPnR_CTR_RX|USB_EPnR_CTR_TX)) ^ USB_EPnR_STAT_RX;
|
|
}
|
|
|
|
/**
|
|
* Write data to EP buffer (called from IRQ handler)
|
|
* @param number - EP number
|
|
* @param *buf - array with data
|
|
* @param size - its size
|
|
*/
|
|
void EP_WriteIRQ(uint8_t number, const uint8_t *buf, uint16_t size){
|
|
if(size > endpoints[number].txbufsz) size = endpoints[number].txbufsz;
|
|
uint16_t N2 = (size + 1) >> 1;
|
|
// the buffer is 16-bit, so we should copy data as it would be uint16_t
|
|
uint16_t *buf16 = (uint16_t *)buf;
|
|
#if defined USB1_16
|
|
// very bad: what if `size` is odd?
|
|
uint32_t *out = (uint32_t *)endpoints[number].tx_buf;
|
|
for(int i = 0; i < N2; ++i, ++out){
|
|
*out = buf16[i];
|
|
}
|
|
#elif defined USB2_16
|
|
// use memcpy instead?
|
|
for(int i = 0; i < N2; i++){
|
|
endpoints[number].tx_buf[i] = buf16[i];
|
|
}
|
|
#else
|
|
#error "Define USB1_16 or USB2_16"
|
|
#endif
|
|
USB_BTABLE->EP[number].USB_COUNT_TX = size;
|
|
}
|
|
|
|
/**
|
|
* Write data to EP buffer (called outside IRQ handler)
|
|
* @param number - EP number
|
|
* @param *buf - array with data
|
|
* @param size - its size
|
|
*/
|
|
void EP_Write(uint8_t number, const uint8_t *buf, uint16_t size){
|
|
EP_WriteIRQ(number, buf, size);
|
|
uint16_t status = KEEP_DTOG(USB->EPnR[number]);
|
|
// keep DTOGs, clear CTR_TX & set TX VALID to start transmission
|
|
USB->EPnR[number] = (status & ~(USB_EPnR_CTR_TX)) ^ USB_EPnR_STAT_TX;
|
|
}
|
|
|
|
/*
|
|
* Copy data from EP buffer into user buffer area
|
|
* @param *buf - user array for data
|
|
* @return amount of data read
|
|
*/
|
|
int EP_Read(uint8_t number, uint8_t *buf){
|
|
int sz = endpoints[number].rx_cnt;
|
|
if(!sz) return 0;
|
|
endpoints[number].rx_cnt = 0;
|
|
#if defined USB1_16
|
|
int n = (sz + 1) >> 1;
|
|
uint32_t *in = (uint32_t*)endpoints[number].rx_buf;
|
|
uint16_t *out = (uint16_t*)buf;
|
|
for(int i = 0; i < n; ++i, ++in)
|
|
out[i] = *(uint16_t*)in;
|
|
#elif defined USB2_16
|
|
// use memcpy instead?
|
|
for(int i = 0; i < sz; ++i)
|
|
buf[i] = endpoints[number].rx_buf[i];
|
|
#else
|
|
#error "Define USB1_16 or USB2_16"
|
|
#endif
|
|
return sz;
|
|
}
|
|
|