chiark / gitweb /
switch tools and volume_id from LGPL to GPLv2
[elogind.git] / udevsend.c
1 /*
2  * udevsend.c
3  *
4  * Copyright (C) 2004 Ling, Xiaofeng <xiaofeng.ling@intel.com>
5  * Copyright (C) 2004 Kay Sievers <kay.sievers@vrfy.org>
6  *
7  *      This program is free software; you can redistribute it and/or modify it
8  *      under the terms of the GNU General Public License as published by the
9  *      Free Software Foundation version 2 of the License.
10  * 
11  *      This program is distributed in the hope that it will be useful, but
12  *      WITHOUT ANY WARRANTY; without even the implied warranty of
13  *      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  *      General Public License for more details.
15  * 
16  *      You should have received a copy of the GNU General Public License along
17  *      with this program; if not, write to the Free Software Foundation, Inc.,
18  *      675 Mass Ave, Cambridge, MA 02139, USA.
19  *
20  */
21
22 #include <stdio.h>
23 #include <stdlib.h>
24 #include <stddef.h>
25 #include <unistd.h>
26 #include <string.h>
27 #include <time.h>
28 #include <errno.h>
29 #include <sys/types.h>
30 #include <sys/socket.h>
31 #include <sys/wait.h>
32 #include <sys/un.h>
33 #include <linux/stddef.h>
34
35 #include "udev.h"
36 #include "udev_version.h"
37 #include "udevd.h"
38 #include "logging.h"
39
40 /* global variables */
41 static int sock = -1;
42
43 #ifdef USE_LOG
44 void log_message (int priority, const char *format, ...)
45 {
46         va_list args;
47
48         if (priority > udev_log_priority)
49                 return;
50
51         va_start(args, format);
52         vsyslog(priority, format, args);
53         va_end(args);
54 }
55 #endif
56
57 static int start_daemon(void)
58 {
59         pid_t pid;
60         pid_t child_pid;
61         char *const argv[] = { "udevd", NULL };
62         char *const envp[] = { NULL };
63
64         pid = fork();
65         switch (pid) {
66         case 0:
67                 /* helper child */
68                 child_pid = fork();
69                 switch (child_pid) {
70                 case 0:
71                         /* daemon with empty environment */
72                         close(sock);
73                         execve(UDEVD_BIN, argv, envp);
74                         err("exec of daemon failed");
75                         _exit(1);
76                 case -1:
77                         err("fork of daemon failed");
78                         return -1;
79                 default:
80                         exit(0);
81                 }
82                 break;
83         case -1:
84                 err("fork of helper failed");
85                 return -1;
86         default:
87                 waitpid(pid, NULL, 0);
88         }
89         return 0;
90 }
91
92 static void run_udev(const char *subsystem)
93 {
94         char *const argv[] = { "udev", (char *)subsystem, NULL };
95         pid_t pid;
96
97         pid = fork();
98         switch (pid) {
99         case 0:
100                 /* child */
101                 execv(UDEV_BIN, argv);
102                 err("exec of udev child failed");
103                 _exit(1);
104                 break;
105         case -1:
106                 err("fork of udev child failed");
107                 break;
108         default:
109                 waitpid(pid, NULL, 0);
110         }
111 }
112
113 int main(int argc, char *argv[], char *envp[])
114 {
115         static struct udevd_msg usend_msg;
116         int usend_msg_len;
117         int i;
118         int loop;
119         struct sockaddr_un saddr;
120         socklen_t addrlen;
121         int bufpos = 0;
122         int retval = 1;
123         int started_daemon = 0;
124         const char *subsystem = NULL;
125
126         logging_init("udevsend");
127 #ifdef USE_LOG
128         udev_init_config();
129 #endif
130         dbg("version %s", UDEV_VERSION);
131
132         sock = socket(AF_LOCAL, SOCK_DGRAM, 0);
133         if (sock == -1) {
134                 err("error getting socket");
135                 goto fallback;
136         }
137
138         memset(&saddr, 0x00, sizeof(struct sockaddr_un));
139         saddr.sun_family = AF_LOCAL;
140         /* use abstract namespace for socket path */
141         strcpy(&saddr.sun_path[1], UDEVD_SOCK_PATH);
142         addrlen = offsetof(struct sockaddr_un, sun_path) + strlen(saddr.sun_path+1) + 1;
143
144         memset(&usend_msg, 0x00, sizeof(struct udevd_msg));
145         strcpy(usend_msg.magic, UDEV_MAGIC);
146         usend_msg.type = UDEVD_UEVENT_UDEVSEND;
147
148         /* copy all keys to send buffer */
149         for (i = 0; envp[i]; i++) {
150                 const char *key;
151                 int keylen;
152
153                 key = envp[i];
154                 keylen = strlen(key);
155
156                 /* prevent loops in the scripts we execute */
157                 if (strncmp(key, "UDEVD_EVENT=", 12) == 0) {
158                         dbg("seems that the event source is not the kernel, just exit");
159                         goto exit;
160                 }
161
162                 if (bufpos + keylen >= UEVENT_BUFFER_SIZE-1) {
163                         err("environment buffer too small, probably not called by the kernel");
164                         continue;
165                 }
166
167                 /* remember the SUBSYSTEM */
168                 if (strncmp(key, "SUBSYSTEM=", 10) == 0)
169                         subsystem = &key[10];
170
171                 dbg("add '%s' to env[%i] buffer", key, i);
172                 strcpy(&usend_msg.envbuf[bufpos], key);
173                 bufpos += keylen + 1;
174         }
175         /* older kernels passed the SUBSYSTEM only as the first argument */
176         if (!subsystem && argc == 2) {
177                 bufpos += sprintf(&usend_msg.envbuf[bufpos], "SUBSYSTEM=%s", argv[1]) + 1;
178                 dbg("add 'SUBSYSTEM=%s' to env[%i] buffer from argv", argv[1], i);
179         }
180
181         usend_msg_len = offsetof(struct udevd_msg, envbuf) + bufpos;
182         dbg("usend_msg_len=%i", usend_msg_len);
183
184         /* If we can't send, try to start daemon and resend message */
185         loop = UDEVSEND_WAIT_MAX_SECONDS * UDEVSEND_WAIT_LOOP_PER_SECOND;
186         while (--loop) {
187                 retval = sendto(sock, &usend_msg, usend_msg_len, 0, (struct sockaddr *)&saddr, addrlen);
188                 if (retval != -1) {
189                         retval = 0;
190                         goto exit;
191                 }
192
193                 if (errno != ECONNREFUSED) {
194                         err("error sending message (%s)", strerror(errno));
195                         goto fallback;
196                 }
197
198                 if (!started_daemon) {
199                         info("try to start udevd daemon");
200                         retval = start_daemon();
201                         if (retval) {
202                                 dbg("error starting daemon");
203                                 goto fallback;
204                         }
205                         dbg("udevd daemon started");
206                         started_daemon = 1;
207                 } else {
208                         dbg("retry to connect %d", UDEVSEND_WAIT_MAX_SECONDS * UDEVSEND_WAIT_LOOP_PER_SECOND - loop);
209                         usleep(1000 * 1000 / UDEVSEND_WAIT_LOOP_PER_SECOND);
210                 }
211         }
212
213 fallback:
214         err("unable to connect to event daemon, try to call udev directly");
215         run_udev(subsystem);
216
217 exit:
218         if (sock != -1)
219                 close(sock);
220
221         logging_close();
222
223         return retval;
224 }