src/rfkill.c

   1 /*
   2  *
   3  *  BlueZ - Bluetooth protocol stack for Linux
   4  *
   5  *  Copyright (C) 2004-2009  Marcel Holtmann <marcel@holtmann.org>
   6  *
   7  *
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License as published by
  10  *  the Free Software Foundation; either version 2 of the License, or
  11  *  (at your option) any later version.
  12  *
  13  *  This program is distributed in the hope that it will be useful,
  14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License
  19  *  along with this program; if not, write to the Free Software
  20  *  Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
  21  *
  22  */
  23
  24 #ifdef HAVE_CONFIG_H
  25 #include <config.h>
  26 #endif
  27
  28 #include <errno.h>
  29 #include <stdio.h>
  30 #include <fcntl.h>
  31 #include <unistd.h>
  32 #include <stdint.h>
  33 #include <stdlib.h>
  34 #include <string.h>
  35
  36 #include <glib.h>
  37
  38 #include "logging.h"
  39 #include "manager.h"
  40 #include "adapter.h"
  41 #include "hcid.h"
  42
  43 enum rfkill_type {
  44         RFKILL_TYPE_ALL = 0,
  45         RFKILL_TYPE_WLAN,
  46         RFKILL_TYPE_BLUETOOTH,
  47         RFKILL_TYPE_UWB,
  48         RFKILL_TYPE_WIMAX,
  49         RFKILL_TYPE_WWAN,
  50 };
  51
  52 enum rfkill_operation {
  53         RFKILL_OP_ADD = 0,
  54         RFKILL_OP_DEL,
  55         RFKILL_OP_CHANGE,
  56         RFKILL_OP_CHANGE_ALL,
  57 };
  58
  59 struct rfkill_event {
  60         uint32_t idx;
  61         uint8_t  type;
  62         uint8_t  op;
  63         uint8_t  soft;
  64         uint8_t  hard;
  65 };
  66
  67 static gboolean rfkill_event(GIOChannel *chan,
  68                                 GIOCondition cond, gpointer data)
  69 {
  70         unsigned char buf[32];
  71         struct rfkill_event *event = (void *) buf;
  72         struct btd_adapter *adapter;
  73         char sysname[PATH_MAX];
  74         gsize len;
  75         GIOError err;
  76         int fd, id;
  77
  78         if (cond & (G_IO_NVAL | G_IO_HUP | G_IO_ERR))
  79                 return FALSE;
  80
  81         memset(buf, 0, sizeof(buf));
  82
  83         err = g_io_channel_read(chan, (gchar *) buf, sizeof(buf), &len);
  84         if (err) {
  85                 if (err == G_IO_ERROR_AGAIN)
  86                         return TRUE;
  87                 return FALSE;
  88         }
  89
  90         if (len != sizeof(struct rfkill_event))
  91                 return TRUE;
  92
  93         debug("RFKILL event idx %u type %u op %u soft %u hard %u",
  94                                         event->idx, event->type, event->op,
  95                                                 event->soft, event->hard);
  96
  97         if (event->soft || event->hard)
  98                 return TRUE;
  99
 100         if (event->op != RFKILL_OP_CHANGE)
 101                 return TRUE;
 102
 103         if (event->type != RFKILL_TYPE_BLUETOOTH &&
 104                                         event->type != RFKILL_TYPE_ALL)
 105                 return TRUE;
 106
 107         snprintf(sysname, sizeof(sysname) - 1,
 108                         "/sys/class/rfkill/rfkill%u/name", event->idx);
 109
 110         fd = open(sysname, O_RDONLY);
 111         if (fd < 0)
 112                 return TRUE;
 113
 114         memset(sysname, 0, sizeof(sysname));
 115
 116         if (read(fd, sysname, sizeof(sysname)) < 4) {
 117                 close(fd);
 118                 return TRUE;
 119         }
 120
 121         close(fd);
 122
 123         if (g_str_has_prefix(sysname, "hci") == FALSE)
 124                 return TRUE;
 125
 126         id = atoi(sysname + 3);
 127         if (id < 0)
 128                 return TRUE;
 129
 130         adapter = manager_find_adapter_by_id(id);
 131         if (!adapter)
 132                 return TRUE;
 133
 134         debug("RFKILL unblock for hci%d", id);
 135
 136         return TRUE;
 137 }
 138
 139 static GIOChannel *channel = NULL;
 140
 141 void rfkill_init(void)
 142 {
 143         int fd;
 144
 145         if (!main_opts.remember_powered)
 146                 return;
 147
 148         fd = open("/dev/rfkill", O_RDWR);
 149         if (fd < 0) {
 150                 error("Failed to open RFKILL control device");
 151                 return;
 152         }
 153
 154         channel = g_io_channel_unix_new(fd);
 155         g_io_channel_set_close_on_unref(channel, TRUE);
 156
 157         g_io_add_watch(channel, G_IO_IN | G_IO_NVAL | G_IO_HUP | G_IO_ERR,
 158                                                         rfkill_event, NULL);
 159 }
 160
 161 void rfkill_exit(void)
 162 {
 163         if (!channel)
 164                 return;
 165
 166         g_io_channel_shutdown(channel, TRUE, NULL);
 167         g_io_channel_unref(channel);
 168
 169         channel = NULL;
 170 }