1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
|
/* gpsdctl.c -- communicate with the control socket of a gpsd instance
*
* This file is Copyright (c) 2010 by the GPSD project
* BSD terms apply: see the file COPYING in the distribution root for details.
*
*/
#include <string.h>
#include <fcntl.h>
#include <sys/stat.h>
#ifndef S_SPLINT_S
#include <netdb.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <sys/un.h>
#ifndef INADDR_ANY
#include <netinet/in.h>
#endif /* INADDR_ANY */
#include <unistd.h>
#endif /* S_SPLINT_S */
#include <syslog.h>
#include <stdbool.h>
#include <stdlib.h>
#include <stdio.h>
#include "gpsd.h" /* only for the strlcpy() prototype */
static char *control_socket = "/var/run/gpsd.sock";
static char *gpsd_options = "";
static int gpsd_control_connect(bool complain)
/* acquire a connection to the gpsd control socket */
{
int sock;
if (access(control_socket, F_OK) != 0) {
(void)syslog(LOG_ERR, "gpsdctl: socket %s doesn't exist", control_socket);
return -1;
} else if ((sock = socket(AF_UNIX, SOCK_STREAM, 0)) < 0) {
if (complain)
(void)syslog(LOG_ERR, "gpsdctl: socket creation failed");
return -1;
} else {
struct sockaddr_un saddr;
memset(&saddr, 0, sizeof(struct sockaddr_un));
saddr.sun_family = AF_UNIX;
(void)strlcpy(saddr.sun_path,
control_socket,
sizeof(saddr.sun_path));
/*@-unrecog@*/
if (connect(sock, (struct sockaddr *)&saddr, SUN_LEN(&saddr)) < 0) {
if (complain)
(void)syslog(LOG_ERR, "gpsdctl: socket connect failed");
return -1;
}
/*@+unrecog@*/
return sock;
}
}
static int gpsd_control(char *action, char *argument)
/* pass a command to gpsd; start the daemon if not already running */
{
int connect;
char buf[512];
(void)syslog(LOG_ERR, "gpsd_control(action=%s, arg=%s)", action, argument);
connect = gpsd_control_connect(false);
if (connect >= 0)
syslog(LOG_INFO, "gpsdctl: 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, "gpsdctl: launching %s", buf);
(void)system(buf);
connect = gpsd_control_connect(true);
}
if (connect < 0) {
syslog(LOG_ERR, "gpsdctl: 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.
*/
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;
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);
(void)write(connect, buf, strlen(buf));
(void)read(connect, buf, 12);
} else if (strcmp(action, "remove") == 0) {
(void)snprintf(buf, sizeof(buf), "-%s\r\n", argument);
(void)write(connect, buf, strlen(buf));
(void)read(connect, buf, 12);
} else if (strcmp(action, "send") == 0) {
(void)snprintf(buf, sizeof(buf), "%s\r\n", argument);
(void)write(connect, buf, strlen(buf));
(void)read(connect, buf, 12);
}
(void)close(connect);
//syslog(LOG_DEBUG, "gpsd_control ends");
return 0;
}
int main(int argc, char *argv[])
{
if (argc != 3) {
(void)syslog(LOG_ERR, "gpsdctl: requires action and argument");
exit(1);
} else {
/*@-observertrans@*/
char *sockenv = getenv("GPSD_SOCKET");
char *optenv = getenv("GPSD_OPTIONS");
if (sockenv != NULL)
control_socket = sockenv;
if (optenv != NULL)
gpsd_options = optenv;
if (gpsd_control(argv[1], argv[2]) < 0)
exit(1);
else
exit(0);
/*@+observertrans@*/
}
}
|
