From 886643338edba982cb8f24dc51db237ff595608a Mon Sep 17 00:00:00 2001
From: john stone <john@tuxcode.org>
Date: Mon, 24 Sep 2012 19:11:00 +0200
Subject: [PATCH] start multimode testfw

---
 fw_test/main.c | 26 ++++++++++++++++++++++++--
 1 file changed, 24 insertions(+), 2 deletions(-)

diff --git a/fw_test/main.c b/fw_test/main.c
index ef81292..ddf33f6 100644
--- a/fw_test/main.c
+++ b/fw_test/main.c
@@ -75,11 +75,11 @@ void set_motor(int val){
 };
 
 
-void init_switch(){
+void init_switch(void){
 	return;
 };
 
-void blinkrattlebeep(){
+void blinkrattlebeep(void){
 	led_off(LED_L|LED_R);
 	_delay_ms(100);	
 	led_on(LED_L);
@@ -99,6 +99,28 @@ void blinkrattlebeep(){
 	buzzr_off();
 };
 
+void mode_motortest(void)
+{
+	set_motor(MOTOR_ON);
+	_delay_ms(400);
+	set_motor(MOTOR_OFF);
+	_delay_ms(500);
+	return;
+}
+
+
+void mode_blinktest(void)
+{
+	led_off(LED_L|LED_R);
+	_delay_ms(100);	
+	led_on(LED_L);
+	_delay_ms(100);	
+	led_off(LED_L);
+	led_on(LED_R);
+	_delay_ms(100);
+	led_off(LED_R);	
+	return
+}
 
 
 void __attribute__((noreturn))