1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
|
#include <stdlib.h>
#include <string.h>
#include <stdio.h>
#include "errcatch.h"
#include "modes.h"
#include "orangutan_shim.h"
#include "consts.h"
#include "halt.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_errcatch_handle_error(g_w2_error_buffer[g_w2_error_offset]);
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;
// go into emergency mode for critical errors
if ((severity ^ W2_ERR_TYPE_CRIT) == 0) g_w2_current_mode = &w2_mode_halt;
//TODO: forward error to sercomm
return;
}
|