/* 
 * libdivecomputer
 * 
 * Copyright (C) 2008 Jef Driesen
 * 
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 * 
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 * 
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
 * MA 02110-1301 USA
 */

#include <assert.h>
#include <string.h>

#include "suunto_common.h"
#include "ringbuffer.h"


device_status_t
suunto_common_extract_dives (const unsigned char data[], unsigned int begin, unsigned int end, unsigned int eop, unsigned int peek, dive_callback_t callback, void *userdata)
{
	assert (eop >= begin && eop < end);
	assert (data[eop] == 0x82);

	unsigned char buffer[0x2000 - 0x4C] = {0};
	assert (sizeof (buffer) >= end - begin);

	unsigned int current = eop;
	unsigned int previous = eop;
	for (unsigned int i = 0; i < end - begin; ++i) {
		// Move backwards through the ringbuffer.
		if (current == begin)
			current = end;
		current--;

		// Check for an end of profile marker.
		if (data[current] == 0x82)
			break;

		// Check for an end of dive marker (of the next dive),
		// to find the start of the current dive.
		unsigned int index = ringbuffer_decrement (current, peek, begin, end);
		if (data[index] == 0x80) {
			unsigned int len = ringbuffer_distance (current, previous, begin, end);
			if (current + len > end) {
				unsigned int a = end - current;
				unsigned int b = (current + len) - end;
				memcpy (buffer + 0, data + current, a);
				memcpy (buffer + a, data + begin,   b);
			} else {
				memcpy (buffer, data + current, len);
			}

			if (callback && !callback (buffer, len, userdata))
				return DEVICE_STATUS_SUCCESS;

			previous = current;
		}
	}

	assert (data[current] == 0x82);

	return DEVICE_STATUS_SUCCESS;
}