/****************************************************************************
* Standard kernel stuff
****************************************************************************/
void kernel_init(void)
{
/* Init the threading API */
init_threads();
/* Other processors will not reach this point in a multicore build.
* In a single-core build with multiple cores they fall-through and
* sleep in cop_main without returning. */
if (CURRENT_CORE == CPU)
{
memset(tick_funcs, 0, sizeof(tick_funcs));
memset(&all_queues, 0, sizeof(all_queues));
corelock_init(&all_queues.cl);
tick_start(1000/HZ);
#ifdef KDEV_INIT
kernel_device_init();
#endif
}
}
int main(void) {
GPIO_InitTypeDef GPIO_InitStructure;
SD_Error sderr;
SD_CardInfo ci;
// All GPIO clock enable
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA |
RCC_AHB1Periph_GPIOB |
RCC_AHB1Periph_GPIOC |
RCC_AHB1Periph_GPIOD |
RCC_AHB1Periph_GPIOE, ENABLE);
// Configure LEDs in output pushpull mode
GPIO_InitStructure.GPIO_Pin = LED_PIN_ALL;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz;
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_NOPULL;
GPIO_Init(LED_GPIO, &GPIO_InitStructure);
// Configure SysTick for 400ms period
if(!tick_start(400.0)) {
while(1);
}
/*
if((SD_Init() == SD_OK) && SD_Detect()){
sderr = SD_GetCardInfo(&ci);
if(sderr == SD_OK){
while(1);
}
}
*/
lsm303_init();
l3gd20_init();
while (1) {
tick_wait(1);
l3gd20_read_sync();
lsm303_read();
}
}
int main(void) {
if (DFU_AVAILABLE) {
DFU_maybe_jump_to_bootloader();
}
clock_setup();
tick_setup(1000);
gpio_setup();
led_num(0);
if (CDC_AVAILABLE) {
console_setup(DEFAULT_BAUDRATE);
}
if (SEMIHOSTING) {
initialise_monitor_handles();
}
else if (VCDC_AVAILABLE) {
retarget(STDOUT_FILENO, VIRTUAL_USART);
retarget(STDERR_FILENO, VIRTUAL_USART);
} else if (CDC_AVAILABLE) {
retarget(STDOUT_FILENO, CONSOLE_USART);
retarget(STDERR_FILENO, CONSOLE_USART);
}
led_num(1);
{
char serial[USB_SERIAL_NUM_LENGTH+1];
desig_get_unique_id_as_string(serial, USB_SERIAL_NUM_LENGTH+1);
cmp_set_usb_serial_number(serial);
}
usbd_device* usbd_dev = cmp_usb_setup();
DAP_app_setup(usbd_dev, &on_dfu_request);
if (CDC_AVAILABLE) {
cdc_uart_app_setup(usbd_dev, &on_usb_activity, &on_usb_activity);
}
if (VCDC_AVAILABLE) {
vcdc_app_setup(usbd_dev, &on_usb_activity, &on_usb_activity);
}
if (DFU_AVAILABLE) {
dfu_setup(usbd_dev, &on_dfu_request);
}
tick_start();
/* Enable the watchdog to enable DFU recovery from bad firmware images */
iwdg_set_period_ms(1000);
iwdg_start();
while (1) {
iwdg_reset();
usbd_poll(usbd_dev);
if (CDC_AVAILABLE) {
cdc_uart_app_update();
}
if (VCDC_AVAILABLE) {
vcdc_app_update();
}
// Handle DAP
bool dap_active = DAP_app_update();
if (dap_active) {
usb_timer = 1000;
} else if (do_reset_to_dfu && DFU_AVAILABLE) {
/* Blink 3 times to indicate reset */
int x;
for (x=0; x < 3; x++) {
iwdg_reset();
led_num(7);
wait_ms(150);
led_num(0);
wait_ms(150);
iwdg_reset();
}
DFU_reset_and_jump_to_bootloader();
}
if (usb_timer > 0) {
usb_timer--;
LED_ACTIVITY_OUT(1);
} else {
LED_ACTIVITY_OUT(0);
}
}
return 0;
}
