bluetooth.c revision 04a1a722bda65ea26fc449a613085909056c1fa2
1/* 2 * Copyright (C) 2008 The Android Open Source Project 3 * 4 * Licensed under the Apache License, Version 2.0 (the "License"); 5 * you may not use this file except in compliance with the License. 6 * You may obtain a copy of the License at 7 * 8 * http://www.apache.org/licenses/LICENSE-2.0 9 * 10 * Unless required by applicable law or agreed to in writing, software 11 * distributed under the License is distributed on an "AS IS" BASIS, 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. 13 * See the License for the specific language governing permissions and 14 * limitations under the License. 15 */ 16 17#define LOG_TAG "bluedroid" 18 19#include <errno.h> 20#include <fcntl.h> 21#include <sys/ioctl.h> 22#include <sys/socket.h> 23#include <sys/types.h> 24#include <sys/stat.h> 25 26#include <cutils/log.h> 27#include <cutils/properties.h> 28 29#include <bluetooth/bluetooth.h> 30#include <bluetooth/hci.h> 31#include <bluetooth/hci_lib.h> 32 33#include <bluedroid/bluetooth.h> 34 35#ifndef HCI_DEV_ID 36#define HCI_DEV_ID 0 37#endif 38 39#define HCID_STOP_DELAY_USEC 500000 40 41#define MIN(x,y) (((x)<(y))?(x):(y)) 42 43 44static int rfkill_id = -1; 45static char *rfkill_state_path = NULL; 46 47 48static int init_rfkill() { 49 char path[64]; 50 char buf[16]; 51 int fd; 52 int sz; 53 int id; 54 for (id = 0; ; id++) { 55 snprintf(path, sizeof(path), "/sys/class/rfkill/rfkill%d/type", id); 56 fd = open(path, O_RDONLY); 57 if (fd < 0) { 58 LOGW("open(%s) failed: %s (%d)\n", path, strerror(errno), errno); 59 return -1; 60 } 61 sz = read(fd, &buf, sizeof(buf)); 62 close(fd); 63 if (sz >= 9 && memcmp(buf, "bluetooth", 9) == 0) { 64 rfkill_id = id; 65 break; 66 } 67 } 68 69 asprintf(&rfkill_state_path, "/sys/class/rfkill/rfkill%d/state", rfkill_id); 70 return 0; 71} 72 73static int check_bluetooth_power() { 74 int sz; 75 int fd = -1; 76 int ret = -1; 77 char buffer; 78 79 if (rfkill_id == -1) { 80 if (init_rfkill()) goto out; 81 } 82 83 fd = open(rfkill_state_path, O_RDONLY); 84 if (fd < 0) { 85 LOGE("open(%s) failed: %s (%d)", rfkill_state_path, strerror(errno), 86 errno); 87 goto out; 88 } 89 sz = read(fd, &buffer, 1); 90 if (sz != 1) { 91 LOGE("read(%s) failed: %s (%d)", rfkill_state_path, strerror(errno), 92 errno); 93 goto out; 94 } 95 96 switch (buffer) { 97 case '1': 98 ret = 1; 99 break; 100 case '0': 101 ret = 0; 102 break; 103 } 104 105out: 106 if (fd >= 0) close(fd); 107 return ret; 108} 109 110static int set_bluetooth_power(int on) { 111 int sz; 112 int fd = -1; 113 int ret = -1; 114 const char buffer = (on ? '1' : '0'); 115 116 if (rfkill_id == -1) { 117 if (init_rfkill()) goto out; 118 } 119 120 fd = open(rfkill_state_path, O_WRONLY); 121 if (fd < 0) { 122 LOGE("open(%s) for write failed: %s (%d)", rfkill_state_path, 123 strerror(errno), errno); 124 goto out; 125 } 126 sz = write(fd, &buffer, 1); 127 if (sz < 0) { 128 LOGE("write(%s) failed: %s (%d)", rfkill_state_path, strerror(errno), 129 errno); 130 goto out; 131 } 132 ret = 0; 133 134out: 135 if (fd >= 0) close(fd); 136 return ret; 137} 138 139static inline int create_hci_sock() { 140 int sk = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI); 141 if (sk < 0) { 142 LOGE("Failed to create bluetooth hci socket: %s (%d)", 143 strerror(errno), errno); 144 } 145 return sk; 146} 147 148int bt_enable() { 149 LOGV(__FUNCTION__); 150 151 int ret = -1; 152 int hci_sock = -1; 153 int attempt; 154 155 if (set_bluetooth_power(1) < 0) goto out; 156 157 LOGI("Starting hciattach daemon"); 158 if (property_set("ctl.start", "hciattach") < 0) { 159 LOGE("Failed to start hciattach"); 160 set_bluetooth_power(0); 161 goto out; 162 } 163 164 // Try for 10 seconds, this can only succeed once hciattach has sent the 165 // firmware and then turned on hci device via HCIUARTSETPROTO ioctl 166 for (attempt = 1000; attempt > 0; attempt--) { 167 hci_sock = create_hci_sock(); 168 if (hci_sock < 0) goto out; 169 170 ret = ioctl(hci_sock, HCIDEVUP, HCI_DEV_ID); 171 if (!ret) { 172 break; 173 } 174 close(hci_sock); 175 usleep(10000); // 10 ms retry delay 176 } 177 if (attempt == 0) { 178 LOGE("%s: Timeout waiting for HCI device to come up, error- %d, ", 179 __FUNCTION__, ret); 180 set_bluetooth_power(0); 181 goto out; 182 } 183 184 LOGI("Starting bluetoothd deamon"); 185 if (property_set("ctl.start", "bluetoothd") < 0) { 186 LOGE("Failed to start bluetoothd"); 187 set_bluetooth_power(0); 188 goto out; 189 } 190 191 ret = 0; 192 193out: 194 if (hci_sock >= 0) close(hci_sock); 195 return ret; 196} 197 198int bt_disable() { 199 LOGV(__FUNCTION__); 200 201 int ret = -1; 202 int hci_sock = -1; 203 204 LOGI("Stopping bluetoothd deamon"); 205 if (property_set("ctl.stop", "bluetoothd") < 0) { 206 LOGE("Error stopping bluetoothd"); 207 goto out; 208 } 209 usleep(HCID_STOP_DELAY_USEC); 210 211 hci_sock = create_hci_sock(); 212 if (hci_sock < 0) goto out; 213 ioctl(hci_sock, HCIDEVDOWN, HCI_DEV_ID); 214 215 LOGI("Stopping hciattach deamon"); 216 if (property_set("ctl.stop", "hciattach") < 0) { 217 LOGE("Error stopping hciattach"); 218 goto out; 219 } 220 221 if (set_bluetooth_power(0) < 0) { 222 goto out; 223 } 224 ret = 0; 225 226out: 227 if (hci_sock >= 0) close(hci_sock); 228 return ret; 229} 230 231int bt_is_enabled() { 232 LOGV(__FUNCTION__); 233 234 int hci_sock = -1; 235 int ret = -1; 236 struct hci_dev_info dev_info; 237 238 239 // Check power first 240 ret = check_bluetooth_power(); 241 if (ret == -1 || ret == 0) goto out; 242 243 ret = -1; 244 245 // Power is on, now check if the HCI interface is up 246 hci_sock = create_hci_sock(); 247 if (hci_sock < 0) goto out; 248 249 dev_info.dev_id = HCI_DEV_ID; 250 if (ioctl(hci_sock, HCIGETDEVINFO, (void *)&dev_info) < 0) { 251 ret = 0; 252 goto out; 253 } 254 255 if (dev_info.flags & (1 << (HCI_UP & 31))) { 256 ret = 1; 257 } else { 258 ret = 0; 259 } 260 261out: 262 if (hci_sock >= 0) close(hci_sock); 263 return ret; 264} 265 266int ba2str(const bdaddr_t *ba, char *str) { 267 return sprintf(str, "%2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X", 268 ba->b[5], ba->b[4], ba->b[3], ba->b[2], ba->b[1], ba->b[0]); 269} 270 271int str2ba(const char *str, bdaddr_t *ba) { 272 int i; 273 for (i = 5; i >= 0; i--) { 274 ba->b[i] = (uint8_t) strtoul(str, &str, 16); 275 str++; 276 } 277 return 0; 278} 279