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
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
|
#include <stdlib.h>
#include <string.h>
#include "errcatch.h"
#include "modes.h"
#include "orangutan_shim.h"
#include "sercomm.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;
uint8_t g_w2_error_buffer_full = 0;
uint8_t g_w2_error_uncaught = 0;
void w2_errcatch_main() {
while (g_w2_error_offset != g_w2_error_index) {
w2_s_error *error = g_w2_error_buffer[g_w2_error_offset];
w2_errcatch_handle_error(error);
g_w2_error_offset = (g_w2_error_offset + 1) % W2_ERROR_BUFFER_SIZE;
}
if (g_w2_error_buffer_full) {
w2_errcatch_throw(W2_E_WARN_ERR_BUFFER_FULL);
g_w2_error_buffer_full = 0;
}
if (g_w2_error_uncaught) {
w2_errcatch_throw(W2_E_WARN_UNCAUGHT_ERROR);
g_w2_error_uncaught = 0;
}
}
w2_s_error *w2_alloc_error(w2_e_errorcode code, uint16_t length, const char *message) {
w2_s_error *error = malloc(sizeof(w2_s_error) + length);
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(w2_e_errorcode code) { w2_errcatch_throw_msg(code, 0, ""); }
void w2_errcatch_throw_msg(w2_e_errorcode code, uint16_t length, const char *message) {
uint8_t next_index = (g_w2_error_index + 1) % W2_ERROR_BUFFER_SIZE;
g_w2_error_buffer_full = next_index == g_w2_error_offset;
free(g_w2_error_buffer[g_w2_error_index]);
w2_s_error *error = w2_alloc_error(code, length, message);
g_w2_error_buffer[g_w2_error_index] = error;
if (g_w2_error_buffer_full) return;
g_w2_error_index = next_index;
}
void w2_errcatch_handle_error(w2_s_error *error) {
uint8_t severity = error->code & W2_E_TYPE_MASK;
// trigger emergency mode for critical errors
if ((severity ^ W2_E_TYPE_CRIT) == 0) w2_modes_switch(W2_M_HALT);
// TODO: handle more error types
switch (error->code) {
case W2_E_WARN_UNCAUGHT_ERROR: {
break;
}
default: {
g_w2_error_uncaught = 1;
#ifdef W2_SIM
simwarn("Uncaught/unhandled error found with code 0x%02x\n", error->code);
#endif
}
}
// forward error to sercomm
size_t msg_size = sizeof(w2_s_cmd_expt_tx) + sizeof(uint8_t) * error->message_length;
w2_s_cmd_expt_tx *msg = malloc(msg_size);
msg->opcode = W2_CMD_EXPT | W2_CMDDIR_TX;
msg->error = error->code;
msg->length = error->message_length;
memcpy(msg->message, error->message, error->message_length);
w2_s_bin *msg_bin = w2_bin_s_alloc(msg_size, (uint8_t *)msg);
w2_sercomm_append_msg(msg_bin);
free(msg);
free(msg_bin);
return;
}
|