initial commit of version 0.0.5c

1 files changed, 220 insertions, 0 deletions

diff --git a/monitor.c b/monitor.c
new file mode 100644
index 0000000..ff9392c
--- /dev/null
+++ b/monitor.c
@@ -0,0 +1,220 @@
+#include "monitor.h"
+#include "dynamicdevice.h"
+#include <unistd.h>
+
+// --- cUdevMonitor ----------------------------------------------------------
+
+cMutex cUdevMonitor::mutexMonitors;
+int cUdevMonitor::numMonitors = 0;
+cUdevMonitor *cUdevMonitor::monitors[MAXUDEVMONITORS] = { NULL };
+
+cUdevMonitor *cUdevMonitor::Get(const char *Subsystem)
+{
+  cMutexLock lock(&mutexMonitors);
+  int i = 0;
+  while (i < numMonitors) {
+        if (monitors[i]) {
+            if ((Subsystem == NULL) && (*monitors[i]->subsystem == NULL))
+               return monitors[i];
+            if ((Subsystem != NULL)
+                && (*monitors[i]->subsystem != NULL)
+                && (strcmp(*monitors[i]->subsystem, Subsystem) == 0))
+               return monitors[i];
+           }
+        i++;
+        }
+  if (i < MAXUDEVMONITORS) {
+     numMonitors++;
+     cUdevMonitor *m = new cUdevMonitor(Subsystem);
+     m->index = i;
+     monitors[i] = m;
+     return m;
+     }
+  return NULL;
+}
+
+bool cUdevMonitor::AddFilter(const char *Subsystem, cUdevFilter *Filter)
+{
+  if (Filter == NULL)
+     return false;
+  cUdevMonitor *m = Get(Subsystem);
+  if (m == NULL) {
+     delete Filter;
+     return false;
+     }
+  if (!m->AddFilter(Filter)) {
+     delete Filter;
+     return false;
+     }
+  return true;
+}
+
+void cUdevMonitor::ShutdownAllMonitors(void)
+{
+  cMutexLock lock(&mutexMonitors);
+  for (int i = 0; i < numMonitors; i++) {
+      if (monitors[i]) {
+         delete monitors[i];
+         monitors[i] = NULL;
+         }
+      }
+}
+
+cUdevMonitor::cUdevMonitor(const char *Subsystem)
+:monitor(NULL)
+,index(-1)
+,subsystem(Subsystem)
+{
+  struct udev *udev = cUdev::Init();
+  if (udev) {
+     monitor = udev_monitor_new_from_netlink(udev, "udev");
+     if (monitor && Subsystem)
+        udev_monitor_filter_add_match_subsystem_devtype(monitor, Subsystem, NULL);
+     }
+  SetDescription("dynamite udev monitor for subsystem %s", Subsystem);
+}
+
+cUdevMonitor::~cUdevMonitor(void)
+{
+  if ((index >= 0) && (index < MAXUDEVMONITORS)) {
+     cMutexLock lock(&mutexMonitors);
+     if (monitors[index] == this)
+        monitors[index] = NULL;
+     }
+  Cancel(3);
+  filters.Clear();
+  if (monitor)
+     udev_monitor_unref(monitor);
+  monitor = NULL;
+}
+
+#define MONITOR_POLL_INTERVAL_MS 500
+
+void cUdevMonitor::Action(void)
+{
+  if (monitor == NULL)
+     return;
+  udev_monitor_enable_receiving(monitor);
+  int fd = udev_monitor_get_fd(monitor);
+  if (fd == 0)
+     return;
+  fd_set fds;
+  struct timeval tv;
+  while (Running()) {
+        FD_ZERO(&fds);
+        FD_SET(fd, &fds);
+        tv.tv_sec = 0;
+        tv.tv_usec = MONITOR_POLL_INTERVAL_MS * 1000;
+        int ret = select(fd+1, &fds, NULL, NULL, &tv);
+        if (!Running())
+           break;
+        if ((ret > 0) && FD_ISSET(fd, &fds)) {
+           udev_device *dev = udev_monitor_receive_device(monitor);
+           if (dev) {
+              cMutexLock lock(&filtersMutex);
+              cUdevDevice d(dev);
+              for (cUdevFilter *f = filters.First(); f; f = filters.Next(f))
+                  f->Process(d);
+              }
+           }
+        }
+  close(fd);
+}
+
+bool cUdevMonitor::AddFilter(cUdevFilter *Filter)
+{
+  if (monitor == NULL)
+     return false;
+  if (Filter == NULL)
+     return false;
+  if (Filter->monitor == this)
+     return true;
+  if (Filter->monitor != NULL)
+     return false;
+  cMutexLock lock(&filtersMutex);
+  Filter->monitor = this;
+  filters.Add(Filter);
+  if (!Running())
+     Start();
+  return true;
+}
+
+bool cUdevMonitor::DelFilter(cUdevFilter *Filter)
+{
+  if (monitor == NULL)
+     return false;
+  if (Filter == NULL)
+     return false;
+  if (Filter->monitor != this)
+     return false;
+  cMutexLock lock(&filtersMutex);
+  filters.Del(Filter);
+  Filter->monitor = NULL;
+  if (filters.Count() == 0)
+     Cancel(3);
+  return true;
+}
+
+// --- cUdevFilter -----------------------------------------------------------
+
+cUdevFilter::cUdevFilter(void)
+:monitor(NULL)
+{
+}
+
+cUdevFilter::~cUdevFilter(void)
+{
+}
+
+// --- cUdevLogFilter --------------------------------------------------------
+
+static void InternLogProcess(int Level, cUdevDevice &Device)
+{
+  char *indent = new char[Level + 2];
+  indent[0] = '+';
+  int i = 0;
+  while (i < Level) {
+        indent[i + 1] = '-';
+        i++;
+        }
+  indent[i + 1] = '\0';
+  const char *action = Device.GetAction();
+  const char *subsystem = Device.GetPropertyValue("SUBSYSTEM");
+  const char *syspath = Device.GetSyspath();
+  const char *devpath = Device.GetPropertyValue("DEVPATH");
+  const char *devname = Device.GetPropertyValue("DEVNAME");
+  isyslog("dynamite: udev: %s action=%s, subsystem=%s, syspath=%s, devpath=%s, devname=%s", indent, action, subsystem, syspath, devpath, devname);
+  cUdevListEntry *devlink = Device.GetDevlinksList();
+  while (devlink) {
+        isyslog("dynamite: udev: %s devlink: %s", indent, devlink->GetName());
+        cUdevListEntry *tmp = devlink->GetNext();
+        delete devlink;
+        devlink = tmp;
+        }
+  cUdevDevice *parent = Device.GetParent();
+  if (parent != NULL) {
+     InternLogProcess(Level + 1, *parent);
+     delete parent;
+     }
+}
+
+void cUdevLogFilter::Process(cUdevDevice &Device)
+{
+  InternLogProcess(0, Device);
+}
+
+// --- cUdevDvbFilter --------------------------------------------------------
+
+void cUdevDvbFilter::Process(cUdevDevice &Device)
+{
+  const char *action = Device.GetAction();
+  if (action && (strcmp(action, "add") == 0)) {
+     const char *dvb_device_type = Device.GetPropertyValue("DVB_DEVICE_TYPE");
+     if (!dvb_device_type || (strcmp(dvb_device_type, "frontend") != 0))
+        return;
+     const char *devname = Device.GetPropertyValue("DEVNAME");
+     if (!devname || cDynamicDevice::IsAttached(devname))
+        return;
+     cDynamicDeviceProbe::QueueDynamicDeviceCommand(ddpcAttach, devname);
+     }
+}