242 lines
11 KiB
C
242 lines
11 KiB
C
#include <stdint.h>
|
|
|
|
typedef struct USBD_descriptor {
|
|
uint32_t addr_tx;
|
|
uint32_t count_tx;
|
|
uint32_t addr_rx;
|
|
uint32_t count_rx;
|
|
} USBD_descriptor;
|
|
|
|
// USBD memory allocation:
|
|
// WARNING THIS IS A 16-bit MEMORY LMAO
|
|
// +0x00
|
|
// descriptors (two sets of two endpoints)
|
|
// +0x20
|
|
// EP 0 OUT (8 bytes)
|
|
// +0x30
|
|
// EP 0 IN (8 bytes)
|
|
// +0x40
|
|
// EP 1 OUT (64 bytes)
|
|
// +0xc0
|
|
// EP 1 IN (64 bytes)
|
|
// +0x140
|
|
// <unused>
|
|
// +0x200
|
|
// <256-byte flash page buffer>
|
|
|
|
const uint8_t USB_DEV_DESC[18] __attribute__((aligned(16))) = {
|
|
18, // bLength
|
|
1, // bDescriptorType
|
|
0x00, 0x02, // bcdUSB
|
|
0xff, // bDeviceClass
|
|
0xff, // bDeviceSubClass
|
|
0xff, // bDeviceProtocol
|
|
8, // bMaxPacketSize0
|
|
0x55, 0xf0, // idVendor
|
|
0x00, 0x00, // idProduct
|
|
0x00, 0x00, // bcdDevice
|
|
0, // iManufacturer
|
|
0, // iProduct
|
|
0, // iSerialNumber
|
|
1, // bNumConfigurations
|
|
};
|
|
|
|
const uint8_t USB_CONF_DESC[9] __attribute__((aligned(16))) = {
|
|
9, // bLength
|
|
2, // bDescriptorType
|
|
0x09, 0x00, // wTotalLength
|
|
0, // bNumInterfaces
|
|
1, // bConfigurationValue
|
|
0, // iConfiguration
|
|
0x80, // bmAttributes
|
|
250, // bMaxPower
|
|
};
|
|
|
|
#define USB_DESCS ((volatile USBD_descriptor*)0x40006000)
|
|
#define USB_EP0_OUT(offs) (*(volatile uint32_t *)(0x40006020 + 2 * (offs)))
|
|
#define USB_EP0_IN(offs) (*(volatile uint32_t *)(0x40006030 + 2 * (offs)))
|
|
#define USB_EP1_OUT(offs) (*(volatile uint32_t *)(0x40006040 + 2 * (offs)))
|
|
#define USB_EP1_IN(offs) (*(volatile uint32_t *)(0x400060C0 + 2 * (offs)))
|
|
|
|
#define R32_RCC_CTLR (*(volatile uint32_t*)0x40021000)
|
|
#define R32_RCC_CFGR0 (*(volatile uint32_t*)0x40021004)
|
|
#define R32_RCC_APB2PCENR (*(volatile uint32_t*)0x40021018)
|
|
#define R32_RCC_APB1PCENR (*(volatile uint32_t*)0x4002101C)
|
|
#define R32_GPIOA_CFGLR (*(volatile uint32_t*)0x40010800)
|
|
#define R32_GPIOA_CFGHR (*(volatile uint32_t*)0x40010804)
|
|
#define R32_GPIOA_BSHR (*(volatile uint32_t*)0x40010810)
|
|
|
|
#define R16_USBD_EPR(n) (*(volatile uint16_t*)(0x40005C00 + 4 * (n)))
|
|
#define R16_USBD_CNTR (*(volatile uint16_t*)0x40005C40)
|
|
#define R16_USBD_ISTR (*(volatile uint16_t*)0x40005C44)
|
|
#define R16_USBD_DADDR (*(volatile uint16_t*)0x40005C4C)
|
|
|
|
#define R32_EXTEN_CTR (*(volatile uint32_t*)0x40023800)
|
|
|
|
// state[7:0] = addr
|
|
#define STATE_SET_ADDR 0x00
|
|
// state[15:8] = byte pos
|
|
// state[7:0] = bytes left
|
|
#define STATE_GET_DEV_DESC 0x01
|
|
#define STATE_GET_CONF_DESC 0x02
|
|
#define STATE_CTRL_STATUS_OUT 0x03
|
|
|
|
int main(void) {
|
|
// PLL setup: system clock 96 MHz
|
|
R32_EXTEN_CTR |= (1 << 4); // sneaky div2
|
|
R32_RCC_CFGR0 = (R32_RCC_CFGR0 & ~0xff0000) | (0b01101000 << 16);
|
|
R32_RCC_CTLR |= (1 << 24);
|
|
while (!(R32_RCC_CTLR & (1 << 25))) {}
|
|
R32_RCC_CFGR0 = (R32_RCC_CFGR0 & ~0b11) | 0b10;
|
|
while ((R32_RCC_CFGR0 & 0b1100) != 0b1000) {}
|
|
|
|
// As recommended in the manual, output low on these pins before enabling USB
|
|
R32_RCC_APB2PCENR |= (1 << 2);
|
|
R32_GPIOA_CFGHR = (R32_GPIOA_CFGHR & ~(0xff << 12)) | (0b00100010 << 12);
|
|
R32_GPIOA_BSHR = (1 << 27) | (1 << 28);
|
|
|
|
// Enable USB
|
|
R32_RCC_APB1PCENR |= (1 << 23);
|
|
R16_USBD_CNTR &= ~(1 << 1);
|
|
USB_DESCS[0].addr_tx = 0x30 / 2;
|
|
USB_DESCS[0].addr_rx = 0x20 / 2;
|
|
USB_DESCS[0].count_rx = (8 << 10);
|
|
USB_DESCS[1].addr_tx = 0xc0 / 2;
|
|
USB_DESCS[1].addr_rx = 0x40 / 2;
|
|
USB_DESCS[1].count_rx = (2 << 10) | (1 << 15);
|
|
// XXX because the table is at offset 0 don't bother writing this
|
|
|
|
// Attach USB
|
|
R16_USBD_CNTR &= ~(1 << 0);
|
|
R32_EXTEN_CTR |= (1 << 1);
|
|
|
|
uint32_t master_state = 0;
|
|
|
|
// R32_GPIOA_CFGLR = (R32_GPIOA_CFGLR & ~0xf) | (0b0010 << 0);
|
|
while (1) {
|
|
uint32_t usb_int_status = R16_USBD_ISTR;
|
|
if (usb_int_status & (1 << 10)) {
|
|
// RESET
|
|
// set all to STALL, SETUP will come in nonetheless
|
|
R16_USBD_EPR(0) = (0b01 << 12) | (0b01 << 9) | (0b01 << 4);
|
|
R16_USBD_DADDR = 0x80;
|
|
} else if (usb_int_status & (1 << 15)) {
|
|
if ((usb_int_status & 0x1f) == 0x10) {
|
|
uint32_t ep0_status = R16_USBD_EPR(0);
|
|
if (ep0_status & (1 << 11)) {
|
|
// setup, STAT_RX and STAT_TX both now NAK
|
|
uint16_t bRequest_bmRequestType = USB_EP0_OUT(0);
|
|
if (bRequest_bmRequestType == 0x0500) {
|
|
// SET_ADDRESS
|
|
master_state = (STATE_SET_ADDR << 24) | USB_EP0_OUT(2);
|
|
USB_DESCS[0].count_tx = 0;
|
|
R16_USBD_EPR(0) = (0b01 << 9) | (0b11 << 12) | (0b01 << 4); // STALL for OUT, ACK for IN
|
|
} else if (bRequest_bmRequestType == 0x0680) {
|
|
// GET_DESCRIPTOR
|
|
uint32_t wValue = USB_EP0_OUT(2);
|
|
if (wValue == 0x0100) {
|
|
for (int i = 0; i < 8; i+=2)
|
|
USB_EP0_IN(i) = *((uint16_t*)(&USB_DEV_DESC[i]));
|
|
uint32_t bytes = USB_EP0_OUT(6);
|
|
if (bytes < 8) {
|
|
USB_DESCS[0].count_tx = bytes;
|
|
master_state = (STATE_GET_DEV_DESC << 24);
|
|
} else {
|
|
USB_DESCS[0].count_tx = 8;
|
|
master_state = (STATE_GET_DEV_DESC << 24) | (8 << 8) | (bytes - 8);
|
|
}
|
|
R16_USBD_EPR(0) = (0b01 << 9) | (0b11 << 12) | (0b01 << 4); // STALL for OUT, ACK for IN
|
|
} else if (wValue == 0x0200) {
|
|
for (int i = 0; i < 8; i+=2)
|
|
USB_EP0_IN(i) = *((uint16_t*)(&USB_CONF_DESC[i]));
|
|
uint32_t bytes = USB_EP0_OUT(6);
|
|
if (bytes < 8) {
|
|
USB_DESCS[0].count_tx = bytes;
|
|
master_state = (STATE_GET_CONF_DESC << 24);
|
|
} else {
|
|
USB_DESCS[0].count_tx = 8;
|
|
master_state = (STATE_GET_CONF_DESC << 24) | (8 << 8) | (bytes - 8);
|
|
}
|
|
R16_USBD_EPR(0) = (0b01 << 9) | (0b11 << 12) | (0b01 << 4); // STALL for OUT, ACK for IN
|
|
} else {
|
|
// bad descriptor
|
|
R16_USBD_EPR(0) = (0b01 << 9) | (0b11 << 12) | (0b11 << 4); // STALL for both
|
|
}
|
|
} else {
|
|
// unknown
|
|
R16_USBD_EPR(0) = (0b01 << 9) | (0b11 << 12) | (0b11 << 4); // STALL for both
|
|
while (1) {}
|
|
}
|
|
} else {
|
|
switch (master_state >> 24) {
|
|
case STATE_CTRL_STATUS_OUT:
|
|
// go back to STALL for OUT
|
|
R16_USBD_EPR(0) = (0b01 << 9) | (0b11 << 12);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
if ((usb_int_status & 0x1f) == 0x00) {
|
|
switch (master_state >> 24) {
|
|
case STATE_SET_ADDR:
|
|
R16_USBD_DADDR = 0x80 | (master_state & 0x7f);
|
|
master_state = 0;
|
|
R16_USBD_EPR(0) = (0b01 << 9) | (0b11 << 4); // STALL if another IN
|
|
break;
|
|
case STATE_GET_DEV_DESC: {
|
|
uint32_t byte_pos = (master_state >> 8) & 0xff;
|
|
uint32_t bytes_left = master_state & 0xff;
|
|
if (bytes_left == 0) {
|
|
// ready for OUT status ACK, no more IN
|
|
master_state = (STATE_CTRL_STATUS_OUT << 24);
|
|
R16_USBD_EPR(0) = (0b01 << 9) | (0b10 << 12) | (1 << 8) | (0b11 << 4);
|
|
} else {
|
|
uint32_t bytes = bytes_left;
|
|
if (bytes > 8) bytes = 8;
|
|
if (byte_pos + bytes > sizeof(USB_DEV_DESC))
|
|
bytes = sizeof(USB_DEV_DESC) - byte_pos;
|
|
for (int i = 0; i < bytes; i+=2)
|
|
USB_EP0_IN(i) = *((uint16_t*)(&USB_DEV_DESC[byte_pos + i]));
|
|
if (bytes < 8) {
|
|
USB_DESCS[0].count_tx = bytes;
|
|
master_state = (STATE_GET_DEV_DESC << 24);
|
|
} else {
|
|
USB_DESCS[0].count_tx = 8;
|
|
master_state = (STATE_GET_DEV_DESC << 24) | ((byte_pos + 8) << 8) | (bytes_left - 8);
|
|
}
|
|
R16_USBD_EPR(0) = (0b01 << 9) | (0b01 << 4); // ACK for IN
|
|
}
|
|
}
|
|
break;
|
|
case STATE_GET_CONF_DESC: {
|
|
uint32_t byte_pos = (master_state >> 8) & 0xff;
|
|
uint32_t bytes_left = master_state & 0xff;
|
|
if (bytes_left == 0) {
|
|
// ready for OUT status ACK, no more IN
|
|
master_state = (STATE_CTRL_STATUS_OUT << 24);
|
|
R16_USBD_EPR(0) = (0b01 << 9) | (0b10 << 12) | (1 << 8) | (0b11 << 4);
|
|
} else {
|
|
uint32_t bytes = bytes_left;
|
|
if (bytes > 8) bytes = 8;
|
|
if (byte_pos + bytes > sizeof(USB_CONF_DESC))
|
|
bytes = sizeof(USB_CONF_DESC) - byte_pos;
|
|
for (int i = 0; i < bytes; i+=2)
|
|
USB_EP0_IN(i) = *((uint16_t*)(&USB_CONF_DESC[byte_pos + i]));
|
|
if (bytes < 8) {
|
|
USB_DESCS[0].count_tx = bytes;
|
|
master_state = (STATE_GET_CONF_DESC << 24);
|
|
} else {
|
|
USB_DESCS[0].count_tx = 8;
|
|
master_state = (STATE_GET_CONF_DESC << 24) | ((byte_pos + 8) << 8) | (bytes_left - 8);
|
|
}
|
|
R16_USBD_EPR(0) = (0b01 << 9) | (0b01 << 4); // ACK for IN
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
R16_USBD_ISTR = 0;
|
|
}
|
|
}
|