#include <config.h>
#endif
-#include <stdarg.h>
#include <sys/types.h>
#define LIBUDEV_I_KNOW_THE_API_IS_SUBJECT_TO_CHANGE
#include <libudev.h>
+#include <glib.h>
+
#include "connman.h"
+
+#ifdef NEED_UDEV_ENUMERATE_ADD_MATCH_PROPERTY
+static int udev_enumerate_add_match_property(struct udev_enumerate *enumerate,
+ const char *property, const char *value)
+{
+ return -EINVAL;
+}
+#endif
+
+#ifdef NEED_UDEV_DEVICE_GET_PARENT_WITH_SUBSYSTEM_DEVTYPE
+static struct udev_device *udev_device_get_parent_with_subsystem_devtype(struct udev_device *device,
+ const char *subsystem, const char *devtype)
+{
+ return NULL;
+}
+#endif
+
+static GSList *device_list = NULL;
+
+static struct connman_device *find_device(const char *interface)
+{
+ GSList *list;
+
+ if (interface == NULL)
+ return NULL;
+
+ for (list = device_list; list; list = list->next) {
+ struct connman_device *device = list->data;
+ const char *device_interface;
+
+ device_interface = connman_device_get_interface(device);
+ if (device_interface == NULL)
+ continue;
+
+ if (g_str_equal(device_interface, interface) == TRUE)
+ return device;
+ }
+
+ return NULL;
+}
+
+static void add_device(struct udev_device *udev_device)
+{
+ enum connman_device_type devtype = CONNMAN_DEVICE_TYPE_UNKNOWN;
+ struct connman_device *device;
+ struct udev_list_entry *entry;
+ const char *type = NULL, *interface = NULL;
+
+ DBG("");
+
+ entry = udev_device_get_properties_list_entry(udev_device);
+ while (entry) {
+ const char *name = udev_list_entry_get_name(entry);
+
+ if (g_str_has_prefix(name, "CONNMAN_TYPE") == TRUE)
+ type = udev_list_entry_get_value(entry);
+ else if (g_str_has_prefix(name, "CONNMAN_INTERFACE") == TRUE)
+ interface = udev_list_entry_get_value(entry);
+
+ entry = udev_list_entry_get_next(entry);
+ }
+
+ device = find_device(interface);
+ if (device != NULL)
+ return;
+
+ if (type == NULL || interface == NULL)
+ return;
+
+ if (g_str_equal(interface, "ttyUSB0") == FALSE &&
+ g_str_equal(interface, "noz0") == FALSE)
+ return;
+
+ if (g_str_equal(type, "nozomi") == TRUE)
+ devtype = CONNMAN_DEVICE_TYPE_NOZOMI;
+ else if (g_str_equal(type, "huawei") == TRUE)
+ devtype = CONNMAN_DEVICE_TYPE_HUAWEI;
+ else if (g_str_equal(type, "novatel") == TRUE)
+ devtype = CONNMAN_DEVICE_TYPE_NOVATEL;
+ else
+ return;
+
+ device = connman_device_create(interface, devtype);
+ if (device == NULL)
+ return;
+
+ connman_device_set_mode(device, CONNMAN_DEVICE_MODE_NETWORK_SINGLE);
+ connman_device_set_policy(device, CONNMAN_DEVICE_POLICY_MANUAL);
+
+ connman_device_set_interface(device, interface);
+
+ if (connman_device_register(device) < 0) {
+ connman_device_unref(device);
+ return;
+ }
+
+ device_list = g_slist_append(device_list, device);
+}
+
+static void remove_device(struct udev_device *udev_device)
+{
+ struct connman_device *device;
+ struct udev_list_entry *entry;
+ const char *interface = NULL;
+
+ DBG("");
+
+ entry = udev_device_get_properties_list_entry(udev_device);
+ while (entry) {
+ const char *name = udev_list_entry_get_name(entry);
+
+ if (g_str_has_prefix(name, "CONNMAN_INTERFACE") == TRUE)
+ interface = udev_list_entry_get_value(entry);
+
+ entry = udev_list_entry_get_next(entry);
+ }
+
+ device = find_device(interface);
+ if (device == NULL)
+ return;
+
+ device_list = g_slist_remove(device_list, device);
+
+ connman_device_unregister(device);
+ connman_device_unref(device);
+}
+
+static void print_properties(struct udev_device *device, const char *prefix)
+{
+ struct udev_list_entry *entry;
+
+ entry = udev_device_get_properties_list_entry(device);
+ while (entry) {
+ const char *name = udev_list_entry_get_name(entry);
+ const char *value = udev_list_entry_get_value(entry);
+
+ if (g_str_has_prefix(name, "CONNMAN") == TRUE ||
+ g_str_has_prefix(name, "ID_MODEM") == TRUE ||
+ g_str_equal(name, "ID_VENDOR") == TRUE ||
+ g_str_equal(name, "ID_MODEL") == TRUE ||
+ g_str_equal(name, "DEVNAME") == TRUE ||
+ g_str_equal(name, "DEVPATH") == TRUE)
+ connman_debug("%s%s = %s", prefix, name, value);
+
+ entry = udev_list_entry_get_next(entry);
+ }
+}
+
+static void print_device(struct udev_device *device, const char *action)
+{
+ const char *subsystem, *devtype = NULL;
+ struct udev_device *parent;
+
+ connman_debug("=== %s ===", action);
+ print_properties(device, "");
+
+ parent = udev_device_get_parent(device);
+ if (parent == NULL)
+ return;
+
+ subsystem = udev_device_get_subsystem(parent);
+
+ if (subsystem != NULL &&
+ g_str_equal(subsystem, "usb-serial") == TRUE) {
+ subsystem = "usb";
+ devtype = "usb_device";
+ }
+
+ parent = udev_device_get_parent_with_subsystem_devtype(device,
+ subsystem, devtype);
+ print_properties(parent, " ");
+}
+
+static void enumerate_devices(struct udev *context)
+{
+ struct udev_enumerate *enumerate;
+ struct udev_list_entry *entry;
+
+ enumerate = udev_enumerate_new(context);
+ if (enumerate == NULL)
+ return;
+
+ udev_enumerate_add_match_property(enumerate, "CONNMAN_TYPE", "?*");
+
+ udev_enumerate_scan_devices(enumerate);
+
+ entry = udev_enumerate_get_list_entry(enumerate);
+ while (entry) {
+ const char *syspath = udev_list_entry_get_name(entry);
+ struct udev_device *device;
+
+ device = udev_device_new_from_syspath(context, syspath);
+
+ print_device(device, "coldplug");
+
+ add_device(device);
+
+ udev_device_unref(device);
+
+ entry = udev_list_entry_get_next(entry);
+ }
+
+ udev_enumerate_unref(enumerate);
+}
+
+static gboolean udev_event(GIOChannel *channel,
+ GIOCondition condition, gpointer user_data)
+{
+ struct udev_monitor *monitor = user_data;
+ struct udev_device *device;
+ const char *action;
+
+ device = udev_monitor_receive_device(monitor);
+ if (device == NULL)
+ return TRUE;
+
+ action = udev_device_get_action(device);
+ if (action == NULL)
+ goto done;
+
+ print_device(device, action);
+
+ if (g_str_equal(action, "add") == TRUE)
+ add_device(device);
+ else if (g_str_equal(action, "remove") == TRUE)
+ remove_device(device);
+
+done:
+ udev_device_unref(device);
+
+ return TRUE;
+}
+
+static struct udev *udev_ctx;
+static struct udev_monitor *udev_mon;
+static guint udev_watch = 0;
+
+int __connman_udev_init(void)
+{
+ GIOChannel *channel;
+ int fd;
+
+ DBG("");
+
+ udev_ctx = udev_new();
+ if (udev_ctx == NULL) {
+ connman_error("Failed to create udev context");
+ return -1;
+ }
+
+ udev_mon = udev_monitor_new_from_socket(udev_ctx,
+ "@/org/moblin/connman/udev");
+ if (udev_mon == NULL) {
+ connman_error("Failed to create udev monitor");
+ udev_unref(udev_ctx);
+ udev_ctx = NULL;
+ return -1;
+ }
+
+ if (udev_monitor_enable_receiving(udev_mon) < 0) {
+ connman_error("Failed to enable udev monitor");
+ udev_unref(udev_ctx);
+ udev_ctx = NULL;
+ udev_monitor_unref(udev_mon);
+ return -1;
+ }
+
+ enumerate_devices(udev_ctx);
+
+ fd = udev_monitor_get_fd(udev_mon);
+
+ channel = g_io_channel_unix_new(fd);
+ if (channel == NULL)
+ return 0;
+
+ udev_watch = g_io_add_watch(channel, G_IO_IN, udev_event, udev_mon);
+
+ g_io_channel_unref(channel);
+
+ return 0;
+}
+
+void __connman_udev_cleanup(void)
+{
+ GSList *list;
+
+ DBG("");
+
+ if (udev_watch > 0)
+ g_source_remove(udev_watch);
+
+ for (list = device_list; list; list = list->next) {
+ struct connman_device *device = list->data;
+
+ connman_device_unregister(device);
+ connman_device_unref(device);
+ }
+
+ g_slist_free(device_list);
+ device_list = NULL;
+
+ if (udev_ctx == NULL)
+ return;
+
+ udev_monitor_unref(udev_mon);
+ udev_unref(udev_ctx);
+}