[/uquote]
На костяк библиотеки ну может месяц ушёл без отрыва от основных проектов. Улучшения - бесконечны. Добавление Миландра пару дней заняло параллельно с его изучением. Пробовал на MicroBlaze, но там это не так актуально - намного эффективнее схемной реализацией оптимизировать. 
Код: Выделить всё
#pragma once
#define MIN(a, b) (((a) < (b)) ? (a) : (b))
// Universal Serial Bus Specification Revision 2.0
// 9.4 Standard Device Requests
enum class STD_REQUEST : uint16_t
{
CLEAR_DEVICE_FEATURE = 0x0100,
CLEAR_INTERFACE_FEATURE = 0x0101,
CLEAR_ENDPOINT_FEATURE = 0x0102,
GET_CONFIGURATION = 0x0880,
GET_DESCRIPTOR = 0x0680,
GET_INTERFACE = 0x0A81,
GET_DEVICE_STATUS = 0x0080,
GET_INTERFACE_STATUS = 0x0081,
GET_ENDPOINT_STATUS = 0x0082,
SET_ADDRESS = 0x0500,
SET_CONFIGURATION = 0x0900,
SET_DESCRIPTOR = 0x0700,
SET_DEVICE_FEATURE = 0x0300,
SET_INTERFACE_FEATURE = 0x0301,
SET_ENDPOINT_FEATURE = 0x0302,
SET_INTERFACE = 0x0B01,
SYNCH_FRAME = 0x0C82
};
struct __attribute__((__packed__)) USB_SETUP_REQ
{
uint16_t wRequest;
union
{
uint16_t wValue;
struct
{
uint8_t descIndex;
DescriptorType descType;
};
};
uint16_t wIndex;
uint16_t wLength;
};
template<typename TPort>
class USB_DEVICE
{
public:
USB_DEVICE() = default;
//Чисто виртуальная функция обязательна для реализации в производных классах
virtual bool ClassSpecificSetup(USB_SETUP_REQ *uSetReq, uint32_t *len, uint8_t **pbuf) = 0;
inline void Enumerate_Reset()
{
TPort::Enumerate_Reset();
TPort::template EPInit<0,EP_TYPE::Control>(); // Инициализируем EP0
CurrentConfiguration = 0;
}
inline void Enumerate_Setup()
{
uint32_t reply_len=0;
uint8_t *pbuf=NULL;
switch(STD_REQUEST(uSetReq.wRequest))
{
case STD_REQUEST::GET_DESCRIPTOR: //Запрос дескриптора
switch(uSetReq.descType)
{
case DescriptorType::DEVICE: //Запрос дескриптора устройства
DEBUG_Print("GET_Device_Descriptor %d bytes\r\n",uSetReq.wLength);
reply_len = sizeof(DeviceDescriptor);
pbuf = (uint8_t *)&DeviceDescriptor;
break;
case DescriptorType::CONFIGURATION: //Запрос дескриптора конфигурации
DEBUG_Print("GET_Configuration_Descriptor %d bytes\r\n",uSetReq.wLength);
reply_len = sizeof(ConfigDescriptor);
pbuf = (uint8_t *)&ConfigDescriptor;
break;
case DescriptorType::DEVICE_QUALIFIER: //Запрос дескриптора device_qualifier
DEBUG_Print("GET_Device_qualifier_Descriptor %d bytes\r\n",uSetReq.wLength);
reply_len = sizeof(Device_Qualifier);
pbuf = (uint8_t *)&Device_Qualifier;
break;
case DescriptorType::STRING: //Запрос строкового дескриптора
for(auto& it : descr_table) // Проходимся по таблице адресов дескрипторов
if( *it == uSetReq.descIndex) // По полю bIndex смотрим на совпадение
{
pbuf = (uint8_t *)it+1; // Адрес для отправки указывает на поле bLength
reply_len = *pbuf; // Длина для отправки берётся из поля bLength
DEBUG_Print("GET_String_Descriptor 0x%X %d bytes\r\n", uSetReq.descIndex, uSetReq.wLength);
break;
}
if(pbuf==NULL) DEBUG_Print("GET_String_Descriptor 0x%X not supported\r\n",uSetReq.descIndex);
break;
default:
DEBUG_Print("GET_Descriptor 0x%X not supported\r\n",uSetReq.wValue);
return;
}
break;
case STD_REQUEST::SET_ADDRESS: // Установка адреса устройства
DEBUG_Print("SET_ADDRESS %d\r\n", uSetReq.wValue);
TPort::SetAdr(uSetReq.wValue); // reply_len = 0 -> ZLP
break;
case STD_REQUEST::SET_CONFIGURATION: // Установка конфигурации устройства
DEBUG_Print("SET_CONFIGURATION %d\r\n", uSetReq.wValue);
CurrentConfiguration = uSetReq.wValue;
break; // reply_len=0 -> ZLP
case STD_REQUEST::GET_CONFIGURATION:
DEBUG_Print("GET_CONFIGURATION:\r\n");
reply_len = 1;
pbuf = (uint8_t *)&CurrentConfiguration;
break;
case STD_REQUEST::GET_DEVICE_STATUS:
[[fallthrough]];
case STD_REQUEST::GET_INTERFACE_STATUS:
[[fallthrough]];
case STD_REQUEST::GET_ENDPOINT_STATUS:
DEBUG_Print("GET_STATUS\r\n");
reply_len = sizeof(get_status_reply);
pbuf = (uint8_t *)get_status_reply;
break;
case STD_REQUEST::CLEAR_DEVICE_FEATURE:
[[fallthrough]];
case STD_REQUEST::CLEAR_INTERFACE_FEATURE:
[[fallthrough]];
case STD_REQUEST::CLEAR_ENDPOINT_FEATURE:
DEBUG_Print("CLEAR_FEATURE\r\n");
// для простоты просто ZLP
break;
case STD_REQUEST::SET_DEVICE_FEATURE:
[[fallthrough]];
case STD_REQUEST::SET_INTERFACE_FEATURE:
[[fallthrough]];
case STD_REQUEST::SET_ENDPOINT_FEATURE:
DEBUG_Print("SET_FEATURE\r\n");
// для простоты просто ZLP
break;
case STD_REQUEST::SET_INTERFACE:
DEBUG_Print("SET_INTERFACE\r\n");
// для простоты просто ZLP
break;
case STD_REQUEST::SET_DESCRIPTOR:
DEBUG_Print("SET_DESCRIPTOR\r\n");
// надо бы STALL, но для простоты просто ZLP
break;
case STD_REQUEST::SYNCH_FRAME:
DEBUG_Print("SYNCH_FRAME\r\n");
// для простых устройств забьём
break;
default:
if(!ClassSpecificSetup((USB_SETUP_REQ *)&uSetReq, &reply_len, &pbuf)) return;
break;
}
TPort::template WriteEP<0>(pbuf,MIN(reply_len,uSetReq.wLength));
}
inline USB_SETUP_REQ *GetSetupRequestAdr() { return (USB_SETUP_REQ *)&uSetReq; }
inline uint8_t *GetRXBufAdr() { return (uint8_t *)rx_buf; }
inline void SetRxLen(uint32_t len) { rx_len = len; }
inline uint32_t GetRxLen() { return rx_len; }
volatile uint32_t rx_len;
volatile uint8_t rx_buf[64];
private:
volatile USB_SETUP_REQ uSetReq; // Принятый SETUP запрос
volatile uint8_t CurrentConfiguration; // Текущая конфигурация
uint8_t get_status_reply[2]; // Ответ на запрос GET_STATUS
};