blob: 7c7f26da671d0d8c4d3b9e006521c301e79dee42 [file] [log] [blame]
/*
* 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;
}