/* * * Connection Manager * * Copyright (C) 2007-2009 Intel Corporation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA * */ #ifdef HAVE_CONFIG_H #include #endif #include #define LIBUDEV_I_KNOW_THE_API_IS_SUBJECT_TO_CHANGE #include #include #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, "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) { 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); }