/*
 * Copyright (C) Tildeslash Ltd. All rights reserved.
 *
 * This program is free software: you can redistribute it and/or modify
 * it under the terms of the GNU Affero General Public License version 3.
 *
 * This program 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 General Public License for more details.
 *
 * You should have received a copy of the GNU Affero General Public License
 * along with this program.  If not, see <http://www.gnu.org/licenses/>.
 *
 * In addition, as a special exception, the copyright holders give
 * permission to link the code of portions of this program with the
 * OpenSSL library under certain conditions as described in each
 * individual source file, and distribute linked combinations
 * including the two.
 *
 * You must obey the GNU Affero General Public License in all respects
 * for all of the code used other than OpenSSL.  
 */

#include "config.h"
#include <string.h>

#include "protocol.h"

/**
 *  Check gpsd status.
 *  There is a project site for gpsd at <http://gpsd.berlios.de/>.
 *
 *  @file
 */
int check_gps(Socket_T socket) {
	char buf[STRLEN];
	const char *ok_gps_device="GPSD,G=GPS";
	const char *ok_rtcm104_device="GPSD,G=RTCM104";
	const char *ok_rtcm104v2_device="GPSD,G=RTCM104v2";

	ASSERT(socket);

	if(socket_print(socket, "G\r\n") < 0) {
		socket_setError(socket, "GPS: error sending data -- %s\n", STRERROR);
		return FALSE;
	}

	if(!socket_readln(socket, buf, sizeof(buf))) {
		socket_setError(socket, "GPS: error receiving data -- %s\n", STRERROR);
		return FALSE;
	}

	Str_chomp(buf);
	if(strncasecmp(buf, ok_gps_device, strlen(ok_gps_device)) != 0) {
		if(strncasecmp(buf, ok_rtcm104v2_device, strlen(ok_rtcm104v2_device)) != 0) {
			if(strncasecmp(buf, ok_rtcm104_device, strlen(ok_rtcm104_device)) != 0) {
				socket_setError(socket, "GPS error (no device): %s\n", buf);
				return FALSE;
			}
		}
	}
	
	return TRUE;
}