udev_multiplex.c

   1 /*
   2  * udev_multiplex.c directory multiplexer
   3  *
   4  * Copyright (C) 2004 Greg Kroah-Hartman <greg@kroah.com>
   5  *
   6  *      This program is free software; you can redistribute it and/or modify it
   7  *      under the terms of the GNU General Public License as published by the
   8  *      Free Software Foundation version 2 of the License.
   9  */
  10
  11 /*
  12  * This essentially emulates the following shell script logic in C:
  13  *      DIR="/etc/dev.d"
  14  *      export DEVNAME="whatever_dev_name_udev_just_gave"
  15  *      for I in "${DIR}/$DEVNAME/"*.dev "${DIR}/$1/"*.dev "${DIR}/default/"*.dev ; do
  16  *              if [ -f $I ]; then $I $1 ; fi
  17  *      done
  18  *      exit 1;
  19  */
  20
  21 #include <stdio.h>
  22 #include <stdlib.h>
  23 #include <string.h>
  24 #include <sys/types.h>
  25 #include <sys/wait.h>
  26 #include <sys/stat.h>
  27 #include <unistd.h>
  28 #include <fcntl.h>
  29
  30 #include "udev.h"
  31 #include "udev_utils.h"
  32 #include "logging.h"
  33
  34 static int run_program(const char *filename, void *data)
  35 {
  36         pid_t pid;
  37         int fd;
  38         struct udevice *udev = data;
  39
  40         dbg("running %s", filename);
  41
  42         pid = fork();
  43         switch (pid) {
  44         case 0:
  45                 /* child */
  46                 fd = open("/dev/null", O_RDWR);
  47                 if ( fd >= 0) {
  48                         dup2(fd, STDOUT_FILENO);
  49                         dup2(fd, STDIN_FILENO);
  50                         dup2(fd, STDERR_FILENO);
  51                 }
  52                 close(fd);
  53
  54                 execl(filename, filename, udev->subsystem, NULL);
  55                 dbg("exec of child failed");
  56                 _exit(1);
  57         case -1:
  58                 dbg("fork of child failed");
  59                 break;
  60                 return -1;
  61         default:
  62                 waitpid(pid, NULL, 0);
  63         }
  64
  65         return 0;
  66 }
  67
  68 /*
  69  * runs files in these directories in order:
  70  *      <node name given by udev>/
  71  *      subsystem/
  72  *      default/
  73  */
  74 void udev_multiplex_directory(struct udevice *udev, const char *basedir, const char *suffix)
  75 {
  76         char dirname[PATH_MAX];
  77
  78         /* chop the device name up into pieces based on '/' */
  79         if (udev->name[0] != '\0') {
  80                 char devname[NAME_SIZE];
  81                 char *temp;
  82
  83                 strfieldcpy(devname, udev->name);
  84                 temp = strchr(devname, '/');
  85                 while (temp != NULL) {
  86                         temp[0] = '\0';
  87
  88                         /* don't call the subsystem directory here */
  89                         if (strcmp(devname, udev->subsystem) != 0) {
  90                                 snprintf(dirname, PATH_MAX, "%s/%s", basedir, devname);
  91                                 dirname[PATH_MAX-1] = '\0';
  92                                 call_foreach_file(run_program, dirname, suffix, udev);
  93                         }
  94
  95                         temp[0] = '/';
  96                         ++temp;
  97                         temp = strchr(temp, '/');
  98                 }
  99         }
 100
 101         if (udev->name[0] != '\0') {
 102                 snprintf(dirname, PATH_MAX, "%s/%s", basedir, udev->name);
 103                 dirname[PATH_MAX-1] = '\0';
 104                 call_foreach_file(run_program, dirname, suffix, udev);
 105         }
 106
 107         if (udev->subsystem[0] != '\0') {
 108                 snprintf(dirname, PATH_MAX, "%s/%s", basedir, udev->subsystem);
 109                 dirname[PATH_MAX-1] = '\0';
 110                 call_foreach_file(run_program, dirname, suffix, udev);
 111         }
 112
 113         snprintf(dirname, PATH_MAX, "%s/default", basedir);
 114         dirname[PATH_MAX-1] = '\0';
 115         call_foreach_file(run_program, dirname, suffix, udev);
 116 }