Test of ADC (+ lots of unrelated code)
This commit is contained in:
parent
25422326fe
commit
614369f83b
1 changed files with 585 additions and 0 deletions
585
src/analog-test/test.c
Normal file
585
src/analog-test/test.c
Normal file
|
|
@ -0,0 +1,585 @@
|
||||||
|
/*
|
||||||
|
* USB-RS485 Switch -- Hardware Testing
|
||||||
|
*
|
||||||
|
* (c) 2022 Martin Mareš <mj@ucw.cz>
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "util.h"
|
||||||
|
|
||||||
|
#include <libopencm3/cm3/cortex.h>
|
||||||
|
#include <libopencm3/cm3/nvic.h>
|
||||||
|
#include <libopencm3/cm3/systick.h>
|
||||||
|
#include <libopencm3/cm3/scb.h>
|
||||||
|
#include <libopencm3/stm32/adc.h>
|
||||||
|
#include <libopencm3/stm32/gpio.h>
|
||||||
|
#include <libopencm3/stm32/rcc.h>
|
||||||
|
#include <libopencm3/stm32/spi.h>
|
||||||
|
#include <libopencm3/stm32/timer.h>
|
||||||
|
#include <libopencm3/stm32/usart.h>
|
||||||
|
#include <libopencm3/usb/dfu.h>
|
||||||
|
#include <libopencm3/usb/usbd.h>
|
||||||
|
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
/*** Hardware init ***/
|
||||||
|
|
||||||
|
static void clock_init(void)
|
||||||
|
{
|
||||||
|
rcc_clock_setup_pll(&rcc_hse_configs[RCC_CLOCK_HSE8_72MHZ]);
|
||||||
|
|
||||||
|
rcc_periph_clock_enable(RCC_GPIOA);
|
||||||
|
rcc_periph_clock_enable(RCC_GPIOB);
|
||||||
|
rcc_periph_clock_enable(RCC_GPIOC);
|
||||||
|
rcc_periph_clock_enable(RCC_USART1);
|
||||||
|
rcc_periph_clock_enable(RCC_USART2);
|
||||||
|
rcc_periph_clock_enable(RCC_USART3);
|
||||||
|
rcc_periph_clock_enable(RCC_SPI2);
|
||||||
|
// rcc_periph_clock_enable(RCC_TIM4);
|
||||||
|
rcc_periph_clock_enable(RCC_ADC1);
|
||||||
|
rcc_periph_clock_enable(RCC_AFIO);
|
||||||
|
|
||||||
|
rcc_periph_reset_pulse(RST_GPIOA);
|
||||||
|
rcc_periph_reset_pulse(RST_GPIOB);
|
||||||
|
rcc_periph_reset_pulse(RST_GPIOC);
|
||||||
|
rcc_periph_reset_pulse(RST_USART1);
|
||||||
|
rcc_periph_reset_pulse(RST_USART2);
|
||||||
|
rcc_periph_reset_pulse(RST_USART3);
|
||||||
|
rcc_periph_reset_pulse(RST_SPI2);
|
||||||
|
// rcc_periph_reset_pulse(RST_TIM4);
|
||||||
|
rcc_periph_reset_pulse(RST_ADC1);
|
||||||
|
rcc_periph_reset_pulse(RST_AFIO);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void gpio_init(void)
|
||||||
|
{
|
||||||
|
// PA0 = VCC sense -> ADC12_IN0
|
||||||
|
// PA1 = 5V sense -> ADC12_IN1
|
||||||
|
// PA2 = TXD2 (debug)
|
||||||
|
// PA3 = RXD2
|
||||||
|
// PA4 = SPI1_SS* (jumpers)
|
||||||
|
// PA5 = SPI1_SCK
|
||||||
|
// PA6 = SPI1_MISO
|
||||||
|
// PA7 = SPI1_MOSI
|
||||||
|
// PA8 = SPI2_OE*
|
||||||
|
// PA9 = TXD1
|
||||||
|
// PA10 = RXD1
|
||||||
|
// PA11 = USB_DN
|
||||||
|
// PA12 = USB_DP
|
||||||
|
// PA13 + PA14 = programming interface
|
||||||
|
// PA15 = GPIO3
|
||||||
|
|
||||||
|
// PB0 = GPIO0 = ADuM4160 PIN (USB upstream enable)
|
||||||
|
// PB1 = I_SENSE -> ADC12_IN9
|
||||||
|
// PB2 = unused
|
||||||
|
// PB3 = I_SEN_A
|
||||||
|
// PB4 = I_SEN_B
|
||||||
|
// PB5 = I_SEN_C
|
||||||
|
// PB6 = I2C1_SCL
|
||||||
|
// PB7 = I2C1_SDA
|
||||||
|
// PB8 = GPIO1
|
||||||
|
// PB9 = GPIO2
|
||||||
|
// PB10 = TXD3
|
||||||
|
// PB11 = RXD3
|
||||||
|
// PB12 = SPI2_STROBE
|
||||||
|
// PB13 = SPI2_SCK
|
||||||
|
// PB14 = SPI2_MISO
|
||||||
|
// PB15 = SPI2_MOSI
|
||||||
|
|
||||||
|
// PC13 = debugging LED *
|
||||||
|
// PC14 = unused
|
||||||
|
// PC15 = unused
|
||||||
|
|
||||||
|
// Switch JTAG off to free up pins
|
||||||
|
gpio_primary_remap(AFIO_MAPR_SWJ_CFG_JTAG_OFF_SW_ON, 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void debug_init(void)
|
||||||
|
{
|
||||||
|
// PC13 = debugging LED à la BluePill
|
||||||
|
gpio_set_mode(GPIOC, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_PUSHPULL, GPIO13);
|
||||||
|
gpio_clear(GPIOC, GPIO13);
|
||||||
|
|
||||||
|
// USART2: Debugging console
|
||||||
|
// PA2 = TXD2
|
||||||
|
// PA3 = RXD2
|
||||||
|
gpio_set_mode(GPIOA, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_ALTFN_PUSHPULL, GPIO2);
|
||||||
|
gpio_set_mode(GPIOA, GPIO_MODE_INPUT, GPIO_CNF_INPUT_FLOAT, GPIO3);
|
||||||
|
|
||||||
|
usart_set_baudrate(USART2, 115200);
|
||||||
|
usart_set_databits(USART2, 8);
|
||||||
|
usart_set_stopbits(USART2, USART_STOPBITS_1);
|
||||||
|
usart_set_mode(USART2, USART_MODE_TX_RX);
|
||||||
|
usart_set_parity(USART2, USART_PARITY_NONE);
|
||||||
|
usart_set_flow_control(USART2, USART_FLOWCONTROL_NONE);
|
||||||
|
|
||||||
|
usart_enable(USART2);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*** System ticks ***/
|
||||||
|
|
||||||
|
static volatile u32 ms_ticks;
|
||||||
|
|
||||||
|
void sys_tick_handler(void)
|
||||||
|
{
|
||||||
|
ms_ticks++;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void tick_init(void)
|
||||||
|
{
|
||||||
|
systick_set_frequency(1000, CPU_CLOCK_MHZ * 1000000);
|
||||||
|
systick_counter_enable();
|
||||||
|
systick_interrupt_enable();
|
||||||
|
}
|
||||||
|
|
||||||
|
static void delay_ms(uint ms)
|
||||||
|
{
|
||||||
|
u32 start_ticks = ms_ticks;
|
||||||
|
while (ms_ticks - start_ticks < ms)
|
||||||
|
;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*** Shift registers ***/
|
||||||
|
|
||||||
|
static void reg_init(void)
|
||||||
|
{
|
||||||
|
// Pins: PA8=OE*, PB12=STROBE, PB13=SCK, PB14=MISO, PB15=MOSI
|
||||||
|
gpio_set_mode(GPIOA, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_PUSHPULL, GPIO8);
|
||||||
|
gpio_set_mode(GPIOB, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_PUSHPULL, GPIO12);
|
||||||
|
gpio_set_mode(GPIOB, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_ALTFN_PUSHPULL, GPIO13 | GPIO15);
|
||||||
|
gpio_set_mode(GPIOB, GPIO_MODE_INPUT, GPIO_CNF_INPUT_FLOAT, GPIO14);
|
||||||
|
|
||||||
|
gpio_set(GPIOA, GPIO8);
|
||||||
|
gpio_clear(GPIOB, GPIO12);
|
||||||
|
|
||||||
|
spi_reset(SPI2);
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Set up SPI in Master mode with:
|
||||||
|
*
|
||||||
|
* - baud rate: 1/64 of peripheral clock frequency
|
||||||
|
* - clock polarity: idle high
|
||||||
|
* - clock phase: data valid on 2nd clock pulse
|
||||||
|
* - data frame format: 8-bit, MSB first
|
||||||
|
*/
|
||||||
|
spi_init_master(SPI2, SPI_CR1_BAUDRATE_FPCLK_DIV_64, SPI_CR1_CPOL_CLK_TO_1_WHEN_IDLE,
|
||||||
|
SPI_CR1_CPHA_CLK_TRANSITION_2, SPI_CR1_DFF_8BIT, SPI_CR1_MSBFIRST);
|
||||||
|
|
||||||
|
// NSS will be managed by software and always held high
|
||||||
|
spi_enable_software_slave_management(SPI2);
|
||||||
|
spi_set_nss_high(SPI2);
|
||||||
|
|
||||||
|
spi_enable(SPI2);
|
||||||
|
}
|
||||||
|
|
||||||
|
static byte reg_state[4] = { 0x88, 0x88, 0x88, 0x88 };
|
||||||
|
|
||||||
|
static void reg_send(void)
|
||||||
|
{
|
||||||
|
for (byte i=0; i<4; i++)
|
||||||
|
spi_send(SPI2, reg_state[3-i]);
|
||||||
|
while (SPI_SR(SPI2) & SPI_SR_BSY)
|
||||||
|
;
|
||||||
|
gpio_set(GPIOB, GPIO12); // strobe
|
||||||
|
asm volatile ("nop; nop; nop; nop"); // just to be sure
|
||||||
|
gpio_clear(GPIOB, GPIO12);
|
||||||
|
gpio_clear(GPIOA, GPIO8); // OE*
|
||||||
|
}
|
||||||
|
|
||||||
|
enum reg_flags {
|
||||||
|
SF_RXEN_N = 8,
|
||||||
|
SF_TXEN = 4,
|
||||||
|
SF_PWREN = 2,
|
||||||
|
SF_LED = 1,
|
||||||
|
};
|
||||||
|
|
||||||
|
static void reg_set_flag(uint port, uint flag)
|
||||||
|
{
|
||||||
|
reg_state[port/2] |= (port & 1) ? flag : (flag << 4);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void reg_clear_flag(uint port, uint flag)
|
||||||
|
{
|
||||||
|
reg_state[port/2] &= ~((port & 1) ? flag : (flag << 4));
|
||||||
|
}
|
||||||
|
|
||||||
|
static void reg_toggle_flag(uint port, uint flag)
|
||||||
|
{
|
||||||
|
reg_state[port/2] ^= (port & 1) ? flag : (flag << 4);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*** ADC ***/
|
||||||
|
|
||||||
|
static void adc_init(void)
|
||||||
|
{
|
||||||
|
// PA0, PA1 and PB1 are analog inputs
|
||||||
|
gpio_set_mode(GPIOA, GPIO_MODE_INPUT, GPIO_CNF_INPUT_ANALOG, GPIO0 | GPIO1);
|
||||||
|
gpio_set_mode(GPIOB, GPIO_MODE_INPUT, GPIO_CNF_INPUT_ANALOG, GPIO1);
|
||||||
|
|
||||||
|
// PB3 to PB5 control the analog multiplexer on PB1
|
||||||
|
gpio_set_mode(GPIOB, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_PUSHPULL, GPIO3 | GPIO4 | GPIO5);
|
||||||
|
|
||||||
|
adc_power_off(ADC1);
|
||||||
|
// ADC prescaler set by rcc_clock_setup_pll(): ADC clock = PCLK2/8 = 9 MHz
|
||||||
|
rcc_set_adcpre(RCC_CFGR_ADCPRE_PCLK2_DIV8);
|
||||||
|
adc_disable_scan_mode(ADC1);
|
||||||
|
adc_set_single_conversion_mode(ADC1);
|
||||||
|
adc_set_sample_time(ADC1, ADC_CHANNEL0, ADC_SMPR_SMP_239DOT5CYC);
|
||||||
|
adc_set_sample_time(ADC1, ADC_CHANNEL1, ADC_SMPR_SMP_239DOT5CYC);
|
||||||
|
adc_set_sample_time(ADC1, ADC_CHANNEL9, ADC_SMPR_SMP_239DOT5CYC);
|
||||||
|
adc_set_sample_time(ADC1, ADC_CHANNEL16, ADC_SMPR_SMP_239DOT5CYC);
|
||||||
|
adc_set_sample_time(ADC1, ADC_CHANNEL17, ADC_SMPR_SMP_239DOT5CYC);
|
||||||
|
adc_enable_external_trigger_regular(ADC1, ADC_CR2_EXTSEL_SWSTART);
|
||||||
|
adc_enable_temperature_sensor();
|
||||||
|
adc_power_on(ADC1);
|
||||||
|
adc_reset_calibration(ADC1);
|
||||||
|
adc_calibrate(ADC1);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void adc_test(void)
|
||||||
|
{
|
||||||
|
for (int i=0; i<4; i++) {
|
||||||
|
uint j=0;
|
||||||
|
switch (i) {
|
||||||
|
case 0:
|
||||||
|
j = ADC_CHANNEL0;
|
||||||
|
break;
|
||||||
|
case 1:
|
||||||
|
j = ADC_CHANNEL1;
|
||||||
|
break;
|
||||||
|
case 2:
|
||||||
|
j = ADC_CHANNEL16;
|
||||||
|
break;
|
||||||
|
case 3:
|
||||||
|
j = ADC_CHANNEL17;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t channels[] = { j };
|
||||||
|
adc_set_regular_sequence(ADC1, 1, channels);
|
||||||
|
|
||||||
|
adc_start_conversion_regular(ADC1);
|
||||||
|
|
||||||
|
while (! adc_eoc(ADC1));
|
||||||
|
uint reg16 = adc_read_regular(ADC1);
|
||||||
|
debug_printf("ADC %d = %d\n", i, reg16);
|
||||||
|
}
|
||||||
|
|
||||||
|
for (int i=0; i<8; i++) {
|
||||||
|
gpio_clear(GPIOB, GPIO3 | GPIO4 | GPIO5);
|
||||||
|
gpio_set(GPIOB, i << 3);
|
||||||
|
delay_ms(5);
|
||||||
|
|
||||||
|
uint8_t channels[] = { ADC_CHANNEL9 };
|
||||||
|
adc_set_regular_sequence(ADC1, 1, channels);
|
||||||
|
|
||||||
|
adc_start_conversion_regular(ADC1);
|
||||||
|
|
||||||
|
while (! adc_eoc(ADC1));
|
||||||
|
uint reg16 = adc_read_regular(ADC1);
|
||||||
|
debug_printf("SENSE %d = %d\n", i, reg16);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/*** Loopback between ports 1 and 5 ***/
|
||||||
|
|
||||||
|
static void loop_init(void)
|
||||||
|
{
|
||||||
|
// USART1: Ports 1 to 4
|
||||||
|
// PA9 = TXD1
|
||||||
|
// PA10 = RXD1
|
||||||
|
gpio_set_mode(GPIOA, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_ALTFN_PUSHPULL, GPIO9);
|
||||||
|
gpio_set_mode(GPIOA, GPIO_MODE_INPUT, GPIO_CNF_INPUT_FLOAT, GPIO10);
|
||||||
|
|
||||||
|
usart_set_baudrate(USART1, 115200);
|
||||||
|
usart_set_databits(USART1, 8);
|
||||||
|
usart_set_stopbits(USART1, USART_STOPBITS_1);
|
||||||
|
usart_set_mode(USART1, USART_MODE_TX_RX);
|
||||||
|
usart_set_parity(USART1, USART_PARITY_NONE);
|
||||||
|
usart_set_flow_control(USART1, USART_FLOWCONTROL_NONE);
|
||||||
|
|
||||||
|
usart_enable(USART1);
|
||||||
|
|
||||||
|
// USART3: Ports 5 to 9
|
||||||
|
// PB10 = TXD3
|
||||||
|
// PB11 = RXD3
|
||||||
|
gpio_set_mode(GPIOB, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_ALTFN_PUSHPULL, GPIO10);
|
||||||
|
gpio_set_mode(GPIOB, GPIO_MODE_INPUT, GPIO_CNF_INPUT_FLOAT, GPIO11);
|
||||||
|
|
||||||
|
usart_set_baudrate(USART3, 115200);
|
||||||
|
usart_set_databits(USART3, 8);
|
||||||
|
usart_set_stopbits(USART3, USART_STOPBITS_1);
|
||||||
|
usart_set_mode(USART3, USART_MODE_TX_RX);
|
||||||
|
usart_set_parity(USART3, USART_PARITY_NONE);
|
||||||
|
usart_set_flow_control(USART3, USART_FLOWCONTROL_NONE);
|
||||||
|
|
||||||
|
usart_enable(USART3);
|
||||||
|
|
||||||
|
// Enable TX on port 1
|
||||||
|
reg_set_flag(0, SF_TXEN);
|
||||||
|
|
||||||
|
// Enable RX on port 5
|
||||||
|
reg_clear_flag(4, SF_RXEN_N);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void loop_recv(void)
|
||||||
|
{
|
||||||
|
if (usart_get_flag(USART3, USART_SR_RXNE)) {
|
||||||
|
uint ch = usart_recv(USART3);
|
||||||
|
debug_putc(ch);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void loop_send(uint ch)
|
||||||
|
{
|
||||||
|
usart_send_blocking(USART1, ch);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*** USB ***/
|
||||||
|
|
||||||
|
#define USB_RS485_USB_VENDOR 0x4242
|
||||||
|
#define USB_RS485_USB_PRODUCT 0x000b
|
||||||
|
#define USB_RS485_USB_VERSION 1
|
||||||
|
|
||||||
|
static usbd_device *usbd_dev;
|
||||||
|
|
||||||
|
enum usb_string {
|
||||||
|
STR_MANUFACTURER = 1,
|
||||||
|
STR_PRODUCT,
|
||||||
|
STR_SERIAL,
|
||||||
|
};
|
||||||
|
|
||||||
|
static char usb_serial_number[13];
|
||||||
|
|
||||||
|
static const char *usb_strings[] = {
|
||||||
|
"United Computer Wizards",
|
||||||
|
"USB-RS485 Switch",
|
||||||
|
usb_serial_number,
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct usb_device_descriptor device = {
|
||||||
|
.bLength = USB_DT_DEVICE_SIZE,
|
||||||
|
.bDescriptorType = USB_DT_DEVICE,
|
||||||
|
.bcdUSB = 0x0200,
|
||||||
|
.bDeviceClass = 0xFF,
|
||||||
|
.bDeviceSubClass = 0,
|
||||||
|
.bDeviceProtocol = 0,
|
||||||
|
.bMaxPacketSize0 = 64,
|
||||||
|
.idVendor = USB_RS485_USB_VENDOR,
|
||||||
|
.idProduct = USB_RS485_USB_PRODUCT,
|
||||||
|
.bcdDevice = USB_RS485_USB_VERSION,
|
||||||
|
.iManufacturer = STR_MANUFACTURER,
|
||||||
|
.iProduct = STR_PRODUCT,
|
||||||
|
.iSerialNumber = STR_SERIAL,
|
||||||
|
.bNumConfigurations = 1,
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct usb_endpoint_descriptor endpoints[] = {{
|
||||||
|
// Bulk end-point for sending LED values
|
||||||
|
.bLength = USB_DT_ENDPOINT_SIZE,
|
||||||
|
.bDescriptorType = USB_DT_ENDPOINT,
|
||||||
|
.bEndpointAddress = 0x01,
|
||||||
|
.bmAttributes = USB_ENDPOINT_ATTR_BULK,
|
||||||
|
.wMaxPacketSize = 64,
|
||||||
|
.bInterval = 1,
|
||||||
|
}};
|
||||||
|
|
||||||
|
static const struct usb_interface_descriptor iface = {
|
||||||
|
.bLength = USB_DT_INTERFACE_SIZE,
|
||||||
|
.bDescriptorType = USB_DT_INTERFACE,
|
||||||
|
.bInterfaceNumber = 0,
|
||||||
|
.bAlternateSetting = 0,
|
||||||
|
.bNumEndpoints = 1,
|
||||||
|
.bInterfaceClass = 0xFF,
|
||||||
|
.bInterfaceSubClass = 0,
|
||||||
|
.bInterfaceProtocol = 0,
|
||||||
|
.iInterface = 0,
|
||||||
|
.endpoint = endpoints,
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct usb_dfu_descriptor dfu_function = {
|
||||||
|
.bLength = sizeof(struct usb_dfu_descriptor),
|
||||||
|
.bDescriptorType = DFU_FUNCTIONAL,
|
||||||
|
.bmAttributes = USB_DFU_CAN_DOWNLOAD | USB_DFU_WILL_DETACH,
|
||||||
|
.wDetachTimeout = 255,
|
||||||
|
.wTransferSize = 1024,
|
||||||
|
.bcdDFUVersion = 0x0100,
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct usb_interface_descriptor dfu_iface = {
|
||||||
|
.bLength = USB_DT_INTERFACE_SIZE,
|
||||||
|
.bDescriptorType = USB_DT_INTERFACE,
|
||||||
|
.bInterfaceNumber = 1,
|
||||||
|
.bAlternateSetting = 0,
|
||||||
|
.bNumEndpoints = 0,
|
||||||
|
.bInterfaceClass = 0xFE,
|
||||||
|
.bInterfaceSubClass = 1,
|
||||||
|
.bInterfaceProtocol = 1,
|
||||||
|
.iInterface = 0,
|
||||||
|
|
||||||
|
.extra = &dfu_function,
|
||||||
|
.extralen = sizeof(dfu_function),
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct usb_interface ifaces[] = {{
|
||||||
|
.num_altsetting = 1,
|
||||||
|
.altsetting = &iface,
|
||||||
|
}, {
|
||||||
|
.num_altsetting = 1,
|
||||||
|
.altsetting = &dfu_iface,
|
||||||
|
}};
|
||||||
|
|
||||||
|
static const struct usb_config_descriptor config = {
|
||||||
|
.bLength = USB_DT_CONFIGURATION_SIZE,
|
||||||
|
.bDescriptorType = USB_DT_CONFIGURATION,
|
||||||
|
.wTotalLength = 0,
|
||||||
|
.bNumInterfaces = 2,
|
||||||
|
.bConfigurationValue = 1,
|
||||||
|
.iConfiguration = 0,
|
||||||
|
.bmAttributes = 0x80,
|
||||||
|
.bMaxPower = 100, // multiplied by 2 mA
|
||||||
|
.interface = ifaces,
|
||||||
|
};
|
||||||
|
|
||||||
|
static byte usb_configured;
|
||||||
|
static uint8_t usbd_control_buffer[64];
|
||||||
|
|
||||||
|
static void dfu_detach_complete(usbd_device *dev UNUSED, struct usb_setup_data *req UNUSED)
|
||||||
|
{
|
||||||
|
// Reset to bootloader, which implements the rest of DFU
|
||||||
|
debug_printf("Switching to DFU\n");
|
||||||
|
debug_flush();
|
||||||
|
scb_reset_core();
|
||||||
|
}
|
||||||
|
|
||||||
|
static enum usbd_request_return_codes dfu_control_cb(usbd_device *dev UNUSED,
|
||||||
|
struct usb_setup_data *req,
|
||||||
|
uint8_t **buf UNUSED,
|
||||||
|
uint16_t *len UNUSED,
|
||||||
|
void (**complete)(usbd_device *dev, struct usb_setup_data *req))
|
||||||
|
{
|
||||||
|
if (req->bmRequestType != 0x21 || req->bRequest != DFU_DETACH)
|
||||||
|
return USBD_REQ_NOTSUPP;
|
||||||
|
|
||||||
|
*complete = dfu_detach_complete;
|
||||||
|
return USBD_REQ_HANDLED;
|
||||||
|
}
|
||||||
|
|
||||||
|
static byte usb_rx_buf[64];
|
||||||
|
|
||||||
|
static void ep01_cb(usbd_device *dev, uint8_t ep UNUSED)
|
||||||
|
{
|
||||||
|
// We received a frame from the USB host
|
||||||
|
uint len = usbd_ep_read_packet(dev, 0x01, usb_rx_buf, sizeof(usb_rx_buf));
|
||||||
|
debug_printf("USB: Host sent %u bytes\n", len);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void set_config_cb(usbd_device *dev, uint16_t wValue UNUSED)
|
||||||
|
{
|
||||||
|
usbd_register_control_callback(
|
||||||
|
dev,
|
||||||
|
USB_REQ_TYPE_CLASS | USB_REQ_TYPE_INTERFACE,
|
||||||
|
USB_REQ_TYPE_TYPE | USB_REQ_TYPE_RECIPIENT,
|
||||||
|
dfu_control_cb);
|
||||||
|
usbd_ep_setup(dev, 0x01, USB_ENDPOINT_ATTR_BULK, 64, ep01_cb);
|
||||||
|
usb_configured = 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void reset_cb(void)
|
||||||
|
{
|
||||||
|
debug_printf("USB: Reset\n");
|
||||||
|
usb_configured = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static volatile bool usb_event_pending;
|
||||||
|
|
||||||
|
void usb_lp_can_rx0_isr(void)
|
||||||
|
{
|
||||||
|
/*
|
||||||
|
* We handle USB in the main loop to avoid race conditions between
|
||||||
|
* USB interrupts and other code. However, we need an interrupt to
|
||||||
|
* up the main loop from sleep.
|
||||||
|
*
|
||||||
|
* We set up only the low-priority ISR, because high-priority ISR handles
|
||||||
|
* only double-buffered bulk transfers and isochronous transfers.
|
||||||
|
*/
|
||||||
|
nvic_disable_irq(NVIC_USB_LP_CAN_RX0_IRQ);
|
||||||
|
usb_event_pending = 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void usb_init(void)
|
||||||
|
{
|
||||||
|
// Simulate USB disconnect
|
||||||
|
gpio_set_mode(GPIOB, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_PUSHPULL, GPIO0);
|
||||||
|
gpio_clear(GPIOB, GPIO0);
|
||||||
|
delay_ms(100);
|
||||||
|
gpio_set(GPIOB, GPIO0);
|
||||||
|
|
||||||
|
usbd_dev = usbd_init(
|
||||||
|
&st_usbfs_v1_usb_driver,
|
||||||
|
&device,
|
||||||
|
&config,
|
||||||
|
usb_strings,
|
||||||
|
ARRAY_SIZE(usb_strings),
|
||||||
|
usbd_control_buffer,
|
||||||
|
sizeof(usbd_control_buffer)
|
||||||
|
);
|
||||||
|
usbd_register_reset_callback(usbd_dev, reset_cb);
|
||||||
|
usbd_register_set_config_callback(usbd_dev, set_config_cb);
|
||||||
|
usb_event_pending = 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
/*** Main ***/
|
||||||
|
|
||||||
|
int main(void)
|
||||||
|
{
|
||||||
|
clock_init();
|
||||||
|
gpio_init();
|
||||||
|
debug_init();
|
||||||
|
reg_init();
|
||||||
|
tick_init();
|
||||||
|
adc_init();
|
||||||
|
usb_init();
|
||||||
|
loop_init();
|
||||||
|
|
||||||
|
debug_printf("Lisak je lisak...\n");
|
||||||
|
|
||||||
|
byte t = 0;
|
||||||
|
u32 last_blink = 0;
|
||||||
|
|
||||||
|
for (;;) {
|
||||||
|
if (ms_ticks - last_blink >= 250) {
|
||||||
|
debug_led_toggle();
|
||||||
|
reg_clear_flag(t, SF_LED);
|
||||||
|
t = (t+1) & 7;
|
||||||
|
reg_set_flag(t, SF_LED);
|
||||||
|
reg_send();
|
||||||
|
last_blink = ms_ticks;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (usart_get_flag(USART2, USART_SR_RXNE)) {
|
||||||
|
uint ch = usart_recv(USART2);
|
||||||
|
debug_putc(ch);
|
||||||
|
if (ch >= '0' && ch <= '7') {
|
||||||
|
reg_toggle_flag(ch - '0', SF_PWREN);
|
||||||
|
reg_send();
|
||||||
|
} else if (ch == 'a') {
|
||||||
|
adc_test();
|
||||||
|
} else {
|
||||||
|
loop_send(ch);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
loop_recv();
|
||||||
|
|
||||||
|
if (usb_event_pending) {
|
||||||
|
usbd_poll(usbd_dev);
|
||||||
|
usb_event_pending = 0;
|
||||||
|
nvic_clear_pending_irq(NVIC_USB_LP_CAN_RX0_IRQ);
|
||||||
|
nvic_enable_irq(NVIC_USB_LP_CAN_RX0_IRQ);
|
||||||
|
}
|
||||||
|
|
||||||
|
wait_for_interrupt();
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
Loading…
Reference in a new issue