From 3af237b5d6f6087d0d63338473edeab73691a63b Mon Sep 17 00:00:00 2001
From: Philip Heron <phil@sanslogic.co.uk>
Date: Sat, 7 Aug 2010 18:38:09 +0100
Subject: [PATCH] Add basic error reporting if the camera misbehaves

---
 hadie.c | 15 +++++++++++++--
 1 file changed, 13 insertions(+), 2 deletions(-)

diff --git a/hadie.c b/hadie.c
index 5bd975d..fe383d9 100644
--- a/hadie.c
+++ b/hadie.c
@@ -57,7 +57,12 @@ char tx_image(void)
 	{
 		uint16_t image_len;
 		
-		if(c3_open(SR_320x240) != 0) return(setup);
+		if(c3_open(SR_320x240) != 0)
+		{
+			rtx_string_P(PSTR(PREFIX CALLSIGN ":Camera error\n"));
+			return(setup);
+		}
+		
 		setup = -1;
 		pkt_id = 0;
 		img_id++;
@@ -71,7 +76,13 @@ char tx_image(void)
 	/* Initialise the packet */
 	init_packet(pkt, img_id, pkt_id++, image_pkts, 320, 240);
 	
-	c3_read(&pkt[PKT_SIZE_HEADER], PKT_SIZE_PAYLOAD);
+	if(c3_read(&pkt[PKT_SIZE_HEADER], PKT_SIZE_PAYLOAD) == 0)
+	{
+		rtx_string_P(PSTR(PREFIX CALLSIGN ":Error reading from camera\n"));
+		c3_close();
+		setup = 0;
+		return(setup);
+	}
 	
 	if(c3_eof())
 	{