diff options
Diffstat (limited to 'src/rfkill.c')
-rw-r--r-- | src/rfkill.c | 173 |
1 files changed, 173 insertions, 0 deletions
diff --git a/src/rfkill.c b/src/rfkill.c new file mode 100644 index 0000000..b40c6e7 --- /dev/null +++ b/src/rfkill.c @@ -0,0 +1,173 @@ +/* + * + * BlueZ - Bluetooth protocol stack for Linux + * + * Copyright (C) 2004-2010 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 "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 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; +} |