X-Git-Url: http://www.chiark.greenend.org.uk/ucgi/~ianmdlvl/git?p=elogind.git;a=blobdiff_plain;f=udevsend.c;h=4b6ef5c2f3b7f8929678d85ecd6524cf07113765;hp=0a305e50c4bf214f1dfb5b66500eee888b62ed62;hb=0d1956de0eb112271a1d0d6e189ace3714bf0872;hpb=2a25816ff0079247d7f868621951739e6d58c885 diff --git a/udevsend.c b/udevsend.c index 0a305e50c..4b6ef5c2f 100644 --- a/udevsend.c +++ b/udevsend.c @@ -23,53 +23,44 @@ */ #include -#include -#include +#include +#include +#include #include #include #include +#include #include #include #include -#include +#include #include "udev.h" +#include "udev_version.h" #include "udevd.h" #include "logging.h" -static inline char *get_action(void) +#ifdef LOG +unsigned char logname[42]; +void log_message (int level, const char *format, ...) { - 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) -{ - char *seqnum; + va_list args; - seqnum = getenv("SEQNUM"); - return seqnum; + va_start(args, format); + vsyslog(level, format, args); + va_end(args); } +#endif static int build_hotplugmsg(struct hotplug_msg *msg, char *action, char *devpath, char *subsystem, int seqnum) { - memset(msg, 0x00, sizeof(msg)); - msg->mtype = HOTPLUGMSGTYPE; + memset(msg, 0x00, sizeof(*msg)); + strfieldcpy(msg->magic, UDEV_MAGIC); msg->seqnum = seqnum; - strncpy(msg->action, action, 8); - strncpy(msg->devpath, devpath, 128); - strncpy(msg->subsystem, subsystem, 16); + strfieldcpy(msg->action, action); + strfieldcpy(msg->devpath, devpath); + strfieldcpy(msg->subsystem, subsystem); return sizeof(struct hotplug_msg); } @@ -88,7 +79,7 @@ static int start_daemon(void) /* daemon */ setsid(); chdir("/"); - execl(UDEVD_EXEC, "udevd", NULL); + execl(UDEVD_BIN, "udevd", NULL); dbg("exec of daemon failed"); exit(1); case -1: @@ -107,82 +98,104 @@ static int start_daemon(void) return 0; } - 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 retval = 1; int size; int loop; struct timespec tspec; + int sock; + struct sockaddr_un saddr; + socklen_t addrlen; + int started_daemon = 0; + +#ifdef DEBUG + init_logging("udevsend"); +#endif + dbg("version %s", UDEV_VERSION); - subsystem = argv[1]; + 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(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"); + if (seqnum == NULL) + seq = -1; + else + seq = atoi(seqnum); + dbg("SEQNUM = '%d'", seq); + + sock = socket(AF_LOCAL, SOCK_DGRAM, 0); + if (sock == -1) { + dbg("error getting socket"); goto exit; } - /* send ipc message to the daemon */ - retval = msgsnd(msgid, &message, size, 0); - if (retval == -1) { - dbg("error sending ipc message"); - goto exit; - } + memset(&saddr, 0x00, sizeof(saddr)); + 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; - /* get state of ipc queue */ - tspec.tv_sec = 0; - tspec.tv_nsec = 10000000; /* 10 millisec */ - loop = 30; + size = build_hotplugmsg(&msg, action, devpath, subsystem, seq); + + /* 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"); - goto exit; + retval = sendto(sock, &msg, size, 0, (struct sockaddr *)&saddr, addrlen); + if (retval != -1) { + retval = 0; + goto close_and_exit; + } + + if (errno != ECONNREFUSED) { + dbg("error sending message"); + goto close_and_exit; + } + + if (!started_daemon) { + dbg("connect failed, try starting daemon..."); + retval = start_daemon(); + if (retval) { + dbg("error starting daemon"); + goto exit; + } + + 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); } - if (msg_queue.msg_qnum == 0) - goto exit; - nanosleep(&tspec, NULL); } - - info("message is still in the ipc queue, starting daemon..."); - retval = start_daemon(); - + +close_and_exit: + close(sock); exit: return retval; }