blob: 86586f0fe180f14dd3e318ff94dae813c6c54de3 [file] [log] [blame]
Denis Vlasenko71c16572009-04-26 01:08:51 +00001/* vi: set sw=4 ts=4: */
2/*
Maxim Kryzhanovsky2004fa12010-03-30 15:49:57 +02003 * ifplugd for busybox, based on ifplugd 0.28 (written by Lennart Poettering).
Denis Vlasenko71c16572009-04-26 01:08:51 +00004 *
Denis Vlasenkof4e45632009-04-26 01:17:44 +00005 * Copyright (C) 2009 Maksym Kryzhanovskyy <xmaks@email.cz>
Denis Vlasenko71c16572009-04-26 01:08:51 +00006 *
Denys Vlasenko0ef64bd2010-08-16 20:14:46 +02007 * Licensed under GPLv2 or later, see file LICENSE in this source tree.
Denis Vlasenko71c16572009-04-26 01:08:51 +00008 */
Pere Orga5bc8c002011-04-11 03:29:49 +02009
10//usage:#define ifplugd_trivial_usage
11//usage: "[OPTIONS]"
12//usage:#define ifplugd_full_usage "\n\n"
13//usage: "Network interface plug detection daemon\n"
Pere Orga5bc8c002011-04-11 03:29:49 +020014//usage: "\n -n Don't daemonize"
15//usage: "\n -s Don't log to syslog"
16//usage: "\n -i IFACE Interface"
17//usage: "\n -f/-F Treat link detection error as link down/link up"
18//usage: "\n (otherwise exit on error)"
19//usage: "\n -a Don't up interface at each link probe"
20//usage: "\n -M Monitor creation/destruction of interface"
21//usage: "\n (otherwise it must exist)"
22//usage: "\n -r PROG Script to run"
23//usage: "\n -x ARG Extra argument for script"
24//usage: "\n -I Don't exit on nonzero exit code from script"
Denys Vlasenko21f620f2012-06-03 10:26:16 +020025//usage: "\n -p Don't run \"up\" script on startup"
26//usage: "\n -q Don't run \"down\" script on exit"
27//usage: "\n -l Always run script on startup"
Pere Orga5bc8c002011-04-11 03:29:49 +020028//usage: "\n -t SECS Poll time in seconds"
29//usage: "\n -u SECS Delay before running script after link up"
30//usage: "\n -d SECS Delay after link down"
31//usage: "\n -m MODE API mode (mii, priv, ethtool, wlan, iff, auto)"
32//usage: "\n -k Kill running daemon"
33
Denis Vlasenko71c16572009-04-26 01:08:51 +000034#include "libbb.h"
35
Denys Vlasenko0568b6e2009-08-08 03:20:12 +020036#include "fix_u32.h"
Denis Vlasenko71c16572009-04-26 01:08:51 +000037#include <linux/if.h>
Denys Vlasenko9c35a1c2009-05-01 09:04:25 +020038#include <linux/mii.h>
Denis Vlasenko71c16572009-04-26 01:08:51 +000039#include <linux/ethtool.h>
Dan Fandrichf533ec82011-06-10 05:17:59 +020040#ifdef HAVE_NET_ETHERNET_H
41# include <net/ethernet.h>
42#endif
Denis Vlasenko71c16572009-04-26 01:08:51 +000043#include <linux/netlink.h>
44#include <linux/rtnetlink.h>
45#include <linux/sockios.h>
46#include <syslog.h>
47
48#define __user
49#include <linux/wireless.h>
50
Denis Vlasenkof4e45632009-04-26 01:17:44 +000051/*
Maxim Kryzhanovsky2004fa12010-03-30 15:49:57 +020052From initial port to busybox, removed most of the redundancy by
53converting implementation of a polymorphic interface to the strict
54functional style. The main role is run a script when link state
55changed, other activities like audio signal or detailed reports
56are on the script itself.
Denis Vlasenkof4e45632009-04-26 01:17:44 +000057
58One questionable point of the design is netlink usage:
59
60We have 1 second timeout by default to poll the link status,
61it is short enough so that there are no real benefits in
62using netlink to get "instantaneous" interface creation/deletion
63notifications. We can check for interface existence by just
64doing some fast ioctl using its name.
65
66Netlink code then can be just dropped (1k or more?)
67*/
68
69
Denis Vlasenko71c16572009-04-26 01:08:51 +000070#define IFPLUGD_ENV_PREVIOUS "IFPLUGD_PREVIOUS"
71#define IFPLUGD_ENV_CURRENT "IFPLUGD_CURRENT"
72
73enum {
74 FLAG_NO_AUTO = 1 << 0, // -a, Do not enable interface automatically
75 FLAG_NO_DAEMON = 1 << 1, // -n, Do not daemonize
76 FLAG_NO_SYSLOG = 1 << 2, // -s, Do not use syslog, use stderr instead
77 FLAG_IGNORE_FAIL = 1 << 3, // -f, Ignore detection failure, retry instead (failure is treated as DOWN)
78 FLAG_IGNORE_FAIL_POSITIVE = 1 << 4, // -F, Ignore detection failure, retry instead (failure is treated as UP)
79 FLAG_IFACE = 1 << 5, // -i, Specify ethernet interface
80 FLAG_RUN = 1 << 6, // -r, Specify program to execute
81 FLAG_IGNORE_RETVAL = 1 << 7, // -I, Don't exit on nonzero return value of program executed
82 FLAG_POLL_TIME = 1 << 8, // -t, Specify poll time in seconds
83 FLAG_DELAY_UP = 1 << 9, // -u, Specify delay for configuring interface
84 FLAG_DELAY_DOWN = 1 << 10, // -d, Specify delay for deconfiguring interface
85 FLAG_API_MODE = 1 << 11, // -m, Force API mode (mii, priv, ethtool, wlan, auto)
86 FLAG_NO_STARTUP = 1 << 12, // -p, Don't run script on daemon startup
87 FLAG_NO_SHUTDOWN = 1 << 13, // -q, Don't run script on daemon quit
88 FLAG_INITIAL_DOWN = 1 << 14, // -l, Run "down" script on startup if no cable is detected
89 FLAG_EXTRA_ARG = 1 << 15, // -x, Specify an extra argument for action script
90 FLAG_MONITOR = 1 << 16, // -M, Use interface monitoring
91#if ENABLE_FEATURE_PIDFILE
92 FLAG_KILL = 1 << 17, // -k, Kill a running daemon
93#endif
94};
95#if ENABLE_FEATURE_PIDFILE
96# define OPTION_STR "+ansfFi:r:It:u:d:m:pqlx:Mk"
97#else
98# define OPTION_STR "+ansfFi:r:It:u:d:m:pqlx:M"
99#endif
100
Denis Vlasenko71c16572009-04-26 01:08:51 +0000101enum { // interface status
102 IFSTATUS_ERR = -1,
103 IFSTATUS_DOWN = 0,
104 IFSTATUS_UP = 1,
105};
106
107enum { // constant fds
108 ioctl_fd = 3,
109 netlink_fd = 4,
110};
111
112struct globals {
113 smallint iface_last_status;
Denys Vlasenko19afe842010-05-08 23:26:16 +0200114 smallint iface_prev_status;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000115 smallint iface_exists;
Maksym Kryzhanovskyy9388b4e2010-07-08 02:47:25 +0200116 smallint api_method_num;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000117
118 /* Used in getopt32, must have sizeof == sizeof(int) */
119 unsigned poll_time;
120 unsigned delay_up;
121 unsigned delay_down;
122
123 const char *iface;
124 const char *api_mode;
125 const char *script_name;
126 const char *extra_arg;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000127};
128#define G (*ptr_to_globals)
129#define INIT_G() do { \
130 SET_PTR_TO_GLOBALS(xzalloc(sizeof(G))); \
131 G.iface_last_status = -1; \
132 G.iface_exists = 1; \
133 G.poll_time = 1; \
134 G.delay_down = 5; \
135 G.iface = "eth0"; \
136 G.api_mode = "a"; \
137 G.script_name = "/etc/ifplugd/ifplugd.action"; \
138} while (0)
139
140
Maksym Kryzhanovskyy4f0279b2010-07-22 02:18:05 +0200141/* Utility routines */
142
143static void set_ifreq_to_ifname(struct ifreq *ifreq)
Denys Vlasenko19afe842010-05-08 23:26:16 +0200144{
Maksym Kryzhanovskyy4f0279b2010-07-22 02:18:05 +0200145 memset(ifreq, 0, sizeof(struct ifreq));
146 strncpy_IFNAMSIZ(ifreq->ifr_name, G.iface);
Denis Vlasenko71c16572009-04-26 01:08:51 +0000147}
148
Denys Vlasenkof422a722010-01-08 12:27:57 +0100149static int network_ioctl(int request, void* data, const char *errmsg)
Denis Vlasenko71c16572009-04-26 01:08:51 +0000150{
Denys Vlasenkof422a722010-01-08 12:27:57 +0100151 int r = ioctl(ioctl_fd, request, data);
152 if (r < 0 && errmsg)
Maxim Kryzhanovskyfcb84c82010-03-29 09:09:05 +0200153 bb_perror_msg("%s failed", errmsg);
Denys Vlasenkof422a722010-01-08 12:27:57 +0100154 return r;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000155}
156
Maksym Kryzhanovskyy4f0279b2010-07-22 02:18:05 +0200157/* Link detection routines and table */
Denis Vlasenko71c16572009-04-26 01:08:51 +0000158
159static smallint detect_link_mii(void)
160{
Denys Vlasenko53f30b42011-01-20 01:20:36 +0100161 /* char buffer instead of bona-fide struct avoids aliasing warning */
162 char buf[sizeof(struct ifreq)];
Denys Vlasenkob3b6c8b2011-01-20 11:29:00 +0100163 struct ifreq *const ifreq = (void *)buf;
164
Denys Vlasenko53f30b42011-01-20 01:20:36 +0100165 struct mii_ioctl_data *mii = (void *)&ifreq->ifr_data;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000166
Denys Vlasenko53f30b42011-01-20 01:20:36 +0100167 set_ifreq_to_ifname(ifreq);
Denis Vlasenko71c16572009-04-26 01:08:51 +0000168
Denys Vlasenko53f30b42011-01-20 01:20:36 +0100169 if (network_ioctl(SIOCGMIIPHY, ifreq, "SIOCGMIIPHY") < 0) {
Denis Vlasenko71c16572009-04-26 01:08:51 +0000170 return IFSTATUS_ERR;
171 }
172
Denys Vlasenko9c35a1c2009-05-01 09:04:25 +0200173 mii->reg_num = 1;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000174
Denys Vlasenko53f30b42011-01-20 01:20:36 +0100175 if (network_ioctl(SIOCGMIIREG, ifreq, "SIOCGMIIREG") < 0) {
Denis Vlasenko71c16572009-04-26 01:08:51 +0000176 return IFSTATUS_ERR;
177 }
178
Denys Vlasenko9c35a1c2009-05-01 09:04:25 +0200179 return (mii->val_out & 0x0004) ? IFSTATUS_UP : IFSTATUS_DOWN;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000180}
181
182static smallint detect_link_priv(void)
183{
Denys Vlasenko53f30b42011-01-20 01:20:36 +0100184 /* char buffer instead of bona-fide struct avoids aliasing warning */
185 char buf[sizeof(struct ifreq)];
Denys Vlasenkob3b6c8b2011-01-20 11:29:00 +0100186 struct ifreq *const ifreq = (void *)buf;
187
Denys Vlasenko53f30b42011-01-20 01:20:36 +0100188 struct mii_ioctl_data *mii = (void *)&ifreq->ifr_data;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000189
Denys Vlasenko53f30b42011-01-20 01:20:36 +0100190 set_ifreq_to_ifname(ifreq);
Denis Vlasenko71c16572009-04-26 01:08:51 +0000191
Denys Vlasenko53f30b42011-01-20 01:20:36 +0100192 if (network_ioctl(SIOCDEVPRIVATE, ifreq, "SIOCDEVPRIVATE") < 0) {
Denis Vlasenko71c16572009-04-26 01:08:51 +0000193 return IFSTATUS_ERR;
194 }
195
Denys Vlasenko9c35a1c2009-05-01 09:04:25 +0200196 mii->reg_num = 1;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000197
Denys Vlasenko53f30b42011-01-20 01:20:36 +0100198 if (network_ioctl(SIOCDEVPRIVATE+1, ifreq, "SIOCDEVPRIVATE+1") < 0) {
Denis Vlasenko71c16572009-04-26 01:08:51 +0000199 return IFSTATUS_ERR;
200 }
201
Denys Vlasenko9c35a1c2009-05-01 09:04:25 +0200202 return (mii->val_out & 0x0004) ? IFSTATUS_UP : IFSTATUS_DOWN;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000203}
204
205static smallint detect_link_ethtool(void)
206{
207 struct ifreq ifreq;
208 struct ethtool_value edata;
209
210 set_ifreq_to_ifname(&ifreq);
211
212 edata.cmd = ETHTOOL_GLINK;
Denys Vlasenko337a31b2009-10-23 18:31:02 +0200213 ifreq.ifr_data = (void*) &edata;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000214
Maxim Kryzhanovskyfcb84c82010-03-29 09:09:05 +0200215 if (network_ioctl(SIOCETHTOOL, &ifreq, "ETHTOOL_GLINK") < 0) {
Denis Vlasenko71c16572009-04-26 01:08:51 +0000216 return IFSTATUS_ERR;
217 }
218
219 return edata.data ? IFSTATUS_UP : IFSTATUS_DOWN;
220}
221
222static smallint detect_link_iff(void)
223{
224 struct ifreq ifreq;
225
226 set_ifreq_to_ifname(&ifreq);
227
Maxim Kryzhanovskyfcb84c82010-03-29 09:09:05 +0200228 if (network_ioctl(SIOCGIFFLAGS, &ifreq, "SIOCGIFFLAGS") < 0) {
Denis Vlasenko71c16572009-04-26 01:08:51 +0000229 return IFSTATUS_ERR;
230 }
231
Denys Vlasenkof422a722010-01-08 12:27:57 +0100232 /* If IFF_UP is not set (interface is down), IFF_RUNNING is never set
233 * regardless of link status. Simply continue to report last status -
234 * no point in reporting spurious link downs if interface is disabled
235 * by admin. When/if it will be brought up,
236 * we'll report real link status.
237 */
238 if (!(ifreq.ifr_flags & IFF_UP) && G.iface_last_status != IFSTATUS_ERR)
239 return G.iface_last_status;
240
Denis Vlasenko71c16572009-04-26 01:08:51 +0000241 return (ifreq.ifr_flags & IFF_RUNNING) ? IFSTATUS_UP : IFSTATUS_DOWN;
242}
243
244static smallint detect_link_wlan(void)
245{
Maxim Kryzhanovskyfcb84c82010-03-29 09:09:05 +0200246 int i;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000247 struct iwreq iwrequest;
248 uint8_t mac[ETH_ALEN];
249
Maxim Kryzhanovskyfcb84c82010-03-29 09:09:05 +0200250 memset(&iwrequest, 0, sizeof(iwrequest));
Denis Vlasenko80e57eb2009-04-26 01:43:36 +0000251 strncpy_IFNAMSIZ(iwrequest.ifr_ifrn.ifrn_name, G.iface);
Denis Vlasenko71c16572009-04-26 01:08:51 +0000252
Maxim Kryzhanovskyfcb84c82010-03-29 09:09:05 +0200253 if (network_ioctl(SIOCGIWAP, &iwrequest, "SIOCGIWAP") < 0) {
Denis Vlasenko71c16572009-04-26 01:08:51 +0000254 return IFSTATUS_ERR;
255 }
256
Maxim Kryzhanovskyfcb84c82010-03-29 09:09:05 +0200257 memcpy(mac, &iwrequest.u.ap_addr.sa_data, ETH_ALEN);
Denis Vlasenko71c16572009-04-26 01:08:51 +0000258
259 if (mac[0] == 0xFF || mac[0] == 0x44 || mac[0] == 0x00) {
Maxim Kryzhanovskyfcb84c82010-03-29 09:09:05 +0200260 for (i = 1; i < ETH_ALEN; ++i) {
Denis Vlasenko71c16572009-04-26 01:08:51 +0000261 if (mac[i] != mac[0])
262 return IFSTATUS_UP;
263 }
264 return IFSTATUS_DOWN;
265 }
266
267 return IFSTATUS_UP;
268}
269
Maksym Kryzhanovskyy4f0279b2010-07-22 02:18:05 +0200270enum { // api mode
271 API_ETHTOOL, // 'e'
272 API_MII, // 'm'
273 API_PRIVATE, // 'p'
274 API_WLAN, // 'w'
275 API_IFF, // 'i'
276 API_AUTO, // 'a'
277};
278
279static const char api_modes[] ALIGN1 = "empwia";
280
281static const struct {
282 const char *name;
283 smallint (*func)(void);
284} method_table[] = {
285 { "SIOCETHTOOL" , &detect_link_ethtool },
286 { "SIOCGMIIPHY" , &detect_link_mii },
287 { "SIOCDEVPRIVATE" , &detect_link_priv },
288 { "wireless extension", &detect_link_wlan },
289 { "IFF_RUNNING" , &detect_link_iff },
290};
291
292
293
294static const char *strstatus(int status)
295{
296 if (status == IFSTATUS_ERR)
297 return "error";
298 return "down\0up" + (status * 5);
299}
300
301static int run_script(const char *action)
302{
303 char *env_PREVIOUS, *env_CURRENT;
304 char *argv[5];
305 int r;
306
307 bb_error_msg("executing '%s %s %s'", G.script_name, G.iface, action);
308
309 argv[0] = (char*) G.script_name;
310 argv[1] = (char*) G.iface;
311 argv[2] = (char*) action;
312 argv[3] = (char*) G.extra_arg;
313 argv[4] = NULL;
314
315 env_PREVIOUS = xasprintf("%s=%s", IFPLUGD_ENV_PREVIOUS, strstatus(G.iface_prev_status));
316 putenv(env_PREVIOUS);
317 env_CURRENT = xasprintf("%s=%s", IFPLUGD_ENV_CURRENT, strstatus(G.iface_last_status));
318 putenv(env_CURRENT);
319
320 /* r < 0 - can't exec, 0 <= r < 0x180 - exited, >=0x180 - killed by sig (r-0x180) */
321 r = spawn_and_wait(argv);
322
323 unsetenv(IFPLUGD_ENV_PREVIOUS);
324 unsetenv(IFPLUGD_ENV_CURRENT);
325 free(env_PREVIOUS);
326 free(env_CURRENT);
327
328 bb_error_msg("exit code: %d", r & 0xff);
329 return (option_mask32 & FLAG_IGNORE_RETVAL) ? 0 : r;
330}
331
332static void up_iface(void)
333{
334 struct ifreq ifrequest;
335
336 if (!G.iface_exists)
337 return;
338
339 set_ifreq_to_ifname(&ifrequest);
340 if (network_ioctl(SIOCGIFFLAGS, &ifrequest, "getting interface flags") < 0) {
341 G.iface_exists = 0;
342 return;
343 }
344
345 if (!(ifrequest.ifr_flags & IFF_UP)) {
346 ifrequest.ifr_flags |= IFF_UP;
347 /* Let user know we mess up with interface */
348 bb_error_msg("upping interface");
349 if (network_ioctl(SIOCSIFFLAGS, &ifrequest, "setting interface flags") < 0)
350 xfunc_die();
351 }
352
353#if 0 /* why do we mess with IP addr? It's not our business */
354 if (network_ioctl(SIOCGIFADDR, &ifrequest, "can't get interface address") < 0) {
355 } else if (ifrequest.ifr_addr.sa_family != AF_INET) {
356 bb_perror_msg("the interface is not IP-based");
357 } else {
358 ((struct sockaddr_in*)(&ifrequest.ifr_addr))->sin_addr.s_addr = INADDR_ANY;
359 network_ioctl(SIOCSIFADDR, &ifrequest, "can't set interface address");
360 }
361 network_ioctl(SIOCGIFFLAGS, &ifrequest, "can't get interface flags");
362#endif
363}
364
365static void maybe_up_new_iface(void)
366{
367 if (!(option_mask32 & FLAG_NO_AUTO))
368 up_iface();
369
370#if 0 /* bloat */
371 struct ifreq ifrequest;
372 struct ethtool_drvinfo driver_info;
373
374 set_ifreq_to_ifname(&ifrequest);
375 driver_info.cmd = ETHTOOL_GDRVINFO;
376 ifrequest.ifr_data = &driver_info;
377 if (network_ioctl(SIOCETHTOOL, &ifrequest, NULL) == 0) {
378 char buf[sizeof("/xx:xx:xx:xx:xx:xx")];
379
380 /* Get MAC */
381 buf[0] = '\0';
382 set_ifreq_to_ifname(&ifrequest);
383 if (network_ioctl(SIOCGIFHWADDR, &ifrequest, NULL) == 0) {
384 sprintf(buf, "/%02X:%02X:%02X:%02X:%02X:%02X",
385 (uint8_t)(ifrequest.ifr_hwaddr.sa_data[0]),
386 (uint8_t)(ifrequest.ifr_hwaddr.sa_data[1]),
387 (uint8_t)(ifrequest.ifr_hwaddr.sa_data[2]),
388 (uint8_t)(ifrequest.ifr_hwaddr.sa_data[3]),
389 (uint8_t)(ifrequest.ifr_hwaddr.sa_data[4]),
390 (uint8_t)(ifrequest.ifr_hwaddr.sa_data[5]));
391 }
392
393 bb_error_msg("using interface %s%s with driver<%s> (version: %s)",
394 G.iface, buf, driver_info.driver, driver_info.version);
395 }
396#endif
397 if (G.api_mode[0] == 'a')
398 G.api_method_num = API_AUTO;
399}
400
Maksym Kryzhanovskyy9388b4e2010-07-08 02:47:25 +0200401static smallint detect_link(void)
Denis Vlasenko71c16572009-04-26 01:08:51 +0000402{
Denis Vlasenko71c16572009-04-26 01:08:51 +0000403 smallint status;
404
405 if (!G.iface_exists)
406 return (option_mask32 & FLAG_MONITOR) ? IFSTATUS_DOWN : IFSTATUS_ERR;
407
Denys Vlasenkof422a722010-01-08 12:27:57 +0100408 /* Some drivers can't detect link status when the interface is down.
409 * I imagine detect_link_iff() is the most vulnerable.
410 * That's why -a "noauto" in an option, not a hardwired behavior.
411 */
Denis Vlasenko71c16572009-04-26 01:08:51 +0000412 if (!(option_mask32 & FLAG_NO_AUTO))
413 up_iface();
Denis Vlasenko71c16572009-04-26 01:08:51 +0000414
Maksym Kryzhanovskyy4f0279b2010-07-22 02:18:05 +0200415 if (G.api_method_num == API_AUTO) {
416 int i;
417 smallint sv_logmode;
Maksym Kryzhanovskyy9388b4e2010-07-08 02:47:25 +0200418
Maksym Kryzhanovskyy4f0279b2010-07-22 02:18:05 +0200419 sv_logmode = logmode;
420 for (i = 0; i < ARRAY_SIZE(method_table); i++) {
421 logmode = LOGMODE_NONE;
422 status = method_table[i].func();
423 logmode = sv_logmode;
424 if (status != IFSTATUS_ERR) {
425 G.api_method_num = i;
426 bb_error_msg("using %s detection mode", method_table[i].name);
427 break;
Maksym Kryzhanovskyy9388b4e2010-07-08 02:47:25 +0200428 }
Maksym Kryzhanovskyy9388b4e2010-07-08 02:47:25 +0200429 }
Maksym Kryzhanovskyy4f0279b2010-07-22 02:18:05 +0200430 } else {
431 status = method_table[G.api_method_num].func();
Maksym Kryzhanovskyy9388b4e2010-07-08 02:47:25 +0200432 }
433
Denis Vlasenko71c16572009-04-26 01:08:51 +0000434 if (status == IFSTATUS_ERR) {
435 if (option_mask32 & FLAG_IGNORE_FAIL)
436 status = IFSTATUS_DOWN;
Maksym Kryzhanovskyy9388b4e2010-07-08 02:47:25 +0200437 else if (option_mask32 & FLAG_IGNORE_FAIL_POSITIVE)
Denis Vlasenko71c16572009-04-26 01:08:51 +0000438 status = IFSTATUS_UP;
Maksym Kryzhanovskyy4f0279b2010-07-22 02:18:05 +0200439 else if (G.api_mode[0] == 'a')
Maksym Kryzhanovskyy9388b4e2010-07-08 02:47:25 +0200440 bb_error_msg("can't detect link status");
Denis Vlasenko71c16572009-04-26 01:08:51 +0000441 }
Maksym Kryzhanovskyy4f0279b2010-07-22 02:18:05 +0200442
Denis Vlasenko71c16572009-04-26 01:08:51 +0000443 if (status != G.iface_last_status) {
Denys Vlasenko19afe842010-05-08 23:26:16 +0200444 G.iface_prev_status = G.iface_last_status;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000445 G.iface_last_status = status;
446 }
447
448 return status;
449}
450
451static NOINLINE int check_existence_through_netlink(void)
452{
Denys Vlasenko37201212010-04-02 07:04:44 +0200453 int iface_len;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000454 char replybuf[1024];
455
Denys Vlasenko37201212010-04-02 07:04:44 +0200456 iface_len = strlen(G.iface);
Denis Vlasenko71c16572009-04-26 01:08:51 +0000457 while (1) {
458 struct nlmsghdr *mhdr;
459 ssize_t bytes;
460
461 bytes = recv(netlink_fd, &replybuf, sizeof(replybuf), MSG_DONTWAIT);
462 if (bytes < 0) {
463 if (errno == EAGAIN)
464 return G.iface_exists;
465 if (errno == EINTR)
466 continue;
467
468 bb_perror_msg("netlink: recv");
469 return -1;
470 }
471
472 mhdr = (struct nlmsghdr*)replybuf;
473 while (bytes > 0) {
Maxim Kryzhanovsky2004fa12010-03-30 15:49:57 +0200474 if (!NLMSG_OK(mhdr, bytes)) {
Denis Vlasenko71c16572009-04-26 01:08:51 +0000475 bb_error_msg("netlink packet too small or truncated");
476 return -1;
477 }
478
479 if (mhdr->nlmsg_type == RTM_NEWLINK || mhdr->nlmsg_type == RTM_DELLINK) {
480 struct rtattr *attr;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000481 int attr_len;
482
Denis Vlasenko71c16572009-04-26 01:08:51 +0000483 if (mhdr->nlmsg_len < NLMSG_LENGTH(sizeof(struct ifinfomsg))) {
484 bb_error_msg("netlink packet too small or truncated");
485 return -1;
486 }
487
Maxim Kryzhanovsky2004fa12010-03-30 15:49:57 +0200488 attr = IFLA_RTA(NLMSG_DATA(mhdr));
489 attr_len = IFLA_PAYLOAD(mhdr);
Denis Vlasenko71c16572009-04-26 01:08:51 +0000490
491 while (RTA_OK(attr, attr_len)) {
492 if (attr->rta_type == IFLA_IFNAME) {
Denis Vlasenko71c16572009-04-26 01:08:51 +0000493 int len = RTA_PAYLOAD(attr);
Denis Vlasenko71c16572009-04-26 01:08:51 +0000494 if (len > IFNAMSIZ)
495 len = IFNAMSIZ;
Denys Vlasenko37201212010-04-02 07:04:44 +0200496 if (iface_len <= len
497 && strncmp(G.iface, RTA_DATA(attr), len) == 0
498 ) {
Denis Vlasenko71c16572009-04-26 01:08:51 +0000499 G.iface_exists = (mhdr->nlmsg_type == RTM_NEWLINK);
500 }
501 }
502 attr = RTA_NEXT(attr, attr_len);
503 }
504 }
505
506 mhdr = NLMSG_NEXT(mhdr, bytes);
507 }
508 }
509
510 return G.iface_exists;
511}
512
Denys Vlasenko9c35a1c2009-05-01 09:04:25 +0200513#if ENABLE_FEATURE_PIDFILE
Denis Vlasenko71c16572009-04-26 01:08:51 +0000514static NOINLINE pid_t read_pid(const char *filename)
515{
516 int len;
517 char buf[128];
518
519 len = open_read_close(filename, buf, 127);
520 if (len > 0) {
521 buf[len] = '\0';
522 /* returns ULONG_MAX on error => -1 */
523 return bb_strtoul(buf, NULL, 10);
524 }
525 return 0;
526}
Denys Vlasenko9c35a1c2009-05-01 09:04:25 +0200527#endif
Denis Vlasenko71c16572009-04-26 01:08:51 +0000528
529int ifplugd_main(int argc, char **argv) MAIN_EXTERNALLY_VISIBLE;
530int ifplugd_main(int argc UNUSED_PARAM, char **argv)
531{
532 int iface_status;
533 int delay_time;
534 const char *iface_status_str;
535 struct pollfd netlink_pollfd[1];
536 unsigned opts;
Maksym Kryzhanovskyy9388b4e2010-07-08 02:47:25 +0200537 const char *api_mode_found;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000538#if ENABLE_FEATURE_PIDFILE
539 char *pidfile_name;
540 pid_t pid_from_pidfile;
541#endif
542
543 INIT_G();
544
545 opt_complementary = "t+:u+:d+";
546 opts = getopt32(argv, OPTION_STR,
547 &G.iface, &G.script_name, &G.poll_time, &G.delay_up,
548 &G.delay_down, &G.api_mode, &G.extra_arg);
Denys Vlasenko5a34d022009-11-07 17:30:14 +0100549 G.poll_time *= 1000;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000550
551 applet_name = xasprintf("ifplugd(%s)", G.iface);
552
553#if ENABLE_FEATURE_PIDFILE
Anthony G. Basile12677ac2012-12-10 14:49:39 -0500554 pidfile_name = xasprintf(CONFIG_PID_FILE_PATH "/ifplugd.%s.pid", G.iface);
Denis Vlasenko71c16572009-04-26 01:08:51 +0000555 pid_from_pidfile = read_pid(pidfile_name);
556
557 if (opts & FLAG_KILL) {
558 if (pid_from_pidfile > 0)
559 kill(pid_from_pidfile, SIGQUIT);
560 return EXIT_SUCCESS;
561 }
562
563 if (pid_from_pidfile > 0 && kill(pid_from_pidfile, 0) == 0)
564 bb_error_msg_and_die("daemon already running");
565#endif
Maksym Kryzhanovskyy4f0279b2010-07-22 02:18:05 +0200566
Maksym Kryzhanovskyy9388b4e2010-07-08 02:47:25 +0200567 api_mode_found = strchr(api_modes, G.api_mode[0]);
568 if (!api_mode_found)
Denis Vlasenko71c16572009-04-26 01:08:51 +0000569 bb_error_msg_and_die("unknown API mode '%s'", G.api_mode);
Maksym Kryzhanovskyy9388b4e2010-07-08 02:47:25 +0200570 G.api_method_num = api_mode_found - api_modes;
Denis Vlasenko71c16572009-04-26 01:08:51 +0000571
572 if (!(opts & FLAG_NO_DAEMON))
573 bb_daemonize_or_rexec(DAEMON_CHDIR_ROOT, argv);
574
575 xmove_fd(xsocket(AF_INET, SOCK_DGRAM, 0), ioctl_fd);
576 if (opts & FLAG_MONITOR) {
Maksym Kryzhanovskyy4f0279b2010-07-22 02:18:05 +0200577 struct sockaddr_nl addr;
578 int fd = xsocket(PF_NETLINK, SOCK_DGRAM, NETLINK_ROUTE);
579
580 memset(&addr, 0, sizeof(addr));
581 addr.nl_family = AF_NETLINK;
582 addr.nl_groups = RTMGRP_LINK;
583 addr.nl_pid = getpid();
584
585 xbind(fd, (struct sockaddr*)&addr, sizeof(addr));
586 xmove_fd(fd, netlink_fd);
Denis Vlasenko71c16572009-04-26 01:08:51 +0000587 }
588
589 write_pidfile(pidfile_name);
590
591 /* this can't be moved before socket creation */
592 if (!(opts & FLAG_NO_SYSLOG)) {
593 openlog(applet_name, 0, LOG_DAEMON);
594 logmode |= LOGMODE_SYSLOG;
595 }
596
597 bb_signals(0
598 | (1 << SIGINT )
599 | (1 << SIGTERM)
600 | (1 << SIGQUIT)
601 | (1 << SIGHUP ) /* why we ignore it? */
602 /* | (1 << SIGCHLD) - run_script does not use it anymore */
603 , record_signo);
604
605 bb_error_msg("started: %s", bb_banner);
606
607 if (opts & FLAG_MONITOR) {
608 struct ifreq ifrequest;
609 set_ifreq_to_ifname(&ifrequest);
Denys Vlasenkof422a722010-01-08 12:27:57 +0100610 G.iface_exists = (network_ioctl(SIOCGIFINDEX, &ifrequest, NULL) == 0);
Denis Vlasenko71c16572009-04-26 01:08:51 +0000611 }
612
613 if (G.iface_exists)
614 maybe_up_new_iface();
615
616 iface_status = detect_link();
617 if (iface_status == IFSTATUS_ERR)
618 goto exiting;
619 iface_status_str = strstatus(iface_status);
620
621 if (opts & FLAG_MONITOR) {
622 bb_error_msg("interface %s",
623 G.iface_exists ? "exists"
624 : "doesn't exist, waiting");
625 }
626 /* else we assume it always exists, but don't mislead user
627 * by potentially lying that it really exists */
628
629 if (G.iface_exists) {
630 bb_error_msg("link is %s", iface_status_str);
631 }
632
633 if ((!(opts & FLAG_NO_STARTUP)
634 && iface_status == IFSTATUS_UP
635 )
636 || (opts & FLAG_INITIAL_DOWN)
637 ) {
638 if (run_script(iface_status_str) != 0)
639 goto exiting;
640 }
641
642 /* Main loop */
643 netlink_pollfd[0].fd = netlink_fd;
644 netlink_pollfd[0].events = POLLIN;
645 delay_time = 0;
646 while (1) {
647 int iface_status_old;
648 int iface_exists_old;
649
650 switch (bb_got_signal) {
651 case SIGINT:
652 case SIGTERM:
653 bb_got_signal = 0;
654 goto cleanup;
655 case SIGQUIT:
656 bb_got_signal = 0;
657 goto exiting;
658 default:
659 bb_got_signal = 0;
660 break;
661 }
662
663 if (poll(netlink_pollfd,
664 (opts & FLAG_MONITOR) ? 1 : 0,
Denys Vlasenko5a34d022009-11-07 17:30:14 +0100665 G.poll_time
Denis Vlasenko71c16572009-04-26 01:08:51 +0000666 ) < 0
667 ) {
668 if (errno == EINTR)
669 continue;
670 bb_perror_msg("poll");
671 goto exiting;
672 }
673
674 iface_status_old = iface_status;
675 iface_exists_old = G.iface_exists;
676
677 if ((opts & FLAG_MONITOR)
678 && (netlink_pollfd[0].revents & POLLIN)
679 ) {
680 G.iface_exists = check_existence_through_netlink();
681 if (G.iface_exists < 0) /* error */
682 goto exiting;
683 if (iface_exists_old != G.iface_exists) {
684 bb_error_msg("interface %sappeared",
685 G.iface_exists ? "" : "dis");
686 if (G.iface_exists)
687 maybe_up_new_iface();
688 }
689 }
690
691 /* note: if !G.iface_exists, returns DOWN */
692 iface_status = detect_link();
693 if (iface_status == IFSTATUS_ERR) {
694 if (!(opts & FLAG_MONITOR))
695 goto exiting;
696 iface_status = IFSTATUS_DOWN;
697 }
698 iface_status_str = strstatus(iface_status);
699
700 if (iface_status_old != iface_status) {
701 bb_error_msg("link is %s", iface_status_str);
702
703 if (delay_time) {
704 /* link restored its old status before
705 * we run script. don't run the script: */
706 delay_time = 0;
707 } else {
708 delay_time = monotonic_sec();
709 if (iface_status == IFSTATUS_UP)
710 delay_time += G.delay_up;
711 if (iface_status == IFSTATUS_DOWN)
712 delay_time += G.delay_down;
713 if (delay_time == 0)
714 delay_time++;
715 }
716 }
717
718 if (delay_time && (int)(monotonic_sec() - delay_time) >= 0) {
719 delay_time = 0;
720 if (run_script(iface_status_str) != 0)
721 goto exiting;
722 }
723 } /* while (1) */
724
725 cleanup:
726 if (!(opts & FLAG_NO_SHUTDOWN)
727 && (iface_status == IFSTATUS_UP
728 || (iface_status == IFSTATUS_DOWN && delay_time)
729 )
730 ) {
731 setenv(IFPLUGD_ENV_PREVIOUS, strstatus(iface_status), 1);
732 setenv(IFPLUGD_ENV_CURRENT, strstatus(-1), 1);
733 run_script("down\0up"); /* reusing string */
734 }
735
736 exiting:
737 remove_pidfile(pidfile_name);
738 bb_error_msg_and_die("exiting");
739}