/* * * BlueZ - Bluetooth protocol stack for Linux * * Copyright (C) 2004-2010 Marcel Holtmann * * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * 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 #include #include #include #include #include #include #include #include "log.h" #include "adapter.h" #include "manager.h" #include "hcid.h" enum rfkill_type { RFKILL_TYPE_ALL = 0, RFKILL_TYPE_WLAN, RFKILL_TYPE_BLUETOOTH, RFKILL_TYPE_UWB, RFKILL_TYPE_WIMAX, RFKILL_TYPE_WWAN, }; enum rfkill_operation { RFKILL_OP_ADD = 0, RFKILL_OP_DEL, RFKILL_OP_CHANGE, RFKILL_OP_CHANGE_ALL, }; struct rfkill_event { uint32_t idx; uint8_t type; uint8_t op; uint8_t soft; uint8_t hard; }; static gboolean rfkill_event(GIOChannel *chan, GIOCondition cond, gpointer data) { unsigned char buf[32]; struct rfkill_event *event = (void *) buf; struct btd_adapter *adapter; char sysname[PATH_MAX]; ssize_t len; int fd, id; if (cond & (G_IO_NVAL | G_IO_HUP | G_IO_ERR)) return FALSE; fd = g_io_channel_unix_get_fd(chan); memset(buf, 0, sizeof(buf)); len = read(fd, buf, sizeof(buf)); if (len < 0) { if (errno == EAGAIN) return TRUE; return FALSE; } if (len != sizeof(struct rfkill_event)) return TRUE; DBG("RFKILL event idx %u type %u op %u soft %u hard %u", event->idx, event->type, event->op, event->soft, event->hard); if (event->soft || event->hard) return TRUE; if (event->op != RFKILL_OP_CHANGE) return TRUE; if (event->type != RFKILL_TYPE_BLUETOOTH && event->type != RFKILL_TYPE_ALL) return TRUE; snprintf(sysname, sizeof(sysname) - 1, "/sys/class/rfkill/rfkill%u/name", event->idx); fd = open(sysname, O_RDONLY); if (fd < 0) return TRUE; memset(sysname, 0, sizeof(sysname)); if (read(fd, sysname, sizeof(sysname)) < 4) { close(fd); return TRUE; } close(fd); if (g_str_has_prefix(sysname, "hci") == FALSE) return TRUE; id = atoi(sysname + 3); if (id < 0) return TRUE; adapter = manager_find_adapter_by_id(id); if (!adapter) return TRUE; DBG("RFKILL unblock for hci%d", id); btd_adapter_restore_powered(adapter); return TRUE; } static guint watch = 0; void rfkill_init(void) { int fd; GIOChannel *channel; if (!main_opts.remember_powered) return; fd = open("/dev/rfkill", O_RDWR); if (fd < 0) { error("Failed to open RFKILL control device"); return; } channel = g_io_channel_unix_new(fd); g_io_channel_set_close_on_unref(channel, TRUE); watch = g_io_add_watch(channel, G_IO_IN | G_IO_NVAL | G_IO_HUP | G_IO_ERR, rfkill_event, NULL); g_io_channel_unref(channel); } void rfkill_exit(void) { if (watch == 0) return; g_source_remove(watch); watch = 0; }