gpsd/gpsdctl.c

/* gpsdctl.c -- communicate with the control socket of a gpsd instance
 *
 * This file is Copyright 2010 by the GPSD project
 * SPDX-License-Identifier: BSD-2-clause
 *
 */

#include "gpsd_config.h"  /* must be before all includes */

#include <assert.h>
#include <fcntl.h>
#include <stdbool.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <syslog.h>
#include <sys/socket.h>
#include <sys/stat.h>
#include <unistd.h>

#include "gpsd.h"

#define DEFAULT_GPSD_TEST_SOCKET        "/tmp/gpsd.sock"

static char *control_socket = DEFAULT_GPSD_SOCKET;
static char *gpsd_options = "";

static int gpsd_control(char *action, char *argument)
/* pass a command to gpsd; start the daemon if not already running */
{
    int connect = -1;
    char buf[512];
    int status;

    (void)syslog(LOG_ERR, "gpsd_control(action=%s, arg=%s)", action, argument);
    if (access(control_socket, F_OK) == 0 &&
            (connect = netlib_localsocket(control_socket, SOCK_STREAM)) >= 0)
        syslog(LOG_INFO, "reached a running gpsd");
    else if (strcmp(action, "add") == 0) {
        (void)snprintf(buf, sizeof(buf),
                       "gpsd %s -F %s", gpsd_options, control_socket);
        (void)syslog(LOG_NOTICE, "launching %s", buf);
        if (system(buf) != 0) {
            (void)syslog(LOG_ERR, "launch of gpsd failed");
            return -1;
        }
        if (access(control_socket, F_OK) == 0)
            connect = netlib_localsocket(control_socket, SOCK_STREAM);
    }
    if (connect < 0) {
        syslog(LOG_ERR, "can't reach gpsd");
        return -1;
    }
    /*
     * We've got a live connection to the gpsd control socket.  No
     * need to parse the response, because gpsd will lock on to the
     * device if it's really a GPS and ignore it if it's not.
     *
     * The only other place in the code that knows about the format of
     * the add and remove commands is the handle_control() function in
     * gpsd.c. Be careful about keeping them in sync, or hotplugging
     * will have mysterious failures.
     */
    if (strcmp(action, "add") == 0) {
        /*
         * Force the group-read & group-write bits on, so gpsd will still be
         * able to use this device after dropping root privileges.
         */
        struct stat sb;

        /* coverity[toctou] */
        if (stat(argument, &sb) != 1)
            (void)chmod(argument, sb.st_mode | S_IRUSR|S_IWUSR|S_IRGRP|S_IWGRP);
        (void)snprintf(buf, sizeof(buf), "+%s\r\n", argument);
        status = (int)write(connect, buf, strlen(buf));
        ignore_return(read(connect, buf, 12));
    } else if (strcmp(action, "remove") == 0) {
        (void)snprintf(buf, sizeof(buf), "-%s\r\n", argument);
        status = (int)write(connect, buf, strlen(buf));
        ignore_return(read(connect, buf, 12));
    } else {
        (void)syslog(LOG_ERR, "unknown action \"%s\"", action);
        status = -1;
    }
    (void)close(connect);
    //syslog(LOG_DEBUG, "gpsd_control ends");
    return status;
}

int main(int argc, char *argv[])
{
    char *sockenv = getenv("GPSD_SOCKET");
    char *optenv = getenv("GPSD_OPTIONS");
    size_t len;

    openlog("gpsdctl", 0, LOG_DAEMON);
    if (3 != argc) {
        (void)syslog(LOG_ERR, "requires action and argument (%d)", argc);
        exit(EXIT_FAILURE);
    }
    // pacify coverity
    len = strlen(argv[1]);
    if (3 > len || 7 < len) {
        (void)syslog(LOG_ERR, "invalid action '%s'", argv[1]);
        exit(EXIT_FAILURE);
    }

    // pacify coverity
    len = strlen(argv[2]);
    if (GPS_PATH_MAX <= len) {
        (void)syslog(LOG_ERR, "invalid path '%s'", argv[2]);
        exit(EXIT_FAILURE);
    }

    if (NULL != sockenv)
        control_socket = sockenv;
    else if (0 != geteuid())
        control_socket = DEFAULT_GPSD_TEST_SOCKET;

    if (NULL != optenv)
        gpsd_options = optenv;

    if (0 > gpsd_control(argv[1], argv[2]))
        exit(EXIT_FAILURE);

    exit(EXIT_SUCCESS);
}

// vim: set expandtab shiftwidth=4