GPXSee/src/igcparser.cpp

#include <cctype>
#include <cstring>
#include "igcparser.h"


static int str2int(const char *str, size_t len)
{
	int res = 0;

	for (const char *sp = str; sp < str + len; sp++) {
		if (::isdigit(*sp))
			res = res * 10 + *sp - '0';
		else
			return -1;
	}

	return res;
}

static bool readLat(const char *line, qreal &lat)
{
	int d = str2int(line + 7, 2);
	int mi = str2int(line + 9, 2);
	int mf = str2int(line + 11, 3);
	if (d < 0 || mi < 0 || mf < 0)
		return false;

	if (!(line[14] == 'N' || line[14] == 'S'))
		return false;

	lat = d + (((qreal)mi + (qreal)mf/1000) / 60);
	if (lat > 90)
		return false;

	if (line[14] == 'S')
		lat = -lat;

	return true;
}

static bool readLon(const char *line, qreal &lon)
{
	int d = str2int(line + 15, 3);
	int mi = str2int(line + 18, 2);
	int mf = str2int(line + 20, 3);
	if (d < 0 || mi < 0 || mf < 0)
		return false;

	if (!(line[23] == 'E' || line[23] == 'W'))
		return false;

	lon = d + (((qreal)mi + (qreal)mf/1000) / 60);
	if (lon > 180)
		return false;

	if (line[23] == 'W')
		lon = -lon;

	return true;
}

static bool readAltitude(const char *line, qreal &ele)
{
	int p;

	if (!(line[24] == 'A' || line[24] == 'V'))
		return false;

	if (line[25] == '-')
		p = str2int(line + 26, 4);
	else
		p = str2int(line + 25, 5);

	int g = str2int(line + 30, 5);
	if (p < 0 || g < 0)
		return false;

	if (line[24] == 'A')
		ele = (qreal)g;
	else
		ele = NAN;

	return true;
}

bool IGCParser::readDate(const char *line)
{
	int d = str2int(line + 5, 2);
	int m = str2int(line + 7, 2);
	int y = str2int(line + 9, 2);

	if (y < 0 || m < 0 || d < 0) {
		_errorString = "Invalid date";
		return false;
	}

	_date = QDate(2000 + y, m, d);

	return true;
}

bool IGCParser::readRecord(const char *line)
{
	qreal lat, lon, ele;
	QDateTime timestamp;


	if (_date.isNull()) {
		_errorString = "Date header missing";
		return false;
	}

	int h = str2int(line + 1, 2);
	int m = str2int(line + 3, 2);
	int s = str2int(line + 5, 2);

	if (h <0 || m < 0 || s < 0) {
		_errorString = "Invalid  timestamp";
		return false;
	}
	QTime time = QTime(h, m, s);
	if (time < _time)
		_date.addDays(1);
	_time = time;
	timestamp = QDateTime(_date, _time, Qt::UTC);

	if (!readLat(line, lat)) {
		_errorString = "Invalid latitude";
		return false;
	}
	if (!readLon(line, lon)) {
		_errorString = "Invalid longitude";
		return false;
	}

	if (!readAltitude(line, ele)) {
		_errorString = "Invalid altitude";
		return false;
	}

	Trackpoint t(Coordinates(lon, lat));
	t.setTimestamp(timestamp);
	t.setElevation(ele);
	_tracks.last().append(t);

	return true;
}

bool IGCParser::loadFile(QFile *file)
{
	qint64 len;
	char line[76 + 2 + 1 + 1];

	_errorLine = 1;
	_errorString.clear();

	_tracks.append(TrackData());
	_time = QTime(0, 0);

	// Read the initial A record
	if ((len = file->readLine(line, sizeof(line))) < 0) {
		_errorString = "I/O error";
		return false;
	} else {
		if (len < 9 || len > (qint64)sizeof(line) - 1 || line[0] != 'A') {
			_errorString = "Not a IGC file";
			return false;
		}
		for (int i = 1; i < 7; i++) {
			if (!::isprint(line[i])) {
				_errorString = "Not a IGC file";
				return false;
			}
		}
	}

	_errorLine++;

	// Read header (H) records and data (B) records
	while ((len = file->readLine(line, sizeof(line))) > 0) {
		if (len < 0) {
			_errorString = "I/O error";
			return false;
		}
		if (len > (qint64)sizeof(line) - 1) {
			_errorString = "Line limit exceeded";
			return false;
		}

		if (line[0] == 'B') {
			if (len > 35)
				if (!readRecord(line))
					return false;
		} else if (line[0] == 'H') {
			if (len > 10 && !::strncmp(line + 1, "FDTE", 4))
				if (!readDate(line))
					return false;
		}

		_errorLine++;
	}

	return true;
}