#include #include #include #include "consts.h" #include "errcatch.h" #include "halt.h" #include "modes.h" #include "orangutan_shim.h" w2_s_error g_w2_error_buffer[W2_ERROR_BUFFER_SIZE] = {}; uint8_t g_w2_error_index = 0; uint8_t g_w2_error_offset = 0; void w2_errcatch_main() { while (g_w2_error_index != g_w2_error_offset) { w2_s_error* error = &g_w2_error_buffer[g_w2_error_offset]; w2_errcatch_handle_error(error); free(error); g_w2_error_offset = (g_w2_error_offset + 1) % W2_ERROR_BUFFER_SIZE; } } w2_s_error *w2_alloc_error(enum w2_e_errorcodes code, uint16_t length, const char *message) { w2_s_error *error = calloc(sizeof(w2_s_error) + length, 1); memcpy(error, &(w2_s_error const){.code = code, .message_length = length}, sizeof(w2_s_error)); strncpy(error->message, message, length); return error; } void w2_errcatch_throw(enum w2_e_errorcodes code) { w2_errcatch_throw_msg(code, 0, ""); } void w2_errcatch_throw_msg(enum w2_e_errorcodes code, uint16_t length, const char *message) { w2_s_error error = *w2_alloc_error(code, length, message); g_w2_error_buffer[g_w2_error_index] = error; g_w2_error_index = (g_w2_error_index + 1) % W2_ERROR_BUFFER_SIZE; } void w2_errcatch_handle_error(w2_s_error* error) { uint8_t severity = error->code & W2_ERR_TYPE_MASK; // trigger emergency mode for critical errors if ((severity ^ W2_ERR_TYPE_CRIT) == 0) g_w2_current_mode = &w2_mode_halt; // TODO: handle more error types switch (error->code) { case W2_ERR_UNCAUGHT_ERROR: { break; } default: { w2_errcatch_throw(W2_ERR_UNCAUGHT_ERROR); #ifdef W2_SIM simwarn("Uncaught/unhandled error found with code 0x%02x", error->code); #endif } } // TODO: forward error to sercomm return; }