Lines Matching refs:hdev
70 static void hci_notify(struct hci_dev *hdev, int event) in hci_notify() argument
72 hci_sock_dev_event(hdev, event); in hci_notify()
80 struct hci_dev *hdev = file->private_data; in dut_mode_read() local
83 buf[0] = hci_dev_test_flag(hdev, HCI_DUT_MODE) ? 'Y': 'N'; in dut_mode_read()
92 struct hci_dev *hdev = file->private_data; in dut_mode_write() local
99 if (!test_bit(HCI_UP, &hdev->flags)) in dut_mode_write()
109 if (enable == hci_dev_test_flag(hdev, HCI_DUT_MODE)) in dut_mode_write()
112 hci_req_lock(hdev); in dut_mode_write()
114 skb = __hci_cmd_sync(hdev, HCI_OP_ENABLE_DUT_MODE, 0, NULL, in dut_mode_write()
117 skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, in dut_mode_write()
119 hci_req_unlock(hdev); in dut_mode_write()
130 hci_dev_change_flag(hdev, HCI_DUT_MODE); in dut_mode_write()
144 static void hci_req_sync_complete(struct hci_dev *hdev, u8 result, u16 opcode, in hci_req_sync_complete() argument
147 BT_DBG("%s result 0x%2.2x", hdev->name, result); in hci_req_sync_complete()
149 if (hdev->req_status == HCI_REQ_PEND) { in hci_req_sync_complete()
150 hdev->req_result = result; in hci_req_sync_complete()
151 hdev->req_status = HCI_REQ_DONE; in hci_req_sync_complete()
153 hdev->req_skb = skb_get(skb); in hci_req_sync_complete()
154 wake_up_interruptible(&hdev->req_wait_q); in hci_req_sync_complete()
158 static void hci_req_cancel(struct hci_dev *hdev, int err) in hci_req_cancel() argument
160 BT_DBG("%s err 0x%2.2x", hdev->name, err); in hci_req_cancel()
162 if (hdev->req_status == HCI_REQ_PEND) { in hci_req_cancel()
163 hdev->req_result = err; in hci_req_cancel()
164 hdev->req_status = HCI_REQ_CANCELED; in hci_req_cancel()
165 wake_up_interruptible(&hdev->req_wait_q); in hci_req_cancel()
169 struct sk_buff *__hci_cmd_sync_ev(struct hci_dev *hdev, u16 opcode, u32 plen, in __hci_cmd_sync_ev() argument
177 BT_DBG("%s", hdev->name); in __hci_cmd_sync_ev()
179 hci_req_init(&req, hdev); in __hci_cmd_sync_ev()
183 hdev->req_status = HCI_REQ_PEND; in __hci_cmd_sync_ev()
185 add_wait_queue(&hdev->req_wait_q, &wait); in __hci_cmd_sync_ev()
190 remove_wait_queue(&hdev->req_wait_q, &wait); in __hci_cmd_sync_ev()
197 remove_wait_queue(&hdev->req_wait_q, &wait); in __hci_cmd_sync_ev()
202 switch (hdev->req_status) { in __hci_cmd_sync_ev()
204 err = -bt_to_errno(hdev->req_result); in __hci_cmd_sync_ev()
208 err = -hdev->req_result; in __hci_cmd_sync_ev()
216 hdev->req_status = hdev->req_result = 0; in __hci_cmd_sync_ev()
217 skb = hdev->req_skb; in __hci_cmd_sync_ev()
218 hdev->req_skb = NULL; in __hci_cmd_sync_ev()
220 BT_DBG("%s end: err %d", hdev->name, err); in __hci_cmd_sync_ev()
234 struct sk_buff *__hci_cmd_sync(struct hci_dev *hdev, u16 opcode, u32 plen, in __hci_cmd_sync() argument
237 return __hci_cmd_sync_ev(hdev, opcode, plen, param, 0, timeout); in __hci_cmd_sync()
242 static int __hci_req_sync(struct hci_dev *hdev, in __hci_req_sync() argument
251 BT_DBG("%s start", hdev->name); in __hci_req_sync()
253 hci_req_init(&req, hdev); in __hci_req_sync()
255 hdev->req_status = HCI_REQ_PEND; in __hci_req_sync()
259 add_wait_queue(&hdev->req_wait_q, &wait); in __hci_req_sync()
264 hdev->req_status = 0; in __hci_req_sync()
266 remove_wait_queue(&hdev->req_wait_q, &wait); in __hci_req_sync()
282 remove_wait_queue(&hdev->req_wait_q, &wait); in __hci_req_sync()
287 switch (hdev->req_status) { in __hci_req_sync()
289 err = -bt_to_errno(hdev->req_result); in __hci_req_sync()
293 err = -hdev->req_result; in __hci_req_sync()
301 hdev->req_status = hdev->req_result = 0; in __hci_req_sync()
303 BT_DBG("%s end: err %d", hdev->name, err); in __hci_req_sync()
308 static int hci_req_sync(struct hci_dev *hdev, in hci_req_sync() argument
315 if (!test_bit(HCI_UP, &hdev->flags)) in hci_req_sync()
319 hci_req_lock(hdev); in hci_req_sync()
320 ret = __hci_req_sync(hdev, req, opt, timeout); in hci_req_sync()
321 hci_req_unlock(hdev); in hci_req_sync()
328 BT_DBG("%s %ld", req->hdev->name, opt); in hci_reset_req()
331 set_bit(HCI_RESET, &req->hdev->flags); in hci_reset_req()
337 req->hdev->flow_ctl_mode = HCI_FLOW_CTL_MODE_PACKET_BASED; in bredr_init()
351 req->hdev->flow_ctl_mode = HCI_FLOW_CTL_MODE_BLOCK_BASED; in amp_init1()
378 if (req->hdev->commands[14] & 0x20) in amp_init2()
384 struct hci_dev *hdev = req->hdev; in hci_init1_req() local
386 BT_DBG("%s %ld", hdev->name, opt); in hci_init1_req()
389 if (!test_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks)) in hci_init1_req()
392 switch (hdev->dev_type) { in hci_init1_req()
402 BT_ERR("Unknown device type %d", hdev->dev_type); in hci_init1_req()
441 struct hci_dev *hdev = req->hdev; in le_setup() local
459 if (!lmp_bredr_capable(hdev)) in le_setup()
460 hci_dev_set_flag(hdev, HCI_LE_ENABLED); in le_setup()
465 struct hci_dev *hdev = req->hdev; in hci_setup_event_mask() local
476 if (hdev->hci_ver < BLUETOOTH_VER_1_2) in hci_setup_event_mask()
479 if (lmp_bredr_capable(hdev)) { in hci_setup_event_mask()
496 if (hdev->le_features[0] & HCI_LE_ENCRYPTION) { in hci_setup_event_mask()
502 if (lmp_inq_rssi_capable(hdev)) in hci_setup_event_mask()
505 if (lmp_sniffsubr_capable(hdev)) in hci_setup_event_mask()
508 if (lmp_pause_enc_capable(hdev)) in hci_setup_event_mask()
511 if (lmp_ext_inq_capable(hdev)) in hci_setup_event_mask()
514 if (lmp_no_flush_capable(hdev)) in hci_setup_event_mask()
517 if (lmp_lsto_capable(hdev)) in hci_setup_event_mask()
520 if (lmp_ssp_capable(hdev)) { in hci_setup_event_mask()
534 if (lmp_le_capable(hdev)) in hci_setup_event_mask()
542 struct hci_dev *hdev = req->hdev; in hci_init2_req() local
544 if (hdev->dev_type == HCI_AMP) in hci_init2_req()
547 if (lmp_bredr_capable(hdev)) in hci_init2_req()
550 hci_dev_clear_flag(hdev, HCI_BREDR_ENABLED); in hci_init2_req()
552 if (lmp_le_capable(hdev)) in hci_init2_req()
563 if (hdev->hci_ver > BLUETOOTH_VER_1_1 && in hci_init2_req()
564 !test_bit(HCI_QUIRK_BROKEN_LOCAL_COMMANDS, &hdev->quirks)) in hci_init2_req()
567 if (lmp_ssp_capable(hdev)) { in hci_init2_req()
574 hdev->max_page = 0x01; in hci_init2_req()
576 if (hci_dev_test_flag(hdev, HCI_SSP_ENABLED)) { in hci_init2_req()
584 memset(hdev->eir, 0, sizeof(hdev->eir)); in hci_init2_req()
591 if (lmp_inq_rssi_capable(hdev) || in hci_init2_req()
592 test_bit(HCI_QUIRK_FIXUP_INQUIRY_MODE, &hdev->quirks)) { in hci_init2_req()
599 mode = lmp_ext_inq_capable(hdev) ? 0x02 : 0x01; in hci_init2_req()
604 if (lmp_inq_tx_pwr_capable(hdev)) in hci_init2_req()
607 if (lmp_ext_feat_capable(hdev)) { in hci_init2_req()
615 if (hci_dev_test_flag(hdev, HCI_LINK_SECURITY)) { in hci_init2_req()
624 struct hci_dev *hdev = req->hdev; in hci_setup_link_policy() local
628 if (lmp_rswitch_capable(hdev)) in hci_setup_link_policy()
630 if (lmp_hold_capable(hdev)) in hci_setup_link_policy()
632 if (lmp_sniff_capable(hdev)) in hci_setup_link_policy()
634 if (lmp_park_capable(hdev)) in hci_setup_link_policy()
643 struct hci_dev *hdev = req->hdev; in hci_set_le_support() local
647 if (!lmp_bredr_capable(hdev)) in hci_set_le_support()
652 if (hci_dev_test_flag(hdev, HCI_LE_ENABLED)) { in hci_set_le_support()
657 if (cp.le != lmp_host_le_capable(hdev)) in hci_set_le_support()
664 struct hci_dev *hdev = req->hdev; in hci_set_event_mask_page_2() local
670 if (lmp_csb_master_capable(hdev)) { in hci_set_event_mask_page_2()
680 if (lmp_csb_slave_capable(hdev)) { in hci_set_event_mask_page_2()
688 if (lmp_ping_capable(hdev) || hdev->le_features[0] & HCI_LE_PING) in hci_set_event_mask_page_2()
696 struct hci_dev *hdev = req->hdev; in hci_init3_req() local
701 if (hdev->commands[6] & 0x20) { in hci_init3_req()
709 if (hdev->commands[5] & 0x10) in hci_init3_req()
712 if (hdev->commands[8] & 0x01) in hci_init3_req()
719 if (hdev->commands[13] & 0x01) in hci_init3_req()
722 if (lmp_le_capable(hdev)) { in hci_init3_req()
728 if (hdev->le_features[0] & HCI_LE_ENCRYPTION) in hci_init3_req()
734 if (hdev->le_features[0] & HCI_LE_CONN_PARAM_REQ_PROC) in hci_init3_req()
742 if (hdev->le_features[0] & HCI_LE_DATA_LEN_EXT) in hci_init3_req()
748 if (hdev->le_features[0] & HCI_LE_EXT_SCAN_POLICY) in hci_init3_req()
756 if (hdev->commands[34] & 0x02) in hci_init3_req()
764 if (hdev->commands[34] & 0x04) in hci_init3_req()
770 if (hdev->commands[25] & 0x40) { in hci_init3_req()
775 if (hdev->le_features[0] & HCI_LE_DATA_LEN_EXT) { in hci_init3_req()
787 for (p = 2; p < HCI_MAX_PAGES && p <= hdev->max_page; p++) { in hci_init3_req()
798 struct hci_dev *hdev = req->hdev; in hci_init4_req() local
813 if (hdev->commands[6] & 0x80 && in hci_init4_req()
814 !test_bit(HCI_QUIRK_BROKEN_STORED_LINK_KEY, &hdev->quirks)) { in hci_init4_req()
824 if (hdev->commands[22] & 0x04) in hci_init4_req()
828 if (hdev->commands[29] & 0x20) in hci_init4_req()
832 if (hdev->commands[30] & 0x08) in hci_init4_req()
836 if (lmp_sync_train_capable(hdev)) in hci_init4_req()
840 if (hci_dev_test_flag(hdev, HCI_SSP_ENABLED) && in hci_init4_req()
841 bredr_sc_enabled(hdev)) { in hci_init4_req()
849 static int __hci_init(struct hci_dev *hdev) in __hci_init() argument
853 err = __hci_req_sync(hdev, hci_init1_req, 0, HCI_INIT_TIMEOUT); in __hci_init()
860 if (hci_dev_test_flag(hdev, HCI_SETUP)) { in __hci_init()
861 debugfs_create_file("dut_mode", 0644, hdev->debugfs, hdev, in __hci_init()
865 err = __hci_req_sync(hdev, hci_init2_req, 0, HCI_INIT_TIMEOUT); in __hci_init()
873 if (hdev->dev_type != HCI_BREDR) in __hci_init()
876 err = __hci_req_sync(hdev, hci_init3_req, 0, HCI_INIT_TIMEOUT); in __hci_init()
880 err = __hci_req_sync(hdev, hci_init4_req, 0, HCI_INIT_TIMEOUT); in __hci_init()
896 if (!hci_dev_test_flag(hdev, HCI_SETUP) && in __hci_init()
897 !hci_dev_test_flag(hdev, HCI_CONFIG)) in __hci_init()
900 hci_debugfs_create_common(hdev); in __hci_init()
902 if (lmp_bredr_capable(hdev)) in __hci_init()
903 hci_debugfs_create_bredr(hdev); in __hci_init()
905 if (lmp_le_capable(hdev)) in __hci_init()
906 hci_debugfs_create_le(hdev); in __hci_init()
913 struct hci_dev *hdev = req->hdev; in hci_init0_req() local
915 BT_DBG("%s %ld", hdev->name, opt); in hci_init0_req()
918 if (!test_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks)) in hci_init0_req()
925 if (hdev->set_bdaddr) in hci_init0_req()
929 static int __hci_unconf_init(struct hci_dev *hdev) in __hci_unconf_init() argument
933 if (test_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks)) in __hci_unconf_init()
936 err = __hci_req_sync(hdev, hci_init0_req, 0, HCI_INIT_TIMEOUT); in __hci_unconf_init()
947 BT_DBG("%s %x", req->hdev->name, scan); in hci_scan_req()
957 BT_DBG("%s %x", req->hdev->name, auth); in hci_auth_req()
967 BT_DBG("%s %x", req->hdev->name, encrypt); in hci_encrypt_req()
977 BT_DBG("%s %x", req->hdev->name, policy); in hci_linkpol_req()
987 struct hci_dev *hdev = NULL, *d; in hci_dev_get() local
997 hdev = hci_dev_hold(d); in hci_dev_get()
1002 return hdev; in hci_dev_get()
1007 bool hci_discovery_active(struct hci_dev *hdev) in hci_discovery_active() argument
1009 struct discovery_state *discov = &hdev->discovery; in hci_discovery_active()
1021 void hci_discovery_set_state(struct hci_dev *hdev, int state) in hci_discovery_set_state() argument
1023 int old_state = hdev->discovery.state; in hci_discovery_set_state()
1025 BT_DBG("%s state %u -> %u", hdev->name, hdev->discovery.state, state); in hci_discovery_set_state()
1030 hdev->discovery.state = state; in hci_discovery_set_state()
1034 hci_update_background_scan(hdev); in hci_discovery_set_state()
1037 mgmt_discovering(hdev, 0); in hci_discovery_set_state()
1042 mgmt_discovering(hdev, 1); in hci_discovery_set_state()
1051 void hci_inquiry_cache_flush(struct hci_dev *hdev) in hci_inquiry_cache_flush() argument
1053 struct discovery_state *cache = &hdev->discovery; in hci_inquiry_cache_flush()
1065 struct inquiry_entry *hci_inquiry_cache_lookup(struct hci_dev *hdev, in hci_inquiry_cache_lookup() argument
1068 struct discovery_state *cache = &hdev->discovery; in hci_inquiry_cache_lookup()
1081 struct inquiry_entry *hci_inquiry_cache_lookup_unknown(struct hci_dev *hdev, in hci_inquiry_cache_lookup_unknown() argument
1084 struct discovery_state *cache = &hdev->discovery; in hci_inquiry_cache_lookup_unknown()
1097 struct inquiry_entry *hci_inquiry_cache_lookup_resolve(struct hci_dev *hdev, in hci_inquiry_cache_lookup_resolve() argument
1101 struct discovery_state *cache = &hdev->discovery; in hci_inquiry_cache_lookup_resolve()
1116 void hci_inquiry_cache_update_resolve(struct hci_dev *hdev, in hci_inquiry_cache_update_resolve() argument
1119 struct discovery_state *cache = &hdev->discovery; in hci_inquiry_cache_update_resolve()
1135 u32 hci_inquiry_cache_update(struct hci_dev *hdev, struct inquiry_data *data, in hci_inquiry_cache_update() argument
1138 struct discovery_state *cache = &hdev->discovery; in hci_inquiry_cache_update()
1144 hci_remove_remote_oob_data(hdev, &data->bdaddr, BDADDR_BREDR); in hci_inquiry_cache_update()
1149 ie = hci_inquiry_cache_lookup(hdev, &data->bdaddr); in hci_inquiry_cache_update()
1157 hci_inquiry_cache_update_resolve(hdev, ie); in hci_inquiry_cache_update()
1197 static int inquiry_cache_dump(struct hci_dev *hdev, int num, __u8 *buf) in inquiry_cache_dump() argument
1199 struct discovery_state *cache = &hdev->discovery; in inquiry_cache_dump()
1228 struct hci_dev *hdev = req->hdev; in hci_inq_req() local
1231 BT_DBG("%s", hdev->name); in hci_inq_req()
1233 if (test_bit(HCI_INQUIRY, &hdev->flags)) in hci_inq_req()
1247 struct hci_dev *hdev; in hci_inquiry() local
1255 hdev = hci_dev_get(ir.dev_id); in hci_inquiry()
1256 if (!hdev) in hci_inquiry()
1259 if (hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) { in hci_inquiry()
1264 if (hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) { in hci_inquiry()
1269 if (hdev->dev_type != HCI_BREDR) { in hci_inquiry()
1274 if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED)) { in hci_inquiry()
1279 hci_dev_lock(hdev); in hci_inquiry()
1280 if (inquiry_cache_age(hdev) > INQUIRY_CACHE_AGE_MAX || in hci_inquiry()
1281 inquiry_cache_empty(hdev) || ir.flags & IREQ_CACHE_FLUSH) { in hci_inquiry()
1282 hci_inquiry_cache_flush(hdev); in hci_inquiry()
1285 hci_dev_unlock(hdev); in hci_inquiry()
1290 err = hci_req_sync(hdev, hci_inq_req, (unsigned long) &ir, in hci_inquiry()
1298 if (wait_on_bit(&hdev->flags, HCI_INQUIRY, in hci_inquiry()
1317 hci_dev_lock(hdev); in hci_inquiry()
1318 ir.num_rsp = inquiry_cache_dump(hdev, max_rsp, buf); in hci_inquiry()
1319 hci_dev_unlock(hdev); in hci_inquiry()
1334 hci_dev_put(hdev); in hci_inquiry()
1338 static int hci_dev_do_open(struct hci_dev *hdev) in hci_dev_do_open() argument
1342 BT_DBG("%s %p", hdev->name, hdev); in hci_dev_do_open()
1344 hci_req_lock(hdev); in hci_dev_do_open()
1346 if (hci_dev_test_flag(hdev, HCI_UNREGISTER)) { in hci_dev_do_open()
1351 if (!hci_dev_test_flag(hdev, HCI_SETUP) && in hci_dev_do_open()
1352 !hci_dev_test_flag(hdev, HCI_CONFIG)) { in hci_dev_do_open()
1356 if (hci_dev_test_flag(hdev, HCI_RFKILLED)) { in hci_dev_do_open()
1373 if (!hci_dev_test_flag(hdev, HCI_USER_CHANNEL) && in hci_dev_do_open()
1374 hdev->dev_type == HCI_BREDR && in hci_dev_do_open()
1375 !bacmp(&hdev->bdaddr, BDADDR_ANY) && in hci_dev_do_open()
1376 !bacmp(&hdev->static_addr, BDADDR_ANY)) { in hci_dev_do_open()
1382 if (test_bit(HCI_UP, &hdev->flags)) { in hci_dev_do_open()
1387 if (hdev->open(hdev)) { in hci_dev_do_open()
1392 atomic_set(&hdev->cmd_cnt, 1); in hci_dev_do_open()
1393 set_bit(HCI_INIT, &hdev->flags); in hci_dev_do_open()
1395 if (hci_dev_test_flag(hdev, HCI_SETUP)) { in hci_dev_do_open()
1396 if (hdev->setup) in hci_dev_do_open()
1397 ret = hdev->setup(hdev); in hci_dev_do_open()
1405 if (test_bit(HCI_QUIRK_EXTERNAL_CONFIG, &hdev->quirks) || in hci_dev_do_open()
1406 test_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks)) in hci_dev_do_open()
1407 hci_dev_set_flag(hdev, HCI_UNCONFIGURED); in hci_dev_do_open()
1417 if (hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) in hci_dev_do_open()
1418 ret = __hci_unconf_init(hdev); in hci_dev_do_open()
1421 if (hci_dev_test_flag(hdev, HCI_CONFIG)) { in hci_dev_do_open()
1427 if (bacmp(&hdev->public_addr, BDADDR_ANY) && in hci_dev_do_open()
1428 hdev->set_bdaddr) in hci_dev_do_open()
1429 ret = hdev->set_bdaddr(hdev, &hdev->public_addr); in hci_dev_do_open()
1435 if (!hci_dev_test_flag(hdev, HCI_UNCONFIGURED) && in hci_dev_do_open()
1436 !hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) in hci_dev_do_open()
1437 ret = __hci_init(hdev); in hci_dev_do_open()
1440 clear_bit(HCI_INIT, &hdev->flags); in hci_dev_do_open()
1443 hci_dev_hold(hdev); in hci_dev_do_open()
1444 hci_dev_set_flag(hdev, HCI_RPA_EXPIRED); in hci_dev_do_open()
1445 set_bit(HCI_UP, &hdev->flags); in hci_dev_do_open()
1446 hci_notify(hdev, HCI_DEV_UP); in hci_dev_do_open()
1447 if (!hci_dev_test_flag(hdev, HCI_SETUP) && in hci_dev_do_open()
1448 !hci_dev_test_flag(hdev, HCI_CONFIG) && in hci_dev_do_open()
1449 !hci_dev_test_flag(hdev, HCI_UNCONFIGURED) && in hci_dev_do_open()
1450 !hci_dev_test_flag(hdev, HCI_USER_CHANNEL) && in hci_dev_do_open()
1451 hdev->dev_type == HCI_BREDR) { in hci_dev_do_open()
1452 hci_dev_lock(hdev); in hci_dev_do_open()
1453 mgmt_powered(hdev, 1); in hci_dev_do_open()
1454 hci_dev_unlock(hdev); in hci_dev_do_open()
1458 flush_work(&hdev->tx_work); in hci_dev_do_open()
1459 flush_work(&hdev->cmd_work); in hci_dev_do_open()
1460 flush_work(&hdev->rx_work); in hci_dev_do_open()
1462 skb_queue_purge(&hdev->cmd_q); in hci_dev_do_open()
1463 skb_queue_purge(&hdev->rx_q); in hci_dev_do_open()
1465 if (hdev->flush) in hci_dev_do_open()
1466 hdev->flush(hdev); in hci_dev_do_open()
1468 if (hdev->sent_cmd) { in hci_dev_do_open()
1469 kfree_skb(hdev->sent_cmd); in hci_dev_do_open()
1470 hdev->sent_cmd = NULL; in hci_dev_do_open()
1473 hdev->close(hdev); in hci_dev_do_open()
1474 hdev->flags &= BIT(HCI_RAW); in hci_dev_do_open()
1478 hci_req_unlock(hdev); in hci_dev_do_open()
1486 struct hci_dev *hdev; in hci_dev_open() local
1489 hdev = hci_dev_get(dev); in hci_dev_open()
1490 if (!hdev) in hci_dev_open()
1502 if (hci_dev_test_flag(hdev, HCI_UNCONFIGURED) && in hci_dev_open()
1503 !hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) { in hci_dev_open()
1513 if (hci_dev_test_and_clear_flag(hdev, HCI_AUTO_OFF)) in hci_dev_open()
1514 cancel_delayed_work(&hdev->power_off); in hci_dev_open()
1520 flush_workqueue(hdev->req_workqueue); in hci_dev_open()
1528 if (!hci_dev_test_flag(hdev, HCI_USER_CHANNEL) && in hci_dev_open()
1529 !hci_dev_test_flag(hdev, HCI_MGMT)) in hci_dev_open()
1530 hci_dev_set_flag(hdev, HCI_BONDABLE); in hci_dev_open()
1532 err = hci_dev_do_open(hdev); in hci_dev_open()
1535 hci_dev_put(hdev); in hci_dev_open()
1540 static void hci_pend_le_actions_clear(struct hci_dev *hdev) in hci_pend_le_actions_clear() argument
1544 list_for_each_entry(p, &hdev->le_conn_params, list) { in hci_pend_le_actions_clear()
1556 static int hci_dev_do_close(struct hci_dev *hdev) in hci_dev_do_close() argument
1558 BT_DBG("%s %p", hdev->name, hdev); in hci_dev_do_close()
1560 if (!hci_dev_test_flag(hdev, HCI_UNREGISTER) && in hci_dev_do_close()
1561 test_bit(HCI_UP, &hdev->flags)) { in hci_dev_do_close()
1563 if (hdev->shutdown) in hci_dev_do_close()
1564 hdev->shutdown(hdev); in hci_dev_do_close()
1567 cancel_delayed_work(&hdev->power_off); in hci_dev_do_close()
1569 hci_req_cancel(hdev, ENODEV); in hci_dev_do_close()
1570 hci_req_lock(hdev); in hci_dev_do_close()
1572 if (!test_and_clear_bit(HCI_UP, &hdev->flags)) { in hci_dev_do_close()
1573 cancel_delayed_work_sync(&hdev->cmd_timer); in hci_dev_do_close()
1574 hci_req_unlock(hdev); in hci_dev_do_close()
1579 flush_work(&hdev->tx_work); in hci_dev_do_close()
1580 flush_work(&hdev->rx_work); in hci_dev_do_close()
1582 if (hdev->discov_timeout > 0) { in hci_dev_do_close()
1583 cancel_delayed_work(&hdev->discov_off); in hci_dev_do_close()
1584 hdev->discov_timeout = 0; in hci_dev_do_close()
1585 hci_dev_clear_flag(hdev, HCI_DISCOVERABLE); in hci_dev_do_close()
1586 hci_dev_clear_flag(hdev, HCI_LIMITED_DISCOVERABLE); in hci_dev_do_close()
1589 if (hci_dev_test_and_clear_flag(hdev, HCI_SERVICE_CACHE)) in hci_dev_do_close()
1590 cancel_delayed_work(&hdev->service_cache); in hci_dev_do_close()
1592 cancel_delayed_work_sync(&hdev->le_scan_disable); in hci_dev_do_close()
1593 cancel_delayed_work_sync(&hdev->le_scan_restart); in hci_dev_do_close()
1595 if (hci_dev_test_flag(hdev, HCI_MGMT)) in hci_dev_do_close()
1596 cancel_delayed_work_sync(&hdev->rpa_expired); in hci_dev_do_close()
1601 drain_workqueue(hdev->workqueue); in hci_dev_do_close()
1603 hci_dev_lock(hdev); in hci_dev_do_close()
1605 hci_discovery_set_state(hdev, DISCOVERY_STOPPED); in hci_dev_do_close()
1607 if (!hci_dev_test_and_clear_flag(hdev, HCI_AUTO_OFF)) { in hci_dev_do_close()
1608 if (hdev->dev_type == HCI_BREDR) in hci_dev_do_close()
1609 mgmt_powered(hdev, 0); in hci_dev_do_close()
1612 hci_inquiry_cache_flush(hdev); in hci_dev_do_close()
1613 hci_pend_le_actions_clear(hdev); in hci_dev_do_close()
1614 hci_conn_hash_flush(hdev); in hci_dev_do_close()
1615 hci_dev_unlock(hdev); in hci_dev_do_close()
1617 smp_unregister(hdev); in hci_dev_do_close()
1619 hci_notify(hdev, HCI_DEV_DOWN); in hci_dev_do_close()
1621 if (hdev->flush) in hci_dev_do_close()
1622 hdev->flush(hdev); in hci_dev_do_close()
1625 skb_queue_purge(&hdev->cmd_q); in hci_dev_do_close()
1626 atomic_set(&hdev->cmd_cnt, 1); in hci_dev_do_close()
1627 if (!hci_dev_test_flag(hdev, HCI_AUTO_OFF) && in hci_dev_do_close()
1628 !hci_dev_test_flag(hdev, HCI_UNCONFIGURED) && in hci_dev_do_close()
1629 test_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks)) { in hci_dev_do_close()
1630 set_bit(HCI_INIT, &hdev->flags); in hci_dev_do_close()
1631 __hci_req_sync(hdev, hci_reset_req, 0, HCI_CMD_TIMEOUT); in hci_dev_do_close()
1632 clear_bit(HCI_INIT, &hdev->flags); in hci_dev_do_close()
1636 flush_work(&hdev->cmd_work); in hci_dev_do_close()
1639 skb_queue_purge(&hdev->rx_q); in hci_dev_do_close()
1640 skb_queue_purge(&hdev->cmd_q); in hci_dev_do_close()
1641 skb_queue_purge(&hdev->raw_q); in hci_dev_do_close()
1644 if (hdev->sent_cmd) { in hci_dev_do_close()
1645 cancel_delayed_work_sync(&hdev->cmd_timer); in hci_dev_do_close()
1646 kfree_skb(hdev->sent_cmd); in hci_dev_do_close()
1647 hdev->sent_cmd = NULL; in hci_dev_do_close()
1652 hdev->close(hdev); in hci_dev_do_close()
1655 hdev->flags &= BIT(HCI_RAW); in hci_dev_do_close()
1656 hci_dev_clear_volatile_flags(hdev); in hci_dev_do_close()
1659 hdev->amp_status = AMP_STATUS_POWERED_DOWN; in hci_dev_do_close()
1661 memset(hdev->eir, 0, sizeof(hdev->eir)); in hci_dev_do_close()
1662 memset(hdev->dev_class, 0, sizeof(hdev->dev_class)); in hci_dev_do_close()
1663 bacpy(&hdev->random_addr, BDADDR_ANY); in hci_dev_do_close()
1665 hci_req_unlock(hdev); in hci_dev_do_close()
1667 hci_dev_put(hdev); in hci_dev_do_close()
1673 struct hci_dev *hdev; in hci_dev_close() local
1676 hdev = hci_dev_get(dev); in hci_dev_close()
1677 if (!hdev) in hci_dev_close()
1680 if (hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) { in hci_dev_close()
1685 if (hci_dev_test_and_clear_flag(hdev, HCI_AUTO_OFF)) in hci_dev_close()
1686 cancel_delayed_work(&hdev->power_off); in hci_dev_close()
1688 err = hci_dev_do_close(hdev); in hci_dev_close()
1691 hci_dev_put(hdev); in hci_dev_close()
1695 static int hci_dev_do_reset(struct hci_dev *hdev) in hci_dev_do_reset() argument
1699 BT_DBG("%s %p", hdev->name, hdev); in hci_dev_do_reset()
1701 hci_req_lock(hdev); in hci_dev_do_reset()
1704 skb_queue_purge(&hdev->rx_q); in hci_dev_do_reset()
1705 skb_queue_purge(&hdev->cmd_q); in hci_dev_do_reset()
1710 drain_workqueue(hdev->workqueue); in hci_dev_do_reset()
1712 hci_dev_lock(hdev); in hci_dev_do_reset()
1713 hci_inquiry_cache_flush(hdev); in hci_dev_do_reset()
1714 hci_conn_hash_flush(hdev); in hci_dev_do_reset()
1715 hci_dev_unlock(hdev); in hci_dev_do_reset()
1717 if (hdev->flush) in hci_dev_do_reset()
1718 hdev->flush(hdev); in hci_dev_do_reset()
1720 atomic_set(&hdev->cmd_cnt, 1); in hci_dev_do_reset()
1721 hdev->acl_cnt = 0; hdev->sco_cnt = 0; hdev->le_cnt = 0; in hci_dev_do_reset()
1723 ret = __hci_req_sync(hdev, hci_reset_req, 0, HCI_INIT_TIMEOUT); in hci_dev_do_reset()
1725 hci_req_unlock(hdev); in hci_dev_do_reset()
1731 struct hci_dev *hdev; in hci_dev_reset() local
1734 hdev = hci_dev_get(dev); in hci_dev_reset()
1735 if (!hdev) in hci_dev_reset()
1738 if (!test_bit(HCI_UP, &hdev->flags)) { in hci_dev_reset()
1743 if (hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) { in hci_dev_reset()
1748 if (hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) { in hci_dev_reset()
1753 err = hci_dev_do_reset(hdev); in hci_dev_reset()
1756 hci_dev_put(hdev); in hci_dev_reset()
1762 struct hci_dev *hdev; in hci_dev_reset_stat() local
1765 hdev = hci_dev_get(dev); in hci_dev_reset_stat()
1766 if (!hdev) in hci_dev_reset_stat()
1769 if (hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) { in hci_dev_reset_stat()
1774 if (hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) { in hci_dev_reset_stat()
1779 memset(&hdev->stat, 0, sizeof(struct hci_dev_stats)); in hci_dev_reset_stat()
1782 hci_dev_put(hdev); in hci_dev_reset_stat()
1786 static void hci_update_scan_state(struct hci_dev *hdev, u8 scan) in hci_update_scan_state() argument
1790 BT_DBG("%s scan 0x%02x", hdev->name, scan); in hci_update_scan_state()
1793 conn_changed = !hci_dev_test_and_set_flag(hdev, in hci_update_scan_state()
1796 conn_changed = hci_dev_test_and_clear_flag(hdev, in hci_update_scan_state()
1800 discov_changed = !hci_dev_test_and_set_flag(hdev, in hci_update_scan_state()
1803 hci_dev_clear_flag(hdev, HCI_LIMITED_DISCOVERABLE); in hci_update_scan_state()
1804 discov_changed = hci_dev_test_and_clear_flag(hdev, in hci_update_scan_state()
1808 if (!hci_dev_test_flag(hdev, HCI_MGMT)) in hci_update_scan_state()
1813 hci_dev_set_flag(hdev, HCI_BREDR_ENABLED); in hci_update_scan_state()
1815 if (hci_dev_test_flag(hdev, HCI_LE_ENABLED)) in hci_update_scan_state()
1816 mgmt_update_adv_data(hdev); in hci_update_scan_state()
1818 mgmt_new_settings(hdev); in hci_update_scan_state()
1824 struct hci_dev *hdev; in hci_dev_cmd() local
1831 hdev = hci_dev_get(dr.dev_id); in hci_dev_cmd()
1832 if (!hdev) in hci_dev_cmd()
1835 if (hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) { in hci_dev_cmd()
1840 if (hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) { in hci_dev_cmd()
1845 if (hdev->dev_type != HCI_BREDR) { in hci_dev_cmd()
1850 if (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED)) { in hci_dev_cmd()
1857 err = hci_req_sync(hdev, hci_auth_req, dr.dev_opt, in hci_dev_cmd()
1862 if (!lmp_encrypt_capable(hdev)) { in hci_dev_cmd()
1867 if (!test_bit(HCI_AUTH, &hdev->flags)) { in hci_dev_cmd()
1869 err = hci_req_sync(hdev, hci_auth_req, dr.dev_opt, in hci_dev_cmd()
1875 err = hci_req_sync(hdev, hci_encrypt_req, dr.dev_opt, in hci_dev_cmd()
1880 err = hci_req_sync(hdev, hci_scan_req, dr.dev_opt, in hci_dev_cmd()
1887 hci_update_scan_state(hdev, dr.dev_opt); in hci_dev_cmd()
1891 err = hci_req_sync(hdev, hci_linkpol_req, dr.dev_opt, in hci_dev_cmd()
1896 hdev->link_mode = ((__u16) dr.dev_opt) & in hci_dev_cmd()
1901 hdev->pkt_type = (__u16) dr.dev_opt; in hci_dev_cmd()
1905 hdev->acl_mtu = *((__u16 *) &dr.dev_opt + 1); in hci_dev_cmd()
1906 hdev->acl_pkts = *((__u16 *) &dr.dev_opt + 0); in hci_dev_cmd()
1910 hdev->sco_mtu = *((__u16 *) &dr.dev_opt + 1); in hci_dev_cmd()
1911 hdev->sco_pkts = *((__u16 *) &dr.dev_opt + 0); in hci_dev_cmd()
1920 hci_dev_put(hdev); in hci_dev_cmd()
1926 struct hci_dev *hdev; in hci_get_dev_list() local
1947 list_for_each_entry(hdev, &hci_dev_list, list) { in hci_get_dev_list()
1948 unsigned long flags = hdev->flags; in hci_get_dev_list()
1954 if (hci_dev_test_flag(hdev, HCI_AUTO_OFF)) in hci_get_dev_list()
1957 (dr + n)->dev_id = hdev->id; in hci_get_dev_list()
1976 struct hci_dev *hdev; in hci_get_dev_info() local
1984 hdev = hci_dev_get(di.dev_id); in hci_get_dev_info()
1985 if (!hdev) in hci_get_dev_info()
1992 if (hci_dev_test_flag(hdev, HCI_AUTO_OFF)) in hci_get_dev_info()
1993 flags = hdev->flags & ~BIT(HCI_UP); in hci_get_dev_info()
1995 flags = hdev->flags; in hci_get_dev_info()
1997 strcpy(di.name, hdev->name); in hci_get_dev_info()
1998 di.bdaddr = hdev->bdaddr; in hci_get_dev_info()
1999 di.type = (hdev->bus & 0x0f) | ((hdev->dev_type & 0x03) << 4); in hci_get_dev_info()
2001 di.pkt_type = hdev->pkt_type; in hci_get_dev_info()
2002 if (lmp_bredr_capable(hdev)) { in hci_get_dev_info()
2003 di.acl_mtu = hdev->acl_mtu; in hci_get_dev_info()
2004 di.acl_pkts = hdev->acl_pkts; in hci_get_dev_info()
2005 di.sco_mtu = hdev->sco_mtu; in hci_get_dev_info()
2006 di.sco_pkts = hdev->sco_pkts; in hci_get_dev_info()
2008 di.acl_mtu = hdev->le_mtu; in hci_get_dev_info()
2009 di.acl_pkts = hdev->le_pkts; in hci_get_dev_info()
2013 di.link_policy = hdev->link_policy; in hci_get_dev_info()
2014 di.link_mode = hdev->link_mode; in hci_get_dev_info()
2016 memcpy(&di.stat, &hdev->stat, sizeof(di.stat)); in hci_get_dev_info()
2017 memcpy(&di.features, &hdev->features, sizeof(di.features)); in hci_get_dev_info()
2022 hci_dev_put(hdev); in hci_get_dev_info()
2031 struct hci_dev *hdev = data; in hci_rfkill_set_block() local
2033 BT_DBG("%p name %s blocked %d", hdev, hdev->name, blocked); in hci_rfkill_set_block()
2035 if (hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) in hci_rfkill_set_block()
2039 hci_dev_set_flag(hdev, HCI_RFKILLED); in hci_rfkill_set_block()
2040 if (!hci_dev_test_flag(hdev, HCI_SETUP) && in hci_rfkill_set_block()
2041 !hci_dev_test_flag(hdev, HCI_CONFIG)) in hci_rfkill_set_block()
2042 hci_dev_do_close(hdev); in hci_rfkill_set_block()
2044 hci_dev_clear_flag(hdev, HCI_RFKILLED); in hci_rfkill_set_block()
2056 struct hci_dev *hdev = container_of(work, struct hci_dev, power_on); in hci_power_on() local
2059 BT_DBG("%s", hdev->name); in hci_power_on()
2061 err = hci_dev_do_open(hdev); in hci_power_on()
2063 hci_dev_lock(hdev); in hci_power_on()
2064 mgmt_set_powered_failed(hdev, err); in hci_power_on()
2065 hci_dev_unlock(hdev); in hci_power_on()
2073 if (hci_dev_test_flag(hdev, HCI_RFKILLED) || in hci_power_on()
2074 hci_dev_test_flag(hdev, HCI_UNCONFIGURED) || in hci_power_on()
2075 (hdev->dev_type == HCI_BREDR && in hci_power_on()
2076 !bacmp(&hdev->bdaddr, BDADDR_ANY) && in hci_power_on()
2077 !bacmp(&hdev->static_addr, BDADDR_ANY))) { in hci_power_on()
2078 hci_dev_clear_flag(hdev, HCI_AUTO_OFF); in hci_power_on()
2079 hci_dev_do_close(hdev); in hci_power_on()
2080 } else if (hci_dev_test_flag(hdev, HCI_AUTO_OFF)) { in hci_power_on()
2081 queue_delayed_work(hdev->req_workqueue, &hdev->power_off, in hci_power_on()
2085 if (hci_dev_test_and_clear_flag(hdev, HCI_SETUP)) { in hci_power_on()
2089 if (hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) in hci_power_on()
2090 set_bit(HCI_RAW, &hdev->flags); in hci_power_on()
2099 mgmt_index_added(hdev); in hci_power_on()
2100 } else if (hci_dev_test_and_clear_flag(hdev, HCI_CONFIG)) { in hci_power_on()
2104 if (!hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) in hci_power_on()
2105 clear_bit(HCI_RAW, &hdev->flags); in hci_power_on()
2111 mgmt_index_added(hdev); in hci_power_on()
2117 struct hci_dev *hdev = container_of(work, struct hci_dev, in hci_power_off() local
2120 BT_DBG("%s", hdev->name); in hci_power_off()
2122 hci_dev_do_close(hdev); in hci_power_off()
2127 struct hci_dev *hdev = container_of(work, struct hci_dev, error_reset); in hci_error_reset() local
2129 BT_DBG("%s", hdev->name); in hci_error_reset()
2131 if (hdev->hw_error) in hci_error_reset()
2132 hdev->hw_error(hdev, hdev->hw_error_code); in hci_error_reset()
2134 BT_ERR("%s hardware error 0x%2.2x", hdev->name, in hci_error_reset()
2135 hdev->hw_error_code); in hci_error_reset()
2137 if (hci_dev_do_close(hdev)) in hci_error_reset()
2140 hci_dev_do_open(hdev); in hci_error_reset()
2145 struct hci_dev *hdev; in hci_discov_off() local
2147 hdev = container_of(work, struct hci_dev, discov_off.work); in hci_discov_off()
2149 BT_DBG("%s", hdev->name); in hci_discov_off()
2151 mgmt_discoverable_timeout(hdev); in hci_discov_off()
2154 void hci_uuids_clear(struct hci_dev *hdev) in hci_uuids_clear() argument
2158 list_for_each_entry_safe(uuid, tmp, &hdev->uuids, list) { in hci_uuids_clear()
2164 void hci_link_keys_clear(struct hci_dev *hdev) in hci_link_keys_clear() argument
2168 list_for_each_entry_rcu(key, &hdev->link_keys, list) { in hci_link_keys_clear()
2174 void hci_smp_ltks_clear(struct hci_dev *hdev) in hci_smp_ltks_clear() argument
2178 list_for_each_entry_rcu(k, &hdev->long_term_keys, list) { in hci_smp_ltks_clear()
2184 void hci_smp_irks_clear(struct hci_dev *hdev) in hci_smp_irks_clear() argument
2188 list_for_each_entry_rcu(k, &hdev->identity_resolving_keys, list) { in hci_smp_irks_clear()
2194 struct link_key *hci_find_link_key(struct hci_dev *hdev, bdaddr_t *bdaddr) in hci_find_link_key() argument
2199 list_for_each_entry_rcu(k, &hdev->link_keys, list) { in hci_find_link_key()
2210 static bool hci_persistent_key(struct hci_dev *hdev, struct hci_conn *conn, in hci_persistent_key() argument
2258 struct smp_ltk *hci_find_ltk(struct hci_dev *hdev, bdaddr_t *bdaddr, in hci_find_ltk() argument
2264 list_for_each_entry_rcu(k, &hdev->long_term_keys, list) { in hci_find_ltk()
2278 struct smp_irk *hci_find_irk_by_rpa(struct hci_dev *hdev, bdaddr_t *rpa) in hci_find_irk_by_rpa() argument
2283 list_for_each_entry_rcu(irk, &hdev->identity_resolving_keys, list) { in hci_find_irk_by_rpa()
2290 list_for_each_entry_rcu(irk, &hdev->identity_resolving_keys, list) { in hci_find_irk_by_rpa()
2291 if (smp_irk_matches(hdev, irk->val, rpa)) { in hci_find_irk_by_rpa()
2302 struct smp_irk *hci_find_irk_by_addr(struct hci_dev *hdev, bdaddr_t *bdaddr, in hci_find_irk_by_addr() argument
2312 list_for_each_entry_rcu(irk, &hdev->identity_resolving_keys, list) { in hci_find_irk_by_addr()
2324 struct link_key *hci_add_link_key(struct hci_dev *hdev, struct hci_conn *conn, in hci_add_link_key() argument
2331 old_key = hci_find_link_key(hdev, bdaddr); in hci_add_link_key()
2340 list_add_rcu(&key->list, &hdev->link_keys); in hci_add_link_key()
2343 BT_DBG("%s key for %pMR type %u", hdev->name, bdaddr, type); in hci_add_link_key()
2365 *persistent = hci_persistent_key(hdev, conn, type, in hci_add_link_key()
2371 struct smp_ltk *hci_add_ltk(struct hci_dev *hdev, bdaddr_t *bdaddr, in hci_add_ltk() argument
2378 old_key = hci_find_ltk(hdev, bdaddr, addr_type, role); in hci_add_ltk()
2385 list_add_rcu(&key->list, &hdev->long_term_keys); in hci_add_ltk()
2400 struct smp_irk *hci_add_irk(struct hci_dev *hdev, bdaddr_t *bdaddr, in hci_add_irk() argument
2405 irk = hci_find_irk_by_addr(hdev, bdaddr, addr_type); in hci_add_irk()
2414 list_add_rcu(&irk->list, &hdev->identity_resolving_keys); in hci_add_irk()
2423 int hci_remove_link_key(struct hci_dev *hdev, bdaddr_t *bdaddr) in hci_remove_link_key() argument
2427 key = hci_find_link_key(hdev, bdaddr); in hci_remove_link_key()
2431 BT_DBG("%s removing %pMR", hdev->name, bdaddr); in hci_remove_link_key()
2439 int hci_remove_ltk(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 bdaddr_type) in hci_remove_ltk() argument
2444 list_for_each_entry_rcu(k, &hdev->long_term_keys, list) { in hci_remove_ltk()
2448 BT_DBG("%s removing %pMR", hdev->name, bdaddr); in hci_remove_ltk()
2458 void hci_remove_irk(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 addr_type) in hci_remove_irk() argument
2462 list_for_each_entry_rcu(k, &hdev->identity_resolving_keys, list) { in hci_remove_irk()
2466 BT_DBG("%s removing %pMR", hdev->name, bdaddr); in hci_remove_irk()
2473 bool hci_bdaddr_is_paired(struct hci_dev *hdev, bdaddr_t *bdaddr, u8 type) in hci_bdaddr_is_paired() argument
2480 if (hci_find_link_key(hdev, bdaddr)) in hci_bdaddr_is_paired()
2491 irk = hci_get_irk(hdev, bdaddr, addr_type); in hci_bdaddr_is_paired()
2498 list_for_each_entry_rcu(k, &hdev->long_term_keys, list) { in hci_bdaddr_is_paired()
2512 struct hci_dev *hdev = container_of(work, struct hci_dev, in hci_cmd_timeout() local
2515 if (hdev->sent_cmd) { in hci_cmd_timeout()
2516 struct hci_command_hdr *sent = (void *) hdev->sent_cmd->data; in hci_cmd_timeout()
2519 BT_ERR("%s command 0x%4.4x tx timeout", hdev->name, opcode); in hci_cmd_timeout()
2521 BT_ERR("%s command tx timeout", hdev->name); in hci_cmd_timeout()
2524 atomic_set(&hdev->cmd_cnt, 1); in hci_cmd_timeout()
2525 queue_work(hdev->workqueue, &hdev->cmd_work); in hci_cmd_timeout()
2528 struct oob_data *hci_find_remote_oob_data(struct hci_dev *hdev, in hci_find_remote_oob_data() argument
2533 list_for_each_entry(data, &hdev->remote_oob_data, list) { in hci_find_remote_oob_data()
2544 int hci_remove_remote_oob_data(struct hci_dev *hdev, bdaddr_t *bdaddr, in hci_remove_remote_oob_data() argument
2549 data = hci_find_remote_oob_data(hdev, bdaddr, bdaddr_type); in hci_remove_remote_oob_data()
2553 BT_DBG("%s removing %pMR (%u)", hdev->name, bdaddr, bdaddr_type); in hci_remove_remote_oob_data()
2561 void hci_remote_oob_data_clear(struct hci_dev *hdev) in hci_remote_oob_data_clear() argument
2565 list_for_each_entry_safe(data, n, &hdev->remote_oob_data, list) { in hci_remote_oob_data_clear()
2571 int hci_add_remote_oob_data(struct hci_dev *hdev, bdaddr_t *bdaddr, in hci_add_remote_oob_data() argument
2577 data = hci_find_remote_oob_data(hdev, bdaddr, bdaddr_type); in hci_add_remote_oob_data()
2585 list_add(&data->list, &hdev->remote_oob_data); in hci_add_remote_oob_data()
2612 BT_DBG("%s for %pMR", hdev->name, bdaddr); in hci_add_remote_oob_data()
2684 struct hci_conn_params *hci_conn_params_lookup(struct hci_dev *hdev, in hci_conn_params_lookup() argument
2693 list_for_each_entry(params, &hdev->le_conn_params, list) { in hci_conn_params_lookup()
2723 struct hci_conn_params *hci_conn_params_add(struct hci_dev *hdev, in hci_conn_params_add() argument
2731 params = hci_conn_params_lookup(hdev, addr, addr_type); in hci_conn_params_add()
2744 list_add(¶ms->list, &hdev->le_conn_params); in hci_conn_params_add()
2747 params->conn_min_interval = hdev->le_conn_min_interval; in hci_conn_params_add()
2748 params->conn_max_interval = hdev->le_conn_max_interval; in hci_conn_params_add()
2749 params->conn_latency = hdev->le_conn_latency; in hci_conn_params_add()
2750 params->supervision_timeout = hdev->le_supv_timeout; in hci_conn_params_add()
2771 void hci_conn_params_del(struct hci_dev *hdev, bdaddr_t *addr, u8 addr_type) in hci_conn_params_del() argument
2775 params = hci_conn_params_lookup(hdev, addr, addr_type); in hci_conn_params_del()
2781 hci_update_background_scan(hdev); in hci_conn_params_del()
2787 void hci_conn_params_clear_disabled(struct hci_dev *hdev) in hci_conn_params_clear_disabled() argument
2791 list_for_each_entry_safe(params, tmp, &hdev->le_conn_params, list) { in hci_conn_params_clear_disabled()
2802 void hci_conn_params_clear_all(struct hci_dev *hdev) in hci_conn_params_clear_all() argument
2806 list_for_each_entry_safe(params, tmp, &hdev->le_conn_params, list) in hci_conn_params_clear_all()
2809 hci_update_background_scan(hdev); in hci_conn_params_clear_all()
2814 static void inquiry_complete(struct hci_dev *hdev, u8 status, u16 opcode) in inquiry_complete() argument
2819 hci_dev_lock(hdev); in inquiry_complete()
2820 hci_discovery_set_state(hdev, DISCOVERY_STOPPED); in inquiry_complete()
2821 hci_dev_unlock(hdev); in inquiry_complete()
2826 static void le_scan_disable_work_complete(struct hci_dev *hdev, u8 status, in le_scan_disable_work_complete() argument
2839 hdev->discovery.scan_start = 0; in le_scan_disable_work_complete()
2841 switch (hdev->discovery.type) { in le_scan_disable_work_complete()
2843 hci_dev_lock(hdev); in le_scan_disable_work_complete()
2844 hci_discovery_set_state(hdev, DISCOVERY_STOPPED); in le_scan_disable_work_complete()
2845 hci_dev_unlock(hdev); in le_scan_disable_work_complete()
2849 hci_dev_lock(hdev); in le_scan_disable_work_complete()
2852 &hdev->quirks)) { in le_scan_disable_work_complete()
2860 if (!test_bit(HCI_INQUIRY, &hdev->flags) && in le_scan_disable_work_complete()
2861 hdev->discovery.state != DISCOVERY_RESOLVING) in le_scan_disable_work_complete()
2862 hci_discovery_set_state(hdev, in le_scan_disable_work_complete()
2867 hci_inquiry_cache_flush(hdev); in le_scan_disable_work_complete()
2869 hci_req_init(&req, hdev); in le_scan_disable_work_complete()
2879 hci_discovery_set_state(hdev, in le_scan_disable_work_complete()
2884 hci_dev_unlock(hdev); in le_scan_disable_work_complete()
2891 struct hci_dev *hdev = container_of(work, struct hci_dev, in le_scan_disable_work() local
2896 BT_DBG("%s", hdev->name); in le_scan_disable_work()
2898 cancel_delayed_work_sync(&hdev->le_scan_restart); in le_scan_disable_work()
2900 hci_req_init(&req, hdev); in le_scan_disable_work()
2909 static void le_scan_restart_work_complete(struct hci_dev *hdev, u8 status, in le_scan_restart_work_complete() argument
2914 BT_DBG("%s", hdev->name); in le_scan_restart_work_complete()
2921 if (!test_bit(HCI_QUIRK_STRICT_DUPLICATE_FILTER, &hdev->quirks) || in le_scan_restart_work_complete()
2922 !hdev->discovery.scan_start) in le_scan_restart_work_complete()
2930 duration = hdev->discovery.scan_duration; in le_scan_restart_work_complete()
2931 scan_start = hdev->discovery.scan_start; in le_scan_restart_work_complete()
2945 queue_delayed_work(hdev->workqueue, in le_scan_restart_work_complete()
2946 &hdev->le_scan_disable, timeout); in le_scan_restart_work_complete()
2951 struct hci_dev *hdev = container_of(work, struct hci_dev, in le_scan_restart_work() local
2957 BT_DBG("%s", hdev->name); in le_scan_restart_work()
2960 if (!hci_dev_test_flag(hdev, HCI_LE_SCAN)) in le_scan_restart_work()
2963 hci_req_init(&req, hdev); in le_scan_restart_work()
2990 void hci_copy_identity_address(struct hci_dev *hdev, bdaddr_t *bdaddr, in hci_copy_identity_address() argument
2993 if (hci_dev_test_flag(hdev, HCI_FORCE_STATIC_ADDR) || in hci_copy_identity_address()
2994 !bacmp(&hdev->bdaddr, BDADDR_ANY) || in hci_copy_identity_address()
2995 (!hci_dev_test_flag(hdev, HCI_BREDR_ENABLED) && in hci_copy_identity_address()
2996 bacmp(&hdev->static_addr, BDADDR_ANY))) { in hci_copy_identity_address()
2997 bacpy(bdaddr, &hdev->static_addr); in hci_copy_identity_address()
3000 bacpy(bdaddr, &hdev->bdaddr); in hci_copy_identity_address()
3008 struct hci_dev *hdev; in hci_alloc_dev() local
3010 hdev = kzalloc(sizeof(*hdev), GFP_KERNEL); in hci_alloc_dev()
3011 if (!hdev) in hci_alloc_dev()
3014 hdev->pkt_type = (HCI_DM1 | HCI_DH1 | HCI_HV1); in hci_alloc_dev()
3015 hdev->esco_type = (ESCO_HV1); in hci_alloc_dev()
3016 hdev->link_mode = (HCI_LM_ACCEPT); in hci_alloc_dev()
3017 hdev->num_iac = 0x01; /* One IAC support is mandatory */ in hci_alloc_dev()
3018 hdev->io_capability = 0x03; /* No Input No Output */ in hci_alloc_dev()
3019 hdev->manufacturer = 0xffff; /* Default to internal use */ in hci_alloc_dev()
3020 hdev->inq_tx_power = HCI_TX_POWER_INVALID; in hci_alloc_dev()
3021 hdev->adv_tx_power = HCI_TX_POWER_INVALID; in hci_alloc_dev()
3023 hdev->sniff_max_interval = 800; in hci_alloc_dev()
3024 hdev->sniff_min_interval = 80; in hci_alloc_dev()
3026 hdev->le_adv_channel_map = 0x07; in hci_alloc_dev()
3027 hdev->le_adv_min_interval = 0x0800; in hci_alloc_dev()
3028 hdev->le_adv_max_interval = 0x0800; in hci_alloc_dev()
3029 hdev->le_scan_interval = 0x0060; in hci_alloc_dev()
3030 hdev->le_scan_window = 0x0030; in hci_alloc_dev()
3031 hdev->le_conn_min_interval = 0x0028; in hci_alloc_dev()
3032 hdev->le_conn_max_interval = 0x0038; in hci_alloc_dev()
3033 hdev->le_conn_latency = 0x0000; in hci_alloc_dev()
3034 hdev->le_supv_timeout = 0x002a; in hci_alloc_dev()
3035 hdev->le_def_tx_len = 0x001b; in hci_alloc_dev()
3036 hdev->le_def_tx_time = 0x0148; in hci_alloc_dev()
3037 hdev->le_max_tx_len = 0x001b; in hci_alloc_dev()
3038 hdev->le_max_tx_time = 0x0148; in hci_alloc_dev()
3039 hdev->le_max_rx_len = 0x001b; in hci_alloc_dev()
3040 hdev->le_max_rx_time = 0x0148; in hci_alloc_dev()
3042 hdev->rpa_timeout = HCI_DEFAULT_RPA_TIMEOUT; in hci_alloc_dev()
3043 hdev->discov_interleaved_timeout = DISCOV_INTERLEAVED_TIMEOUT; in hci_alloc_dev()
3044 hdev->conn_info_min_age = DEFAULT_CONN_INFO_MIN_AGE; in hci_alloc_dev()
3045 hdev->conn_info_max_age = DEFAULT_CONN_INFO_MAX_AGE; in hci_alloc_dev()
3047 mutex_init(&hdev->lock); in hci_alloc_dev()
3048 mutex_init(&hdev->req_lock); in hci_alloc_dev()
3050 INIT_LIST_HEAD(&hdev->mgmt_pending); in hci_alloc_dev()
3051 INIT_LIST_HEAD(&hdev->blacklist); in hci_alloc_dev()
3052 INIT_LIST_HEAD(&hdev->whitelist); in hci_alloc_dev()
3053 INIT_LIST_HEAD(&hdev->uuids); in hci_alloc_dev()
3054 INIT_LIST_HEAD(&hdev->link_keys); in hci_alloc_dev()
3055 INIT_LIST_HEAD(&hdev->long_term_keys); in hci_alloc_dev()
3056 INIT_LIST_HEAD(&hdev->identity_resolving_keys); in hci_alloc_dev()
3057 INIT_LIST_HEAD(&hdev->remote_oob_data); in hci_alloc_dev()
3058 INIT_LIST_HEAD(&hdev->le_white_list); in hci_alloc_dev()
3059 INIT_LIST_HEAD(&hdev->le_conn_params); in hci_alloc_dev()
3060 INIT_LIST_HEAD(&hdev->pend_le_conns); in hci_alloc_dev()
3061 INIT_LIST_HEAD(&hdev->pend_le_reports); in hci_alloc_dev()
3062 INIT_LIST_HEAD(&hdev->conn_hash.list); in hci_alloc_dev()
3064 INIT_WORK(&hdev->rx_work, hci_rx_work); in hci_alloc_dev()
3065 INIT_WORK(&hdev->cmd_work, hci_cmd_work); in hci_alloc_dev()
3066 INIT_WORK(&hdev->tx_work, hci_tx_work); in hci_alloc_dev()
3067 INIT_WORK(&hdev->power_on, hci_power_on); in hci_alloc_dev()
3068 INIT_WORK(&hdev->error_reset, hci_error_reset); in hci_alloc_dev()
3070 INIT_DELAYED_WORK(&hdev->power_off, hci_power_off); in hci_alloc_dev()
3071 INIT_DELAYED_WORK(&hdev->discov_off, hci_discov_off); in hci_alloc_dev()
3072 INIT_DELAYED_WORK(&hdev->le_scan_disable, le_scan_disable_work); in hci_alloc_dev()
3073 INIT_DELAYED_WORK(&hdev->le_scan_restart, le_scan_restart_work); in hci_alloc_dev()
3075 skb_queue_head_init(&hdev->rx_q); in hci_alloc_dev()
3076 skb_queue_head_init(&hdev->cmd_q); in hci_alloc_dev()
3077 skb_queue_head_init(&hdev->raw_q); in hci_alloc_dev()
3079 init_waitqueue_head(&hdev->req_wait_q); in hci_alloc_dev()
3081 INIT_DELAYED_WORK(&hdev->cmd_timer, hci_cmd_timeout); in hci_alloc_dev()
3083 hci_init_sysfs(hdev); in hci_alloc_dev()
3084 discovery_init(hdev); in hci_alloc_dev()
3085 adv_info_init(hdev); in hci_alloc_dev()
3087 return hdev; in hci_alloc_dev()
3092 void hci_free_dev(struct hci_dev *hdev) in hci_free_dev() argument
3095 put_device(&hdev->dev); in hci_free_dev()
3100 int hci_register_dev(struct hci_dev *hdev) in hci_register_dev() argument
3104 if (!hdev->open || !hdev->close || !hdev->send) in hci_register_dev()
3110 switch (hdev->dev_type) { in hci_register_dev()
3124 sprintf(hdev->name, "hci%d", id); in hci_register_dev()
3125 hdev->id = id; in hci_register_dev()
3127 BT_DBG("%p name %s bus %d", hdev, hdev->name, hdev->bus); in hci_register_dev()
3129 hdev->workqueue = alloc_workqueue("%s", WQ_HIGHPRI | WQ_UNBOUND | in hci_register_dev()
3130 WQ_MEM_RECLAIM, 1, hdev->name); in hci_register_dev()
3131 if (!hdev->workqueue) { in hci_register_dev()
3136 hdev->req_workqueue = alloc_workqueue("%s", WQ_HIGHPRI | WQ_UNBOUND | in hci_register_dev()
3137 WQ_MEM_RECLAIM, 1, hdev->name); in hci_register_dev()
3138 if (!hdev->req_workqueue) { in hci_register_dev()
3139 destroy_workqueue(hdev->workqueue); in hci_register_dev()
3145 hdev->debugfs = debugfs_create_dir(hdev->name, bt_debugfs); in hci_register_dev()
3147 dev_set_name(&hdev->dev, "%s", hdev->name); in hci_register_dev()
3149 error = device_add(&hdev->dev); in hci_register_dev()
3153 hdev->rfkill = rfkill_alloc(hdev->name, &hdev->dev, in hci_register_dev()
3155 hdev); in hci_register_dev()
3156 if (hdev->rfkill) { in hci_register_dev()
3157 if (rfkill_register(hdev->rfkill) < 0) { in hci_register_dev()
3158 rfkill_destroy(hdev->rfkill); in hci_register_dev()
3159 hdev->rfkill = NULL; in hci_register_dev()
3163 if (hdev->rfkill && rfkill_blocked(hdev->rfkill)) in hci_register_dev()
3164 hci_dev_set_flag(hdev, HCI_RFKILLED); in hci_register_dev()
3166 hci_dev_set_flag(hdev, HCI_SETUP); in hci_register_dev()
3167 hci_dev_set_flag(hdev, HCI_AUTO_OFF); in hci_register_dev()
3169 if (hdev->dev_type == HCI_BREDR) { in hci_register_dev()
3173 hci_dev_set_flag(hdev, HCI_BREDR_ENABLED); in hci_register_dev()
3177 list_add(&hdev->list, &hci_dev_list); in hci_register_dev()
3183 if (test_bit(HCI_QUIRK_RAW_DEVICE, &hdev->quirks)) in hci_register_dev()
3184 hci_dev_set_flag(hdev, HCI_UNCONFIGURED); in hci_register_dev()
3186 hci_notify(hdev, HCI_DEV_REG); in hci_register_dev()
3187 hci_dev_hold(hdev); in hci_register_dev()
3189 queue_work(hdev->req_workqueue, &hdev->power_on); in hci_register_dev()
3194 destroy_workqueue(hdev->workqueue); in hci_register_dev()
3195 destroy_workqueue(hdev->req_workqueue); in hci_register_dev()
3197 ida_simple_remove(&hci_index_ida, hdev->id); in hci_register_dev()
3204 void hci_unregister_dev(struct hci_dev *hdev) in hci_unregister_dev() argument
3208 BT_DBG("%p name %s bus %d", hdev, hdev->name, hdev->bus); in hci_unregister_dev()
3210 hci_dev_set_flag(hdev, HCI_UNREGISTER); in hci_unregister_dev()
3212 id = hdev->id; in hci_unregister_dev()
3215 list_del(&hdev->list); in hci_unregister_dev()
3218 hci_dev_do_close(hdev); in hci_unregister_dev()
3220 cancel_work_sync(&hdev->power_on); in hci_unregister_dev()
3222 if (!test_bit(HCI_INIT, &hdev->flags) && in hci_unregister_dev()
3223 !hci_dev_test_flag(hdev, HCI_SETUP) && in hci_unregister_dev()
3224 !hci_dev_test_flag(hdev, HCI_CONFIG)) { in hci_unregister_dev()
3225 hci_dev_lock(hdev); in hci_unregister_dev()
3226 mgmt_index_removed(hdev); in hci_unregister_dev()
3227 hci_dev_unlock(hdev); in hci_unregister_dev()
3232 BUG_ON(!list_empty(&hdev->mgmt_pending)); in hci_unregister_dev()
3234 hci_notify(hdev, HCI_DEV_UNREG); in hci_unregister_dev()
3236 if (hdev->rfkill) { in hci_unregister_dev()
3237 rfkill_unregister(hdev->rfkill); in hci_unregister_dev()
3238 rfkill_destroy(hdev->rfkill); in hci_unregister_dev()
3241 device_del(&hdev->dev); in hci_unregister_dev()
3243 debugfs_remove_recursive(hdev->debugfs); in hci_unregister_dev()
3245 destroy_workqueue(hdev->workqueue); in hci_unregister_dev()
3246 destroy_workqueue(hdev->req_workqueue); in hci_unregister_dev()
3248 hci_dev_lock(hdev); in hci_unregister_dev()
3249 hci_bdaddr_list_clear(&hdev->blacklist); in hci_unregister_dev()
3250 hci_bdaddr_list_clear(&hdev->whitelist); in hci_unregister_dev()
3251 hci_uuids_clear(hdev); in hci_unregister_dev()
3252 hci_link_keys_clear(hdev); in hci_unregister_dev()
3253 hci_smp_ltks_clear(hdev); in hci_unregister_dev()
3254 hci_smp_irks_clear(hdev); in hci_unregister_dev()
3255 hci_remote_oob_data_clear(hdev); in hci_unregister_dev()
3256 hci_bdaddr_list_clear(&hdev->le_white_list); in hci_unregister_dev()
3257 hci_conn_params_clear_all(hdev); in hci_unregister_dev()
3258 hci_discovery_filter_clear(hdev); in hci_unregister_dev()
3259 hci_dev_unlock(hdev); in hci_unregister_dev()
3261 hci_dev_put(hdev); in hci_unregister_dev()
3268 int hci_suspend_dev(struct hci_dev *hdev) in hci_suspend_dev() argument
3270 hci_notify(hdev, HCI_DEV_SUSPEND); in hci_suspend_dev()
3276 int hci_resume_dev(struct hci_dev *hdev) in hci_resume_dev() argument
3278 hci_notify(hdev, HCI_DEV_RESUME); in hci_resume_dev()
3284 int hci_reset_dev(struct hci_dev *hdev) in hci_reset_dev() argument
3297 return hci_recv_frame(hdev, skb); in hci_reset_dev()
3302 int hci_recv_frame(struct hci_dev *hdev, struct sk_buff *skb) in hci_recv_frame() argument
3304 if (!hdev || (!test_bit(HCI_UP, &hdev->flags) in hci_recv_frame()
3305 && !test_bit(HCI_INIT, &hdev->flags))) { in hci_recv_frame()
3316 skb_queue_tail(&hdev->rx_q, skb); in hci_recv_frame()
3317 queue_work(hdev->workqueue, &hdev->rx_work); in hci_recv_frame()
3349 static void hci_send_frame(struct hci_dev *hdev, struct sk_buff *skb) in hci_send_frame() argument
3353 BT_DBG("%s type %d len %d", hdev->name, bt_cb(skb)->pkt_type, skb->len); in hci_send_frame()
3359 hci_send_to_monitor(hdev, skb); in hci_send_frame()
3361 if (atomic_read(&hdev->promisc)) { in hci_send_frame()
3363 hci_send_to_sock(hdev, skb); in hci_send_frame()
3369 err = hdev->send(hdev, skb); in hci_send_frame()
3371 BT_ERR("%s sending frame failed (%d)", hdev->name, err); in hci_send_frame()
3377 int hci_send_cmd(struct hci_dev *hdev, __u16 opcode, __u32 plen, in hci_send_cmd() argument
3382 BT_DBG("%s opcode 0x%4.4x plen %d", hdev->name, opcode, plen); in hci_send_cmd()
3384 skb = hci_prepare_cmd(hdev, opcode, plen, param); in hci_send_cmd()
3386 BT_ERR("%s no memory for command", hdev->name); in hci_send_cmd()
3395 skb_queue_tail(&hdev->cmd_q, skb); in hci_send_cmd()
3396 queue_work(hdev->workqueue, &hdev->cmd_work); in hci_send_cmd()
3402 void *hci_sent_cmd_data(struct hci_dev *hdev, __u16 opcode) in hci_sent_cmd_data() argument
3406 if (!hdev->sent_cmd) in hci_sent_cmd_data()
3409 hdr = (void *) hdev->sent_cmd->data; in hci_sent_cmd_data()
3414 BT_DBG("%s opcode 0x%4.4x", hdev->name, opcode); in hci_sent_cmd_data()
3416 return hdev->sent_cmd->data + HCI_COMMAND_HDR_SIZE; in hci_sent_cmd_data()
3436 struct hci_dev *hdev = conn->hdev; in hci_queue_acl() local
3444 switch (hdev->dev_type) { in hci_queue_acl()
3452 BT_ERR("%s unknown dev_type %d", hdev->name, hdev->dev_type); in hci_queue_acl()
3459 BT_DBG("%s nonfrag skb %p len %d", hdev->name, skb, skb->len); in hci_queue_acl()
3464 BT_DBG("%s frag %p len %d", hdev->name, skb, skb->len); in hci_queue_acl()
3485 BT_DBG("%s frag %p len %d", hdev->name, skb, skb->len); in hci_queue_acl()
3496 struct hci_dev *hdev = chan->conn->hdev; in hci_send_acl() local
3498 BT_DBG("%s chan %p flags 0x%4.4x", hdev->name, chan, flags); in hci_send_acl()
3502 queue_work(hdev->workqueue, &hdev->tx_work); in hci_send_acl()
3508 struct hci_dev *hdev = conn->hdev; in hci_send_sco() local
3511 BT_DBG("%s len %d", hdev->name, skb->len); in hci_send_sco()
3523 queue_work(hdev->workqueue, &hdev->tx_work); in hci_send_sco()
3529 static struct hci_conn *hci_low_sent(struct hci_dev *hdev, __u8 type, in hci_low_sent() argument
3532 struct hci_conn_hash *h = &hdev->conn_hash; in hci_low_sent()
3555 if (hci_conn_num(hdev, type) == num) in hci_low_sent()
3566 cnt = hdev->acl_cnt; in hci_low_sent()
3570 cnt = hdev->sco_cnt; in hci_low_sent()
3573 cnt = hdev->le_mtu ? hdev->le_cnt : hdev->acl_cnt; in hci_low_sent()
3589 static void hci_link_tx_to(struct hci_dev *hdev, __u8 type) in hci_link_tx_to() argument
3591 struct hci_conn_hash *h = &hdev->conn_hash; in hci_link_tx_to()
3594 BT_ERR("%s link tx timeout", hdev->name); in hci_link_tx_to()
3602 hdev->name, &c->dst); in hci_link_tx_to()
3610 static struct hci_chan *hci_chan_sent(struct hci_dev *hdev, __u8 type, in hci_chan_sent() argument
3613 struct hci_conn_hash *h = &hdev->conn_hash; in hci_chan_sent()
3619 BT_DBG("%s", hdev->name); in hci_chan_sent()
3658 if (hci_conn_num(hdev, type) == conn_num) in hci_chan_sent()
3669 cnt = hdev->acl_cnt; in hci_chan_sent()
3672 cnt = hdev->block_cnt; in hci_chan_sent()
3676 cnt = hdev->sco_cnt; in hci_chan_sent()
3679 cnt = hdev->le_mtu ? hdev->le_cnt : hdev->acl_cnt; in hci_chan_sent()
3692 static void hci_prio_recalculate(struct hci_dev *hdev, __u8 type) in hci_prio_recalculate() argument
3694 struct hci_conn_hash *h = &hdev->conn_hash; in hci_prio_recalculate()
3698 BT_DBG("%s", hdev->name); in hci_prio_recalculate()
3734 if (hci_conn_num(hdev, type) == num) in hci_prio_recalculate()
3742 static inline int __get_blocks(struct hci_dev *hdev, struct sk_buff *skb) in __get_blocks() argument
3745 return DIV_ROUND_UP(skb->len - HCI_ACL_HDR_SIZE, hdev->block_len); in __get_blocks()
3748 static void __check_timeout(struct hci_dev *hdev, unsigned int cnt) in __check_timeout() argument
3750 if (!hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) { in __check_timeout()
3753 if (!cnt && time_after(jiffies, hdev->acl_last_tx + in __check_timeout()
3755 hci_link_tx_to(hdev, ACL_LINK); in __check_timeout()
3759 static void hci_sched_acl_pkt(struct hci_dev *hdev) in hci_sched_acl_pkt() argument
3761 unsigned int cnt = hdev->acl_cnt; in hci_sched_acl_pkt()
3766 __check_timeout(hdev, cnt); in hci_sched_acl_pkt()
3768 while (hdev->acl_cnt && in hci_sched_acl_pkt()
3769 (chan = hci_chan_sent(hdev, ACL_LINK, "e))) { in hci_sched_acl_pkt()
3784 hci_send_frame(hdev, skb); in hci_sched_acl_pkt()
3785 hdev->acl_last_tx = jiffies; in hci_sched_acl_pkt()
3787 hdev->acl_cnt--; in hci_sched_acl_pkt()
3793 if (cnt != hdev->acl_cnt) in hci_sched_acl_pkt()
3794 hci_prio_recalculate(hdev, ACL_LINK); in hci_sched_acl_pkt()
3797 static void hci_sched_acl_blk(struct hci_dev *hdev) in hci_sched_acl_blk() argument
3799 unsigned int cnt = hdev->block_cnt; in hci_sched_acl_blk()
3805 __check_timeout(hdev, cnt); in hci_sched_acl_blk()
3807 BT_DBG("%s", hdev->name); in hci_sched_acl_blk()
3809 if (hdev->dev_type == HCI_AMP) in hci_sched_acl_blk()
3814 while (hdev->block_cnt > 0 && in hci_sched_acl_blk()
3815 (chan = hci_chan_sent(hdev, type, "e))) { in hci_sched_acl_blk()
3829 blocks = __get_blocks(hdev, skb); in hci_sched_acl_blk()
3830 if (blocks > hdev->block_cnt) in hci_sched_acl_blk()
3836 hci_send_frame(hdev, skb); in hci_sched_acl_blk()
3837 hdev->acl_last_tx = jiffies; in hci_sched_acl_blk()
3839 hdev->block_cnt -= blocks; in hci_sched_acl_blk()
3847 if (cnt != hdev->block_cnt) in hci_sched_acl_blk()
3848 hci_prio_recalculate(hdev, type); in hci_sched_acl_blk()
3851 static void hci_sched_acl(struct hci_dev *hdev) in hci_sched_acl() argument
3853 BT_DBG("%s", hdev->name); in hci_sched_acl()
3856 if (!hci_conn_num(hdev, ACL_LINK) && hdev->dev_type == HCI_BREDR) in hci_sched_acl()
3860 if (!hci_conn_num(hdev, AMP_LINK) && hdev->dev_type == HCI_AMP) in hci_sched_acl()
3863 switch (hdev->flow_ctl_mode) { in hci_sched_acl()
3865 hci_sched_acl_pkt(hdev); in hci_sched_acl()
3869 hci_sched_acl_blk(hdev); in hci_sched_acl()
3875 static void hci_sched_sco(struct hci_dev *hdev) in hci_sched_sco() argument
3881 BT_DBG("%s", hdev->name); in hci_sched_sco()
3883 if (!hci_conn_num(hdev, SCO_LINK)) in hci_sched_sco()
3886 while (hdev->sco_cnt && (conn = hci_low_sent(hdev, SCO_LINK, "e))) { in hci_sched_sco()
3889 hci_send_frame(hdev, skb); in hci_sched_sco()
3898 static void hci_sched_esco(struct hci_dev *hdev) in hci_sched_esco() argument
3904 BT_DBG("%s", hdev->name); in hci_sched_esco()
3906 if (!hci_conn_num(hdev, ESCO_LINK)) in hci_sched_esco()
3909 while (hdev->sco_cnt && (conn = hci_low_sent(hdev, ESCO_LINK, in hci_sched_esco()
3913 hci_send_frame(hdev, skb); in hci_sched_esco()
3922 static void hci_sched_le(struct hci_dev *hdev) in hci_sched_le() argument
3928 BT_DBG("%s", hdev->name); in hci_sched_le()
3930 if (!hci_conn_num(hdev, LE_LINK)) in hci_sched_le()
3933 if (!hci_dev_test_flag(hdev, HCI_UNCONFIGURED)) { in hci_sched_le()
3936 if (!hdev->le_cnt && hdev->le_pkts && in hci_sched_le()
3937 time_after(jiffies, hdev->le_last_tx + HZ * 45)) in hci_sched_le()
3938 hci_link_tx_to(hdev, LE_LINK); in hci_sched_le()
3941 cnt = hdev->le_pkts ? hdev->le_cnt : hdev->acl_cnt; in hci_sched_le()
3943 while (cnt && (chan = hci_chan_sent(hdev, LE_LINK, "e))) { in hci_sched_le()
3955 hci_send_frame(hdev, skb); in hci_sched_le()
3956 hdev->le_last_tx = jiffies; in hci_sched_le()
3964 if (hdev->le_pkts) in hci_sched_le()
3965 hdev->le_cnt = cnt; in hci_sched_le()
3967 hdev->acl_cnt = cnt; in hci_sched_le()
3970 hci_prio_recalculate(hdev, LE_LINK); in hci_sched_le()
3975 struct hci_dev *hdev = container_of(work, struct hci_dev, tx_work); in hci_tx_work() local
3978 BT_DBG("%s acl %d sco %d le %d", hdev->name, hdev->acl_cnt, in hci_tx_work()
3979 hdev->sco_cnt, hdev->le_cnt); in hci_tx_work()
3981 if (!hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) { in hci_tx_work()
3983 hci_sched_acl(hdev); in hci_tx_work()
3984 hci_sched_sco(hdev); in hci_tx_work()
3985 hci_sched_esco(hdev); in hci_tx_work()
3986 hci_sched_le(hdev); in hci_tx_work()
3990 while ((skb = skb_dequeue(&hdev->raw_q))) in hci_tx_work()
3991 hci_send_frame(hdev, skb); in hci_tx_work()
3997 static void hci_acldata_packet(struct hci_dev *hdev, struct sk_buff *skb) in hci_acldata_packet() argument
4009 BT_DBG("%s len %d handle 0x%4.4x flags 0x%4.4x", hdev->name, skb->len, in hci_acldata_packet()
4012 hdev->stat.acl_rx++; in hci_acldata_packet()
4014 hci_dev_lock(hdev); in hci_acldata_packet()
4015 conn = hci_conn_hash_lookup_handle(hdev, handle); in hci_acldata_packet()
4016 hci_dev_unlock(hdev); in hci_acldata_packet()
4026 hdev->name, handle); in hci_acldata_packet()
4033 static void hci_scodata_packet(struct hci_dev *hdev, struct sk_buff *skb) in hci_scodata_packet() argument
4043 BT_DBG("%s len %d handle 0x%4.4x", hdev->name, skb->len, handle); in hci_scodata_packet()
4045 hdev->stat.sco_rx++; in hci_scodata_packet()
4047 hci_dev_lock(hdev); in hci_scodata_packet()
4048 conn = hci_conn_hash_lookup_handle(hdev, handle); in hci_scodata_packet()
4049 hci_dev_unlock(hdev); in hci_scodata_packet()
4057 hdev->name, handle); in hci_scodata_packet()
4063 static bool hci_req_is_complete(struct hci_dev *hdev) in hci_req_is_complete() argument
4067 skb = skb_peek(&hdev->cmd_q); in hci_req_is_complete()
4074 static void hci_resend_last(struct hci_dev *hdev) in hci_resend_last() argument
4080 if (!hdev->sent_cmd) in hci_resend_last()
4083 sent = (void *) hdev->sent_cmd->data; in hci_resend_last()
4088 skb = skb_clone(hdev->sent_cmd, GFP_KERNEL); in hci_resend_last()
4092 skb_queue_head(&hdev->cmd_q, skb); in hci_resend_last()
4093 queue_work(hdev->workqueue, &hdev->cmd_work); in hci_resend_last()
4096 void hci_req_cmd_complete(struct hci_dev *hdev, u16 opcode, u8 status, in hci_req_cmd_complete() argument
4108 if (!hci_sent_cmd_data(hdev, opcode)) { in hci_req_cmd_complete()
4115 if (test_bit(HCI_INIT, &hdev->flags) && opcode == HCI_OP_RESET) in hci_req_cmd_complete()
4116 hci_resend_last(hdev); in hci_req_cmd_complete()
4124 if (!status && !hci_req_is_complete(hdev)) in hci_req_cmd_complete()
4131 if (bt_cb(hdev->sent_cmd)->req.complete) { in hci_req_cmd_complete()
4132 *req_complete = bt_cb(hdev->sent_cmd)->req.complete; in hci_req_cmd_complete()
4136 if (bt_cb(hdev->sent_cmd)->req.complete_skb) { in hci_req_cmd_complete()
4137 *req_complete_skb = bt_cb(hdev->sent_cmd)->req.complete_skb; in hci_req_cmd_complete()
4142 spin_lock_irqsave(&hdev->cmd_q.lock, flags); in hci_req_cmd_complete()
4143 while ((skb = __skb_dequeue(&hdev->cmd_q))) { in hci_req_cmd_complete()
4145 __skb_queue_head(&hdev->cmd_q, skb); in hci_req_cmd_complete()
4153 spin_unlock_irqrestore(&hdev->cmd_q.lock, flags); in hci_req_cmd_complete()
4158 struct hci_dev *hdev = container_of(work, struct hci_dev, rx_work); in hci_rx_work() local
4161 BT_DBG("%s", hdev->name); in hci_rx_work()
4163 while ((skb = skb_dequeue(&hdev->rx_q))) { in hci_rx_work()
4165 hci_send_to_monitor(hdev, skb); in hci_rx_work()
4167 if (atomic_read(&hdev->promisc)) { in hci_rx_work()
4169 hci_send_to_sock(hdev, skb); in hci_rx_work()
4172 if (hci_dev_test_flag(hdev, HCI_USER_CHANNEL)) { in hci_rx_work()
4177 if (test_bit(HCI_INIT, &hdev->flags)) { in hci_rx_work()
4190 BT_DBG("%s Event packet", hdev->name); in hci_rx_work()
4191 hci_event_packet(hdev, skb); in hci_rx_work()
4195 BT_DBG("%s ACL data packet", hdev->name); in hci_rx_work()
4196 hci_acldata_packet(hdev, skb); in hci_rx_work()
4200 BT_DBG("%s SCO data packet", hdev->name); in hci_rx_work()
4201 hci_scodata_packet(hdev, skb); in hci_rx_work()
4213 struct hci_dev *hdev = container_of(work, struct hci_dev, cmd_work); in hci_cmd_work() local
4216 BT_DBG("%s cmd_cnt %d cmd queued %d", hdev->name, in hci_cmd_work()
4217 atomic_read(&hdev->cmd_cnt), skb_queue_len(&hdev->cmd_q)); in hci_cmd_work()
4220 if (atomic_read(&hdev->cmd_cnt)) { in hci_cmd_work()
4221 skb = skb_dequeue(&hdev->cmd_q); in hci_cmd_work()
4225 kfree_skb(hdev->sent_cmd); in hci_cmd_work()
4227 hdev->sent_cmd = skb_clone(skb, GFP_KERNEL); in hci_cmd_work()
4228 if (hdev->sent_cmd) { in hci_cmd_work()
4229 atomic_dec(&hdev->cmd_cnt); in hci_cmd_work()
4230 hci_send_frame(hdev, skb); in hci_cmd_work()
4231 if (test_bit(HCI_RESET, &hdev->flags)) in hci_cmd_work()
4232 cancel_delayed_work(&hdev->cmd_timer); in hci_cmd_work()
4234 schedule_delayed_work(&hdev->cmd_timer, in hci_cmd_work()
4237 skb_queue_head(&hdev->cmd_q, skb); in hci_cmd_work()
4238 queue_work(hdev->workqueue, &hdev->cmd_work); in hci_cmd_work()