#include <config.h>
#endif
-#include <stdarg.h>
#include <sys/types.h>
#define LIBUDEV_I_KNOW_THE_API_IS_SUBJECT_TO_CHANGE
#include "connman.h"
-#ifdef NEED_UDEV_MONITOR_RECEIVE_DEVICE
-static struct udev_device *udev_monitor_receive_device(struct udev_monitor *monitor);
+#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 udev_monitor_get_device(monitor);
+ return -EINVAL;
}
#endif
-#ifdef NEED_UDEV_DEVICE_GET_ACTION
-static const char *udev_device_get_action(struct udev_device *device)
+#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, "RFKILL") == 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, "INTERFACE") == TRUE ||
+ g_str_equal(name, "IFINDEX") == 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)
{
if (action == NULL)
goto done;
- connman_debug("=== %s ===", action);
+ 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 -1;
}
+ enumerate_devices(udev_ctx);
+
fd = udev_monitor_get_fd(udev_mon);
channel = g_io_channel_unix_new(fd);
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;
projects / connman / blobdiff