/*
*
* 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 "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;
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;
}