void work(void) {
fd_set fds;
int sigfd;
static char log_ident[256];
snprintf(log_ident, sizeof(log_ident), "ifplugd");
daemon_log_ident = log_ident;
daemon_log(LOG_INFO, "ifplugd "VERSION" initializing, using NETLINK device monitoring");
if (daemon_pid_file_create() < 0) {
daemon_log(LOG_ERR, "Could not create PID file %s.", daemon_pid_file_proc());
goto finish;
}
if (daemon_signal_init(SIGINT, SIGTERM, SIGQUIT, SIGHUP, SIGCHLD, SIGUSR1, SIGUSR2, -1) < 0) {
daemon_log(LOG_ERR, "Could not register signal handler: %s", strerror(errno));
goto finish;
}
if ((netlink = socket(AF_LOCAL, SOCK_DGRAM, 0)) < 0) {
daemon_log(LOG_ERR, "socket(): %s", strerror(errno));
goto finish;
}
rbus = rbus_init("unix!/tmp/ifplugd.9p");
rbus->rbus.childs = &root_children[0];
discover(netlink);
if (nlapi_open(RTMGRP_LINK) < 0)
goto finish;
if (ifmonitor_init(ifmonitor_cb) < 0)
goto finish;
FD_ZERO(&fds);
sigfd = daemon_signal_fd();
FD_SET(sigfd, &fds);
FD_SET(nlapi_fd, &fds);
for (;;) {
struct interface_state *iface;
fd_set qfds = fds;
struct timeval tv;
IxpConn *c;
for(c = rbus->srv->conn; c; c = c->next) {
if(c->read) {
FD_SET(c->fd, &qfds);
}
}
tv.tv_sec = polltime;
tv.tv_usec = 0;
if (select(FD_SETSIZE, &qfds, NULL, NULL, &tv) < 0) {
if (errno == EINTR)
continue;
daemon_log(LOG_ERR, "select(): %s", strerror(errno));
goto finish;
}
//daemon_log(LOG_INFO, "select()");
for(c = rbus->srv->conn; c; c = c->next) {
if(c->read && FD_ISSET(c->fd, &qfds)) {
c->read(c);
}
}
if (FD_ISSET(nlapi_fd, &qfds)) {
if (nlapi_work(0) < 0)
goto finish;
}
for(iface = interface; iface; iface=iface->next) {
if(! is_iface_available(netlink, iface->name)) {
drop_interface(iface);
continue;
}
detect_beat(netlink, iface);
status_change(iface);
}
if (FD_ISSET(sigfd, &qfds)) {
int sig;
if ((sig = daemon_signal_next()) < 0) {
daemon_log(LOG_ERR, "daemon_signal_next(): %s", strerror(errno));
goto finish;
}
switch (sig) {
case SIGINT:
case SIGTERM:
goto cleanup;
case SIGQUIT:
goto finish;
case SIGCHLD:
break;
case SIGHUP:
break;
default:
daemon_log(LOG_INFO, "Ignoring unknown signal %s", strsignal(sig));
break;
}
}
}
cleanup:
finish:
if (netlink >= 0)
close(netlink);
nlapi_close();
daemon_pid_file_remove();
daemon_signal_done();
daemon_log(LOG_INFO, "Exiting.");
}
void work(void) {
interface_status_t status;
int fd = -1;
fd_set fds;
int sigfd;
time_t t = 0;
int send_retval = 1;
int paused = 0;
static char log_ident[256];
snprintf(log_ident, sizeof(log_ident), "ifplugd(%s)", interface);
daemon_log_ident = log_ident;
daemon_log(LOG_INFO, "ifplugd "VERSION" initializing%s.", use_ifmonitor ? ", using NETLINK device monitoring" : "");
if (daemon_pid_file_create() < 0) {
daemon_log(LOG_ERR, "Could not create PID file %s.", daemon_pid_file_proc());
goto finish;
}
if (daemon_signal_init(SIGINT, SIGTERM, SIGQUIT, SIGHUP, SIGCHLD, SIGUSR1, SIGUSR2, -1) < 0) {
daemon_log(LOG_ERR, "Could not register signal handler: %s", strerror(errno));
goto finish;
}
switch (api_mode) {
case API_ETHTOOL: detect_beat_func = interface_detect_beat_ethtool; break;
case API_MII: detect_beat_func = interface_detect_beat_mii; break;
case API_PRIVATE: detect_beat_func = interface_detect_beat_priv; break;
case API_WLAN: detect_beat_func = interface_detect_beat_wlan; break;
case API_IFF: detect_beat_func = interface_detect_beat_iff; break;
default:
detect_beat_func = detect_beat_auto;
interface_do_message = 0;
break;
}
if ((fd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) {
daemon_log(LOG_ERR, "socket(): %s", strerror(errno));
goto finish;
}
if (use_ifmonitor) {
int b;
if ((b = is_iface_available(fd, interface)) < 0) {
daemon_log(LOG_ERR, "Failed to check interface availabilty!");
goto finish;
}
disabled = !b;
if (nlapi_open(RTMGRP_LINK) < 0)
goto finish;
if (ifmonitor_init(ifmonitor_cb) < 0)
goto finish;
} else
disabled = 0;
if (!disabled) {
if (welcome_iface(fd, interface) < 0)
goto finish;
}
if ((status = detect_beat(fd, interface)) == IFSTATUS_ERR)
goto finish;
daemon_log(LOG_INFO, "Initialization complete, link beat %sdetected%s.", status == IFSTATUS_UP ? "" : "not ", use_ifmonitor ? (disabled ? ", interface disabled" : ", interface enabled") : "");
beep(status == IFSTATUS_UP ? 0 : 1);
if ((!no_startup_script && status == IFSTATUS_UP) || initial_down)
if (action(status) < 0)
goto finish;
if (send_retval && daemonize && wait_on_fork) {
char c = status == IFSTATUS_UP ? 2 : (status == IFSTATUS_DOWN ? 3 : 1);
daemon_retval_send(c);
send_retval = 0;
}
FD_ZERO(&fds);
sigfd = daemon_signal_fd();
FD_SET(sigfd, &fds);
if (use_ifmonitor)
FD_SET(nlapi_fd, &fds);
for (;;) {
interface_status_t s;
fd_set qfds = fds;
int d;
struct timeval tv;
tv.tv_sec = polltime;
tv.tv_usec = 0;
if (select(FD_SETSIZE, &qfds, NULL, NULL, &tv) < 0) {
if (errno == EINTR)
continue;
daemon_log(LOG_ERR, "select(): %s", strerror(errno));
goto finish;
}
//daemon_log(LOG_INFO, "select()");
d = disabled;
s = status;
if (use_ifmonitor) {
if (FD_ISSET(nlapi_fd, &qfds)) {
if (nlapi_work(0) < 0)
goto finish;
}
if (d && !disabled) {
daemon_log(LOG_INFO, "Interface enabled");
welcome_iface(fd, interface);
status = IFSTATUS_DOWN;
}
if (!d && disabled) {
daemon_log(LOG_INFO, "Interface disabled");
status = IFSTATUS_DOWN;
}
}
if (!paused && !disabled) {
//daemon_log(LOG_INFO, "detect");
if ((status = detect_beat(fd, interface)) == IFSTATUS_ERR) {
if (!use_ifmonitor)
goto finish;
status = IFSTATUS_DOWN;
}
}
if (status != s) {
daemon_log(LOG_INFO, "Link beat %s.", status == IFSTATUS_DOWN ? "lost" : "detected");
beep(status == IFSTATUS_UP ? 0 : 1);
if (t)
t = 0;
else {
t = time(NULL);
if (status == IFSTATUS_UP)
t += delay_up;
if (status == IFSTATUS_DOWN)
t += delay_down;
}
}
if (FD_ISSET(sigfd, &qfds)) {
int sig;
if ((sig = daemon_signal_next()) < 0) {
daemon_log(LOG_ERR, "daemon_signal_next(): %s", strerror(errno));
goto finish;
}
switch (sig) {
case SIGINT:
case SIGTERM:
goto cleanup;
case SIGQUIT:
goto finish;
case SIGCHLD:
break;
case SIGHUP:
daemon_log(LOG_INFO, "SIGHUP: %s, link detected on %s: %s", paused ? "Suspended" : "Running", interface, status == IFSTATUS_DOWN ? "no" : "yes");
if (use_ifmonitor)
daemon_log(LOG_INFO, "SIGHUP: Interface %s", disabled ? "disabled" : "enabled");
break;
case SIGUSR1:
daemon_log(LOG_INFO, "SIGUSR1: Daemon suspended (#%i)", ++paused);
break;
case SIGUSR2:
if (paused > 0) {
daemon_log(LOG_INFO, "SIGUSR2: Daemon resumed (#%i)", paused);
paused --;
}
break;
default:
daemon_log(LOG_INFO, "Ignoring unknown signal %s", strsignal(sig));
break;
}
}
if (t && t < time(NULL)) {
t = 0;
if (action(status) < 0)
goto finish;
}
}
cleanup:
if (!no_shutdown_script && (status == IFSTATUS_UP || (status == IFSTATUS_DOWN && t))) {
setenv(IFPLUGD_ENV_PREVIOUS, strstatus(status), 1);
setenv(IFPLUGD_ENV_CURRENT, strstatus(-1), 1);
action(IFSTATUS_DOWN);
beep(1);
}
finish:
if (fd >= 0)
close(fd);
if (use_ifmonitor)
nlapi_close();
if (send_retval && daemonize && wait_on_fork)
daemon_retval_send(255);
daemon_pid_file_remove();
daemon_signal_done();
daemon_log(LOG_INFO, "Exiting.");
}
