From 5b0810c324e4a8c286be21e9c847a1b0de099317 Mon Sep 17 00:00:00 2001
From: Jef Driesen <jefdriesen@users.sourceforge.net>
Date: Thu, 17 Apr 2008 08:04:04 +0000
Subject: [PATCH] Added a function to extract individual dives from the binary
 data.

---
 uwatec_smart.c | 30 ++++++++++++++++++++++++++++++
 uwatec_smart.h |  2 ++
 2 files changed, 32 insertions(+)

diff --git a/uwatec_smart.c b/uwatec_smart.c
index 0c53697..8c78efb 100644
--- a/uwatec_smart.c
+++ b/uwatec_smart.c
@@ -336,3 +336,33 @@ uwatec_smart_read (smart *device, unsigned char data[], unsigned int msize)
 
 	return UWATEC_SUCCESS;
 }
+
+
+int
+uwatec_smart_extract_dives (const unsigned char data[], unsigned int size, dive_callback_t callback, void *userdata)
+{
+	const unsigned char header[4] = {0xa5, 0xa5, 0x5a, 0x5a};
+
+	unsigned int offset = 0;
+	while (offset + 8 <= size) {
+		// Search for the header marker.
+		if (memcmp (data + offset, header, sizeof (header)) == 0) {
+			// Get the length of the profile data.
+			unsigned int len = data[offset + 4] + (data[offset + 5] << 8) + 
+							(data[offset + 6] << 16) + (data[offset + 7] << 24);
+
+			// Check for a buffer overflow.
+			if (offset + len > size)
+				return UWATEC_ERROR;
+
+			if (callback)
+				callback (data + offset, len, userdata);
+
+			offset += len;
+		} else {
+			offset++;
+		}
+	}
+
+	return UWATEC_SUCCESS;
+}
diff --git a/uwatec_smart.h b/uwatec_smart.h
index 32f01e6..cacc3ed 100644
--- a/uwatec_smart.h
+++ b/uwatec_smart.h
@@ -13,6 +13,8 @@ int uwatec_smart_close (smart *device);
 
 int uwatec_smart_read (smart *device, unsigned char data[], unsigned int size);
 
+int uwatec_smart_extract_dives (const unsigned char data[], unsigned int size, dive_callback_t callback, void *userdata);
+
 #ifdef __cplusplus
 }
 #endif /* __cplusplus */