X-Git-Url: http://www.chiark.greenend.org.uk/ucgi/~ianmdlvl/git?p=elogind.git;a=blobdiff_plain;f=udevsend.c;h=883181c1b69dfe496677c942ac483d7a67c404ce;hp=bdc8293df7a2d495d63071469b605240942fdd82;hb=74d2a1d53024d10145dc1e9e5e6124d9d14e9fbe;hpb=71c077fb0a9f7222f5363ebc1c67d48d7a2f5ff8 diff --git a/udevsend.c b/udevsend.c index bdc8293df..883181c1b 100644 --- a/udevsend.c +++ b/udevsend.c @@ -23,54 +23,35 @@ */ #include -#include -#include +#include +#include +#include +#include #include #include #include +#include #include #include -#include -#include +#include #include "udev.h" +#include "udev_lib.h" +#include "udev_version.h" #include "udevd.h" #include "logging.h" -static inline char *get_action(void) -{ - char *action; - - action = getenv("ACTION"); - return action; -} - -static inline char *get_devpath(void) -{ - char *devpath; - - devpath = getenv("DEVPATH"); - return devpath; -} - -static inline char *get_seqnum(void) +#ifdef LOG +unsigned char logname[LOGNAME_SIZE]; +void log_message (int level, const char *format, ...) { - char *seqnum; - - seqnum = getenv("SEQNUM"); - return seqnum; -} + va_list args; -static int build_hotplugmsg(struct hotplug_msg *msg, char *action, - char *devpath, char *subsystem, int seqnum) -{ - msg->mtype = HOTPLUGMSGTYPE; - msg->seqnum = seqnum; - strncpy(msg->action, action, 8); - strncpy(msg->devpath, devpath, 128); - strncpy(msg->subsystem, subsystem, 16); - return sizeof(struct hotplug_msg); + va_start(args, format); + vsyslog(level, format, args); + va_end(args); } +#endif static int start_daemon(void) { @@ -85,7 +66,9 @@ static int start_daemon(void) switch (child_pid) { case 0: /* daemon */ - execl(DEFAULT_UDEVD_EXEC, NULL); + setsid(); + chdir("/"); + execl(UDEVD_BIN, "udevd", NULL); dbg("exec of daemon failed"); exit(1); case -1: @@ -99,87 +82,140 @@ static int start_daemon(void) dbg("fork of helper failed"); return -1; default: - wait(0); + wait(NULL); } return 0; } +static void run_udev(const char *subsystem) +{ + pid_t pid; + + pid = fork(); + switch (pid) { + case 0: + /* child */ + execl(UDEV_BIN, "udev", subsystem, NULL); + dbg("exec of child failed"); + exit(1); + break; + case -1: + dbg("fork of child failed"); + break; + default: + wait(NULL); + } +} int main(int argc, char* argv[]) { - int msgid; - key_t key; - struct msqid_ds msg_queue; - struct hotplug_msg message; + struct hotplug_msg msg; char *action; char *devpath; char *subsystem; char *seqnum; - int seq; - int retval = -EINVAL; - int size; + unsigned long long seq; + int retval = 1; int loop; struct timespec tspec; + int sock = -1; + struct sockaddr_un saddr; + socklen_t addrlen; + int started_daemon = 0; - subsystem = argv[1]; + logging_init("udevsend"); + dbg("version %s", UDEV_VERSION); + + subsystem = get_subsystem(argv[1]); if (subsystem == NULL) { dbg("no subsystem"); goto exit; } + dbg("subsystem = '%s'", subsystem); devpath = get_devpath(); if (devpath == NULL) { dbg("no devpath"); goto exit; } + dbg("DEVPATH = '%s'", devpath); action = get_action(); if (action == NULL) { dbg("no action"); goto exit; } + dbg("ACTION = '%s'", action); seqnum = get_seqnum(); - if (seqnum == NULL) { - dbg("no seqnum"); - goto exit; - } - seq = atoi(seqnum); - - /* create ipc message queue or get id of our existing one */ - key = ftok(DEFAULT_UDEVD_EXEC, IPC_KEY_ID); - size = build_hotplugmsg(&message, action, devpath, subsystem, seq); - msgid = msgget(key, IPC_CREAT); - if (msgid == -1) { - dbg("error open ipc queue"); - goto exit; + if (seqnum == NULL) + seq = 0; + else + seq = strtoull(seqnum, NULL, 10); + dbg("SEQNUM = '%llu'", seq); + + sock = socket(AF_LOCAL, SOCK_DGRAM, 0); + if (sock == -1) { + dbg("error getting socket"); + goto fallback; } - /* send ipc message to the daemon */ - retval = msgsnd(msgid, &message, size, 0); - if (retval == -1) { - dbg("error sending ipc message"); - goto exit; - } + set_cloexec_flag(sock, 1); + + memset(&saddr, 0x00, sizeof(struct sockaddr_un)); + saddr.sun_family = AF_LOCAL; + /* use abstract namespace for socket path */ + strcpy(&saddr.sun_path[1], UDEVD_SOCK_PATH); + addrlen = offsetof(struct sockaddr_un, sun_path) + strlen(saddr.sun_path+1) + 1; + + memset(&msg, 0x00, sizeof(struct hotplug_msg)); + strcpy(msg.magic, UDEV_MAGIC); + msg.seqnum = seq; + strfieldcpy(msg.action, action); + strfieldcpy(msg.devpath, devpath); + strfieldcpy(msg.subsystem, subsystem); - /* get state of ipc queue */ - tspec.tv_sec = 0; - tspec.tv_nsec = 10000000; /* 10 millisec */ - loop = 20; + /* If we can't send, try to start daemon and resend message */ + loop = UDEVSEND_CONNECT_RETRY; while (loop--) { - retval = msgctl(msgid, IPC_STAT, &msg_queue); - if (retval == -1) { - dbg("error getting info on ipc queue"); + retval = sendto(sock, &msg, sizeof(struct hotplug_msg), 0, + (struct sockaddr *)&saddr, addrlen); + if (retval != -1) { + retval = 0; goto exit; } - if (msg_queue.msg_qnum == 0) - goto exit; - nanosleep(&tspec, NULL); + + if (errno != ECONNREFUSED) { + dbg("error sending message"); + goto fallback; + } + + if (!started_daemon) { + info("starting udevd daemon"); + retval = start_daemon(); + if (retval) { + info("error starting daemon"); + goto fallback; + } + dbg("daemon started"); + started_daemon = 1; + } else { + dbg("retry to connect %d", UDEVSEND_CONNECT_RETRY - loop); + tspec.tv_sec = 0; + tspec.tv_nsec = 100000000; /* 100 millisec */ + nanosleep(&tspec, NULL); + } } - info("message is still in the ipc queue, starting daemon..."); - retval = start_daemon(); +fallback: + info("unable to connect to event daemon, try to call udev directly"); + run_udev(subsystem); exit: + if (sock != -1) + close(sock); + + logging_close(); + return retval; }