/* * * BlueZ - Bluetooth protocol stack for Linux * * Copyright (C) 2004-2009 Marcel Holtmann <marcel@holtmann.org> * * * 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 <config.h> #endif #include <errno.h> #include <stdio.h> #include <fcntl.h> #include <unistd.h> #include <stdint.h> #include <stdlib.h> #include <string.h> #include <glib.h> #include "logging.h" #include "manager.h" #include "adapter.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]; gsize len; GIOError err; int fd, id; if (cond & (G_IO_NVAL | G_IO_HUP | G_IO_ERR)) return FALSE; memset(buf, 0, sizeof(buf)); err = g_io_channel_read(chan, (gchar *) buf, sizeof(buf), &len); if (err) { if (err == G_IO_ERROR_AGAIN) return TRUE; return FALSE; } if (len != sizeof(struct rfkill_event)) return TRUE; debug("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; debug("RFKILL unblock for hci%d", id); btd_adapter_restore_powered(adapter); return TRUE; } static GIOChannel *channel = NULL; void rfkill_init(void) { int fd; 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); g_io_add_watch(channel, G_IO_IN | G_IO_NVAL | G_IO_HUP | G_IO_ERR, rfkill_event, NULL); } void rfkill_exit(void) { if (!channel) return; g_io_channel_shutdown(channel, TRUE, NULL); g_io_channel_unref(channel); channel = NULL; }