int main() {
log_init();
// If bootloader mode not requested, go immediately to app.
if (!ShouldEnterBootloader()) {
OscCalibrateCached();
log_printf("Running app...");
__asm__("goto __APP_RESET");
}
// We need to enter bootloader mode, wait for the boot pin to be released.
while (!led_read());
// Now we can start!
led_init();
#ifdef SIGNAL_AFTER_BAD_RESET
if (RCON & 0b1100001001000000) {
SignalRcon();
}
#endif
log_printf("Hello from Bootloader!!!");
if (IsPin1Grounded()) {
log_printf("Erasing config.");
EraseConfig();
}
OscCalibrateCached();
Blink(5);
USBInitialize();
while (1) {
// Wait for connection
while (!(USBGetDeviceState() == CONFIGURED_STATE
&& CDCIsDtePresent())) USBTasks();
log_printf("Connected!");
BootProtocolInit();
while (USBGetDeviceState() == CONFIGURED_STATE && CDCIsDtePresent()) {
static char in_buf[64];
USBTasks();
BYTE size = getsUSBUSART(in_buf, sizeof(in_buf));
if (!BootProtocolProcess(in_buf, size)) {
log_printf("Protocol error. Will detach / re-attach.");
USBSoftDetach();
__delay_ms(2000);
USBDeviceAttach();
break;
}
BootProtocolTasks();
}
log_printf("Disconnected!");
}
return 0;
}
static void CDCTasks() {
DWORD size;
if (channel_state > CHANNEL_DETACHED
&& USBGetDeviceState() == DETACHED_STATE) {
// handle detach
if (channel_state >= CHANNEL_OPEN) {
callback(NULL, 1, callback_arg);
}
channel_state = CHANNEL_DETACHED;
} else if (channel_state > CHANNEL_WAIT_DTE
&& !CDCIsDtePresent()) {
// handle close
if (channel_state >= CHANNEL_OPEN) {
callback(NULL, 0, callback_arg);
}
channel_state = CHANNEL_WAIT_DTE;
}
switch (channel_state) {
case CHANNEL_DETACHED:
if (USBGetDeviceState() == CONFIGURED_STATE) {
channel_state = CHANNEL_WAIT_DTE;
}
break;
case CHANNEL_WAIT_DTE:
if (CDCIsDtePresent()) {
channel_state = CHANNEL_WAIT_OPEN;
}
break;
case CHANNEL_WAIT_OPEN:
break;
case CHANNEL_OPEN:
size = getsUSBUSART(rx_buf, rx_buf_size);
if (size) {
callback(rx_buf, size, callback_arg);
}
break;
}
}