#include "general.h"
#include "platform.h"
#include "usb.h"
#include "aux_serial.h"
#include <libopencm3/stm32/rcc.h>
#include <libopencm3/cm3/scb.h>
#include <libopencm3/cm3/scs.h>
#include <libopencm3/cm3/nvic.h>
#include <libopencm3/stm32/usart.h>
#include <libopencm3/usb/usbd.h>
#include <libopencm3/stm32/adc.h>
#include "platform_common.h"
uint32_t led_error_port;
uint16_t led_error_pin;
static uint8_t rev;
static void adc_init(void);
int platform_hwversion(void)
{
return rev;
}
void platform_init(void)
{
uint32_t data;
SCS_DEMCR |= SCS_DEMCR_VC_MON_EN;
rcc_clock_setup_pll(&rcc_hse_configs[RCC_CLOCK_HSE8_72MHZ]);
rev = detect_rev();
rcc_periph_clock_enable(RCC_AFIO);
rcc_periph_clock_enable(RCC_CRC);
data = AFIO_MAPR;
data &= ~AFIO_MAPR_SWJ_MASK;
data |= AFIO_MAPR_SWJ_CFG_JTAG_OFF_SW_OFF;
AFIO_MAPR = data;
gpio_set_mode(TMS_PORT, GPIO_MODE_OUTPUT_2_MHZ, GPIO_CNF_INPUT_FLOAT, TMS_PIN);
gpio_set_mode(TCK_PORT, GPIO_MODE_OUTPUT_2_MHZ, GPIO_CNF_OUTPUT_PUSHPULL, TCK_PIN);
gpio_set_mode(TDI_PORT, GPIO_MODE_OUTPUT_2_MHZ, GPIO_CNF_OUTPUT_PUSHPULL, TDI_PIN);
gpio_set_mode(TDO_PORT, GPIO_MODE_INPUT, GPIO_CNF_INPUT_FLOAT, TDO_PIN);
switch (rev) {
case 0:
led_error_port = GPIOA;
led_error_pin = GPIO8;
adc_init();
break;
case 1:
led_error_port = GPIOC;
led_error_pin = GPIO13;
RCC_CFGR &= ~(0xfU << 24U);
RCC_CFGR |= (RCC_CFGR_MCO_HSE << 24U);
gpio_set_mode(GPIOA, GPIO_MODE_OUTPUT_50_MHZ, GPIO_CNF_OUTPUT_ALTFN_PUSHPULL, GPIO8);
break;
}
platform_nrst_set_val(false);
data = AFIO_MAPR;
data &= ~AFIO_MAPR_TIM2_REMAP_FULL_REMAP;
data |= AFIO_MAPR_TIM2_REMAP_PARTIAL_REMAP1;
AFIO_MAPR = data;
extern uint32_t vector_table;
SCB_VTOR = (uintptr_t)&vector_table;
platform_timing_init();
blackmagic_usb_init();
aux_serial_init();
}
void platform_nrst_set_val(bool assert)
{
if (assert) {
gpio_set_mode(TRST_PORT, GPIO_MODE_OUTPUT_2_MHZ, GPIO_CNF_OUTPUT_OPENDRAIN, TRST_PIN);
while (gpio_get(TRST_PORT, TRST_PIN))
gpio_clear(TRST_PORT, TRST_PIN);
} else {
gpio_set_mode(TRST_PORT, GPIO_MODE_INPUT, GPIO_CNF_INPUT_PULL_UPDOWN, TRST_PIN);
while (!gpio_get(TRST_PORT, TRST_PIN))
gpio_set(TRST_PORT, TRST_PIN);
}
}
bool platform_nrst_get_val(void)
{
return gpio_get(TRST_PORT, TRST_PIN) == 0;
}
static void adc_init(void)
{
rcc_periph_clock_enable(RCC_ADC1);
gpio_set_mode(GPIOA, GPIO_MODE_INPUT, GPIO_CNF_INPUT_ANALOG, GPIO0);
adc_power_off(ADC1);
adc_disable_scan_mode(ADC1);
adc_set_single_conversion_mode(ADC1);
adc_disable_external_trigger_regular(ADC1);
adc_set_right_aligned(ADC1);
adc_set_sample_time_on_all_channels(ADC1, ADC_SMPR_SMP_28DOT5CYC);
adc_power_on(ADC1);
for (volatile size_t i = 0; i < 800000U; ++i)
continue;
adc_reset_calibration(ADC1);
adc_calibrate(ADC1);
}
const char *platform_target_voltage(void)
{
static char ret[] = "0.0V";
const uint8_t channel = 0;
switch (rev) {
case 0:
adc_set_regular_sequence(ADC1, 1, (uint8_t *)&channel);
adc_start_conversion_direct(ADC1);
while (!adc_eoc(ADC1))
continue;
uint32_t value = (adc_read_regular(ADC1) * 66U) / 4096U;
ret[0] = '0' + value / 10U;
ret[2] = '0' + value % 10U;
return ret;
}
return NULL;
}
void set_idle_state(int state)
{
switch (rev) {
case 0:
gpio_set_val(GPIOA, GPIO8, state);
break;
case 1:
gpio_set_val(GPIOC, GPIO13, !state);
break;
}
}
void platform_target_clk_output_enable(bool enable)
{
(void)enable;
}
bool platform_spi_init(const spi_bus_e bus)
{
(void)bus;
return false;
}
bool platform_spi_deinit(const spi_bus_e bus)
{
(void)bus;
return false;
}
bool platform_spi_chip_select(const uint8_t device_select)
{
(void)device_select;
return false;
}
uint8_t platform_spi_xfer(const spi_bus_e bus, const uint8_t value)
{
(void)bus;
return value;
}