From 6b7b02596522b0db476dd64bb69e0e3825ce790d Mon Sep 17 00:00:00 2001 From: lonkaars Date: Sun, 26 Jun 2022 16:21:07 +0200 Subject: added error beeps and fix mode history IOB error --- robot/modes.c | 3 +-- 1 file changed, 1 insertion(+), 2 deletions(-) (limited to 'robot/modes.c') diff --git a/robot/modes.c b/robot/modes.c index a54bc43..d706c2f 100644 --- a/robot/modes.c +++ b/robot/modes.c @@ -30,8 +30,7 @@ void w2_modes_init() { void w2_modes_main() { (*g_w2_modes[g_w2_mode_history[g_w2_mode_history_index]])(); } void w2_modes_switch(w2_e_mode new_mode, bool replace) { - int16_t next_history_index = - g_w2_mode_history_index + (new_mode == W2_M_PREV ? -1 : 1) * (replace - 1); + int16_t next_history_index = g_w2_mode_history_index + (new_mode == W2_M_PREV ? -1 : 1) * !replace; if (next_history_index == -1 || next_history_index == W2_MODE_HISTORY_BUFFER_SIZE - 1) { next_history_index = W2_RANGE(0, next_history_index, W2_MODE_HISTORY_BUFFER_SIZE); w2_errcatch_throw(W2_E_WARN_MODE_HISTORY_BUFFER_IOB); -- cgit v1.2.3