From a7e72ad69cf309a78bf090cef3343ad1399ed488 Mon Sep 17 00:00:00 2001
From: Thammi <thammi@chaossource.net>
Date: Fri, 12 Oct 2012 00:50:30 +0200
Subject: [PATCH] Fix mode switch bug

---
 firmware/main.c | 2 +-
 1 file changed, 1 insertion(+), 1 deletion(-)

diff --git a/firmware/main.c b/firmware/main.c
index c1954c8..e23c8a9 100644
--- a/firmware/main.c
+++ b/firmware/main.c
@@ -34,7 +34,7 @@ void modeswitch_poll(void)
 {
 	if (btn_state(BTNST_LUP, BTN_LEFT)) {
 		//opmode --
-		NextMode = (OpMode -1) % mode_num;
+		NextMode = OpMode <= 0 ? mode_num - 1 : OpMode - 1;
 		button_clear(BTN_LEFT);
 	}
 	if (btn_state(BTNST_LUP, BTN_RIGHT)) {