bluetooth.c revision cd60add87bf628e96d3a91dc96d4bf945a0ccb17 
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        if (property_set("ctl.stop", "hciattach") < 0) {
181            LOGE("Error stopping hciattach");
182        }
183        set_bluetooth_power(0);
184        goto out;
185    }
186
187    LOGI("Starting bluetoothd deamon");
188    if (property_set("ctl.start", "bluetoothd") < 0) {
189        LOGE("Failed to start bluetoothd");
190        set_bluetooth_power(0);
191        goto out;
192    }
193
194    ret = 0;
195
196out:
197    if (hci_sock >= 0) close(hci_sock);
198    return ret;
199}
200
201int bt_disable() {
202    LOGV(__FUNCTION__);
203
204    int ret = -1;
205    int hci_sock = -1;
206
207    LOGI("Stopping bluetoothd deamon");
208    if (property_set("ctl.stop", "bluetoothd") < 0) {
209        LOGE("Error stopping bluetoothd");
210        goto out;
211    }
212    usleep(HCID_STOP_DELAY_USEC);
213
214    hci_sock = create_hci_sock();
215    if (hci_sock < 0) goto out;
216    ioctl(hci_sock, HCIDEVDOWN, HCI_DEV_ID);
217
218    LOGI("Stopping hciattach deamon");
219    if (property_set("ctl.stop", "hciattach") < 0) {
220        LOGE("Error stopping hciattach");
221        goto out;
222    }
223
224    if (set_bluetooth_power(0) < 0) {
225        goto out;
226    }
227    ret = 0;
228
229out:
230    if (hci_sock >= 0) close(hci_sock);
231    return ret;
232}
233
234int bt_is_enabled() {
235    LOGV(__FUNCTION__);
236
237    int hci_sock = -1;
238    int ret = -1;
239    struct hci_dev_info dev_info;
240
241
242    // Check power first
243    ret = check_bluetooth_power();
244    if (ret == -1 || ret == 0) goto out;
245
246    ret = -1;
247
248    // Power is on, now check if the HCI interface is up
249    hci_sock = create_hci_sock();
250    if (hci_sock < 0) goto out;
251
252    dev_info.dev_id = HCI_DEV_ID;
253    if (ioctl(hci_sock, HCIGETDEVINFO, (void *)&dev_info) < 0) {
254        ret = 0;
255        goto out;
256    }
257
258    if (dev_info.flags & (1 << (HCI_UP & 31))) {
259        ret = 1;
260    } else {
261        ret = 0;
262    }
263
264out:
265    if (hci_sock >= 0) close(hci_sock);
266    return ret;
267}
268
269int ba2str(const bdaddr_t *ba, char *str) {
270    return sprintf(str, "%2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X",
271                ba->b[5], ba->b[4], ba->b[3], ba->b[2], ba->b[1], ba->b[0]);
272}
273
274int str2ba(const char *str, bdaddr_t *ba) {
275    int i;
276    for (i = 5; i >= 0; i--) {
277        ba->b[i] = (uint8_t) strtoul(str, &str, 16);
278        str++;
279    }
280    return 0;
281}
282