From 03dbe661312e9d2e3e379bcd455ddfabc48f95b6 Mon Sep 17 00:00:00 2001
From: Lars-Dominik Braun <lars@6xq.net>
Date: Wed, 5 Mar 2014 20:15:47 +0100
Subject: Remove delay, add error detection

---
 main.c | 18 +++++++++++++-----
 1 file changed, 13 insertions(+), 5 deletions(-)

(limited to 'main.c')

diff --git a/main.c b/main.c
index fa3b3c1..f017109 100644
--- a/main.c
+++ b/main.c
@@ -59,13 +59,21 @@ int main () {
 
 		sleepwhile (!gyroscopeRead ());
 		sleepwhile (twr.status == TWST_WAIT);
-
-		volatile const int16_t *val = gyroscopeGet ();
-		printf ("%i/%i/%i\n", val[0], val[1], val[2]);
-
-		_delay_ms (50);
+		switch (twr.status) {
+			case TWST_OK: {
+				volatile const int16_t *val = gyroscopeGet ();
+				printf ("%i/%i/%i\n", val[0], val[1], val[2]);
+				break;
+			}
+
+			case TWST_ERR:
+				goto fail;
+				break;
+		}
 	}
 	//timerStop ();
+fail:
+	printf ("fail\n");
 
 	/* global interrupt disable */
 	cli ();
-- 
cgit v1.2.3