Lines Matching +full:x +full:- +full:rp
1 // SPDX-License-Identifier: GPL-2.0-only
14 #define MSFT_RSSI_THRESHOLD_VALUE_MIN -127
146 struct msft_rp_read_supported_features *rp; in read_supported_features() local
151 skb = __hci_cmd_sync(hdev, hdev->msft_opcode, sizeof(cp), &cp, in read_supported_features()
155 skb = ERR_PTR(-EIO); in read_supported_features()
162 if (skb->len < sizeof(*rp)) { in read_supported_features()
167 rp = (struct msft_rp_read_supported_features *)skb->data; in read_supported_features()
169 if (rp->sub_opcode != MSFT_OP_READ_SUPPORTED_FEATURES) in read_supported_features()
172 if (rp->evt_prefix_len > 0) { in read_supported_features()
173 msft->evt_prefix = kmemdup(rp->evt_prefix, rp->evt_prefix_len, in read_supported_features()
175 if (!msft->evt_prefix) in read_supported_features()
179 msft->evt_prefix_len = rp->evt_prefix_len; in read_supported_features()
180 msft->features = __le64_to_cpu(rp->features); in read_supported_features()
182 if (msft->features & MSFT_FEATURE_MASK_CURVE_VALIDITY) in read_supported_features()
183 hdev->msft_curve_validity = true; in read_supported_features()
195 * This function requires the caller holds hdev->lock
201 struct msft_data *msft = hdev->msft_data; in msft_find_handle_data()
203 list_for_each_entry(entry, &msft->handle_map, list) { in msft_find_handle_data()
204 if (is_mgmt && entry->mgmt_handle == handle) in msft_find_handle_data()
206 if (!is_mgmt && entry->msft_handle == handle) in msft_find_handle_data()
213 /* This function requires the caller holds msft->filter_lock */
219 struct msft_data *msft = hdev->msft_data; in msft_find_address_data()
221 list_for_each_entry(entry, &msft->address_filters, list) { in msft_find_address_data()
222 if (entry->pattern_handle == pattern_handle && in msft_find_address_data()
223 addr_type == entry->addr_type && in msft_find_address_data()
224 !bacmp(addr, &entry->bdaddr)) in msft_find_address_data()
231 /* This function requires the caller holds hdev->lock */
239 list_for_each_entry_safe(dev, tmp, &hdev->monitored_devices, list) { in msft_monitor_device_del()
244 if ((!mgmt_handle || dev->handle == mgmt_handle) && in msft_monitor_device_del()
245 (!bdaddr || (!bacmp(bdaddr, &dev->bdaddr) && in msft_monitor_device_del()
246 addr_type == dev->addr_type))) { in msft_monitor_device_del()
247 if (notify && dev->notified) { in msft_monitor_device_del()
248 mgmt_adv_monitor_device_lost(hdev, dev->handle, in msft_monitor_device_del()
249 &dev->bdaddr, in msft_monitor_device_del()
250 dev->addr_type); in msft_monitor_device_del()
253 list_del(&dev->list); in msft_monitor_device_del()
266 struct msft_rp_le_monitor_advertisement *rp; in msft_le_monitor_advertisement_cb() local
268 struct msft_data *msft = hdev->msft_data; in msft_le_monitor_advertisement_cb()
273 rp = (struct msft_rp_le_monitor_advertisement *)skb->data; in msft_le_monitor_advertisement_cb()
274 if (skb->len < sizeof(*rp)) { in msft_le_monitor_advertisement_cb()
279 status = rp->status; in msft_le_monitor_advertisement_cb()
289 handle_data->mgmt_handle = monitor->handle; in msft_le_monitor_advertisement_cb()
290 handle_data->msft_handle = rp->handle; in msft_le_monitor_advertisement_cb()
291 handle_data->cond_type = MSFT_MONITOR_ADVERTISEMENT_TYPE_PATTERN; in msft_le_monitor_advertisement_cb()
292 INIT_LIST_HEAD(&handle_data->list); in msft_le_monitor_advertisement_cb()
293 list_add(&handle_data->list, &msft->handle_map); in msft_le_monitor_advertisement_cb()
295 monitor->state = ADV_MONITOR_STATE_OFFLOADED; in msft_le_monitor_advertisement_cb()
311 struct msft_data *msft = hdev->msft_data; in msft_remove_addr_filters_sync()
318 mutex_lock(&msft->filter_lock); in msft_remove_addr_filters_sync()
320 list_for_each_entry_safe(address_filter, n, &msft->address_filters, in msft_remove_addr_filters_sync()
322 if (address_filter->pattern_handle != handle) in msft_remove_addr_filters_sync()
325 list_del(&address_filter->list); in msft_remove_addr_filters_sync()
331 if (address_filter->state == AF_STATE_ADDING) { in msft_remove_addr_filters_sync()
332 address_filter->state = AF_STATE_REMOVING; in msft_remove_addr_filters_sync()
340 if (address_filter->state == AF_STATE_REMOVING) in msft_remove_addr_filters_sync()
343 list_add_tail(&address_filter->list, &head); in msft_remove_addr_filters_sync()
346 mutex_unlock(&msft->filter_lock); in msft_remove_addr_filters_sync()
349 list_del(&address_filter->list); in msft_remove_addr_filters_sync()
352 cp.handle = address_filter->msft_handle; in msft_remove_addr_filters_sync()
354 skb = __hci_cmd_sync(hdev, hdev->msft_opcode, sizeof(cp), &cp, in msft_remove_addr_filters_sync()
364 &address_filter->bdaddr); in msft_remove_addr_filters_sync()
375 struct msft_rp_le_cancel_monitor_advertisement *rp; in msft_le_cancel_monitor_advertisement_cb() local
377 struct msft_data *msft = hdev->msft_data; in msft_le_cancel_monitor_advertisement_cb()
381 rp = (struct msft_rp_le_cancel_monitor_advertisement *)skb->data; in msft_le_cancel_monitor_advertisement_cb()
382 if (skb->len < sizeof(*rp)) { in msft_le_cancel_monitor_advertisement_cb()
387 status = rp->status; in msft_le_cancel_monitor_advertisement_cb()
393 handle_data = msft_find_handle_data(hdev, monitor->handle, true); in msft_le_cancel_monitor_advertisement_cb()
396 if (monitor->state == ADV_MONITOR_STATE_OFFLOADED) in msft_le_cancel_monitor_advertisement_cb()
397 monitor->state = ADV_MONITOR_STATE_REGISTERED; in msft_le_cancel_monitor_advertisement_cb()
400 * suspend. It will be re-monitored on resume. in msft_le_cancel_monitor_advertisement_cb()
402 if (!msft->suspending) { in msft_le_cancel_monitor_advertisement_cb()
406 msft_monitor_device_del(hdev, handle_data->mgmt_handle, in msft_le_cancel_monitor_advertisement_cb()
410 msft_handle = handle_data->msft_handle; in msft_le_cancel_monitor_advertisement_cb()
412 list_del(&handle_data->list); in msft_le_cancel_monitor_advertisement_cb()
434 handle_data = msft_find_handle_data(hdev, monitor->handle, true); in msft_remove_monitor_sync()
438 return -ENOENT; in msft_remove_monitor_sync()
441 cp.handle = handle_data->msft_handle; in msft_remove_monitor_sync()
443 skb = __hci_cmd_sync(hdev, hdev->msft_opcode, sizeof(cp), &cp, in msft_remove_monitor_sync()
447 return -EIO; in msft_remove_monitor_sync()
451 return msft_le_cancel_monitor_advertisement_cb(hdev, hdev->msft_opcode, in msft_remove_monitor_sync()
458 struct msft_data *msft = hdev->msft_data; in msft_suspend_sync()
465 msft->suspending = true; in msft_suspend_sync()
468 monitor = idr_get_next(&hdev->adv_monitors_idr, &handle); in msft_suspend_sync()
478 msft->suspending = false; in msft_suspend_sync()
485 struct adv_rssi_thresholds *r = &monitor->rssi; in msft_monitor_rssi_valid()
487 if (r->high_threshold < MSFT_RSSI_THRESHOLD_VALUE_MIN || in msft_monitor_rssi_valid()
488 r->high_threshold > MSFT_RSSI_THRESHOLD_VALUE_MAX || in msft_monitor_rssi_valid()
489 r->low_threshold < MSFT_RSSI_THRESHOLD_VALUE_MIN || in msft_monitor_rssi_valid()
490 r->low_threshold > MSFT_RSSI_THRESHOLD_VALUE_MAX) in msft_monitor_rssi_valid()
496 if (r->high_threshold_timeout != 0) in msft_monitor_rssi_valid()
499 if (r->low_threshold_timeout > MSFT_RSSI_LOW_TIMEOUT_MAX) in msft_monitor_rssi_valid()
509 /* No additional check needed for pattern-based monitor */ in msft_monitor_pattern_valid()
527 return -EINVAL; in msft_add_monitor_sync()
529 list_for_each_entry(entry, &monitor->patterns, list) { in msft_add_monitor_sync()
531 total_size += sizeof(*pattern) + entry->length; in msft_add_monitor_sync()
536 return -ENOMEM; in msft_add_monitor_sync()
538 cp->sub_opcode = MSFT_OP_LE_MONITOR_ADVERTISEMENT; in msft_add_monitor_sync()
539 cp->rssi_high = monitor->rssi.high_threshold; in msft_add_monitor_sync()
540 cp->rssi_low = monitor->rssi.low_threshold; in msft_add_monitor_sync()
541 cp->rssi_low_interval = (u8)monitor->rssi.low_threshold_timeout; in msft_add_monitor_sync()
542 cp->rssi_sampling_period = monitor->rssi.sampling_period; in msft_add_monitor_sync()
544 cp->cond_type = MSFT_MONITOR_ADVERTISEMENT_TYPE_PATTERN; in msft_add_monitor_sync()
546 pattern_data = (void *)cp->data; in msft_add_monitor_sync()
547 pattern_data->count = pattern_count; in msft_add_monitor_sync()
549 list_for_each_entry(entry, &monitor->patterns, list) { in msft_add_monitor_sync()
550 pattern = (void *)(pattern_data->data + offset); in msft_add_monitor_sync()
552 pattern->length = entry->length + 2; in msft_add_monitor_sync()
553 pattern->data_type = entry->ad_type; in msft_add_monitor_sync()
554 pattern->start_byte = entry->offset; in msft_add_monitor_sync()
555 memcpy(pattern->pattern, entry->value, entry->length); in msft_add_monitor_sync()
556 offset += sizeof(*pattern) + entry->length; in msft_add_monitor_sync()
559 skb = __hci_cmd_sync(hdev, hdev->msft_opcode, total_size, cp, in msft_add_monitor_sync()
567 err = msft_le_monitor_advertisement_cb(hdev, hdev->msft_opcode, in msft_add_monitor_sync()
572 handle_data = msft_find_handle_data(hdev, monitor->handle, true); in msft_add_monitor_sync()
574 err = -ENODATA; in msft_add_monitor_sync()
578 handle_data->rssi_high = cp->rssi_high; in msft_add_monitor_sync()
579 handle_data->rssi_low = cp->rssi_low; in msft_add_monitor_sync()
580 handle_data->rssi_low_interval = cp->rssi_low_interval; in msft_add_monitor_sync()
581 handle_data->rssi_sampling_period = cp->rssi_sampling_period; in msft_add_monitor_sync()
592 struct msft_data *msft = hdev->msft_data; in reregister_monitor()
598 msft->resuming = true; in reregister_monitor()
601 monitor = idr_get_next(&hdev->adv_monitors_idr, &handle); in reregister_monitor()
611 msft->resuming = false; in reregister_monitor()
617 struct msft_data *msft = hdev->msft_data; in msft_resume_sync()
627 hdev->advmon_pend_notify = false; in msft_resume_sync()
640 struct msft_data *msft = hdev->msft_data; in msft_do_open()
642 if (hdev->msft_opcode == HCI_OP_NOP) in msft_do_open()
652 /* Reset existing MSFT data before re-reading */ in msft_do_open()
653 kfree(msft->evt_prefix); in msft_do_open()
654 msft->evt_prefix = NULL; in msft_do_open()
655 msft->evt_prefix_len = 0; in msft_do_open()
656 msft->features = 0; in msft_do_open()
659 hdev->msft_data = NULL; in msft_do_open()
665 msft->resuming = true; in msft_do_open()
668 * tell the controller to re-monitor. in msft_do_open()
676 struct msft_data *msft = hdev->msft_data; in msft_do_close()
689 list_for_each_entry_safe(handle_data, tmp, &msft->handle_map, list) { in msft_do_close()
690 monitor = idr_find(&hdev->adv_monitors_idr, in msft_do_close()
691 handle_data->mgmt_handle); in msft_do_close()
693 if (monitor && monitor->state == ADV_MONITOR_STATE_OFFLOADED) in msft_do_close()
694 monitor->state = ADV_MONITOR_STATE_REGISTERED; in msft_do_close()
696 list_del(&handle_data->list); in msft_do_close()
700 mutex_lock(&msft->filter_lock); in msft_do_close()
701 list_for_each_entry_safe(address_filter, n, &msft->address_filters, in msft_do_close()
703 list_del(&address_filter->list); in msft_do_close()
706 mutex_unlock(&msft->filter_lock); in msft_do_close()
711 hdev->advmon_pend_notify = false; in msft_do_close()
721 struct msft_data *msft = hdev->msft_data; in msft_cancel_address_filter_sync()
727 return -EINVAL; in msft_cancel_address_filter_sync()
731 if (!test_bit(HCI_UP, &hdev->flags)) in msft_cancel_address_filter_sync()
734 mutex_lock(&msft->filter_lock); in msft_cancel_address_filter_sync()
735 list_del(&address_filter->list); in msft_cancel_address_filter_sync()
736 mutex_unlock(&msft->filter_lock); in msft_cancel_address_filter_sync()
739 cp.handle = address_filter->msft_handle; in msft_cancel_address_filter_sync()
741 skb = __hci_cmd_sync(hdev, hdev->msft_opcode, sizeof(cp), &cp, in msft_cancel_address_filter_sync()
745 &address_filter->bdaddr); in msft_cancel_address_filter_sync()
746 err = -EIO; in msft_cancel_address_filter_sync()
752 &address_filter->bdaddr); in msft_cancel_address_filter_sync()
772 INIT_LIST_HEAD(&msft->handle_map); in msft_register()
773 INIT_LIST_HEAD(&msft->address_filters); in msft_register()
774 hdev->msft_data = msft; in msft_register()
775 mutex_init(&msft->filter_lock); in msft_register()
780 struct msft_data *msft = hdev->msft_data; in msft_unregister()
787 hdev->msft_data = NULL; in msft_unregister()
789 kfree(msft->evt_prefix); in msft_unregister()
790 mutex_destroy(&msft->filter_lock); in msft_unregister()
794 /* This function requires the caller holds hdev->lock */
807 bacpy(&dev->bdaddr, bdaddr); in msft_device_found()
808 dev->addr_type = addr_type; in msft_device_found()
809 dev->handle = mgmt_handle; in msft_device_found()
810 dev->notified = false; in msft_device_found()
812 INIT_LIST_HEAD(&dev->list); in msft_device_found()
813 list_add(&dev->list, &hdev->monitored_devices); in msft_device_found()
814 hdev->advmon_pend_notify = true; in msft_device_found()
817 /* This function requires the caller holds hdev->lock */
835 bt_dev_err(hdev, "Malformed MSFT vendor event: 0x%02x", ev); in msft_skb_pull()
843 struct msft_rp_le_monitor_advertisement *rp; in msft_add_address_filter_sync() local
845 struct msft_data *msft = hdev->msft_data; in msft_add_address_filter_sync()
852 return -EINVAL; in msft_add_address_filter_sync()
856 if (!test_bit(HCI_UP, &hdev->flags)) in msft_add_address_filter_sync()
857 return -ENODEV; in msft_add_address_filter_sync()
867 if (address_filter->state == AF_STATE_REMOVING) { in msft_add_address_filter_sync()
868 mutex_lock(&msft->filter_lock); in msft_add_address_filter_sync()
869 list_del(&address_filter->list); in msft_add_address_filter_sync()
870 mutex_unlock(&msft->filter_lock); in msft_add_address_filter_sync()
876 sizeof(address_filter->addr_type) + in msft_add_address_filter_sync()
877 sizeof(address_filter->bdaddr); in msft_add_address_filter_sync()
884 cp->sub_opcode = MSFT_OP_LE_MONITOR_ADVERTISEMENT; in msft_add_address_filter_sync()
885 cp->rssi_high = address_filter->rssi_high; in msft_add_address_filter_sync()
886 cp->rssi_low = address_filter->rssi_low; in msft_add_address_filter_sync()
887 cp->rssi_low_interval = address_filter->rssi_low_interval; in msft_add_address_filter_sync()
888 cp->rssi_sampling_period = address_filter->rssi_sampling_period; in msft_add_address_filter_sync()
889 cp->cond_type = MSFT_MONITOR_ADVERTISEMENT_TYPE_ADDR; in msft_add_address_filter_sync()
890 cp->data[0] = address_filter->addr_type; in msft_add_address_filter_sync()
891 memcpy(&cp->data[1], &address_filter->bdaddr, in msft_add_address_filter_sync()
892 sizeof(address_filter->bdaddr)); in msft_add_address_filter_sync()
894 skb = __hci_cmd_sync(hdev, hdev->msft_opcode, size, cp, in msft_add_address_filter_sync()
898 &address_filter->bdaddr); in msft_add_address_filter_sync()
904 rp = skb_pull_data(skb, sizeof(*rp)); in msft_add_address_filter_sync()
905 if (!rp || rp->sub_opcode != MSFT_OP_LE_MONITOR_ADVERTISEMENT || in msft_add_address_filter_sync()
906 rp->status) in msft_add_address_filter_sync()
910 mutex_lock(&msft->filter_lock); in msft_add_address_filter_sync()
914 &address_filter->bdaddr); in msft_add_address_filter_sync()
915 list_del(&address_filter->list); in msft_add_address_filter_sync()
918 address_filter->state = AF_STATE_ADDED; in msft_add_address_filter_sync()
919 address_filter->msft_handle = rp->handle; in msft_add_address_filter_sync()
921 &address_filter->bdaddr); in msft_add_address_filter_sync()
923 mutex_unlock(&msft->filter_lock); in msft_add_address_filter_sync()
930 /* This function requires the caller holds msft->filter_lock */
936 struct msft_data *msft = hdev->msft_data; in msft_add_address_filter()
943 address_filter->state = AF_STATE_ADDING; in msft_add_address_filter()
944 address_filter->msft_handle = 0xff; in msft_add_address_filter()
945 address_filter->pattern_handle = handle_data->msft_handle; in msft_add_address_filter()
946 address_filter->mgmt_handle = handle_data->mgmt_handle; in msft_add_address_filter()
947 address_filter->rssi_high = handle_data->rssi_high; in msft_add_address_filter()
948 address_filter->rssi_low = handle_data->rssi_low; in msft_add_address_filter()
949 address_filter->rssi_low_interval = handle_data->rssi_low_interval; in msft_add_address_filter()
950 address_filter->rssi_sampling_period = handle_data->rssi_sampling_period; in msft_add_address_filter()
951 address_filter->addr_type = addr_type; in msft_add_address_filter()
952 bacpy(&address_filter->bdaddr, bdaddr); in msft_add_address_filter()
958 list_add_tail(&address_filter->list, &msft->address_filters); in msft_add_address_filter()
964 list_del(&address_filter->list); in msft_add_address_filter()
970 &address_filter->bdaddr); in msft_add_address_filter()
975 /* This function requires the caller holds hdev->lock */
981 struct msft_data *msft = hdev->msft_data; in msft_monitor_device_evt()
990 "MSFT vendor event 0x%02x: handle 0x%04x state %d addr %pMR", in msft_monitor_device_evt()
991 MSFT_EV_LE_MONITOR_DEVICE, ev->monitor_handle, in msft_monitor_device_evt()
992 ev->monitor_state, &ev->bdaddr); in msft_monitor_device_evt()
994 handle_data = msft_find_handle_data(hdev, ev->monitor_handle, false); in msft_monitor_device_evt()
996 if (!test_bit(HCI_QUIRK_USE_MSFT_EXT_ADDRESS_FILTER, &hdev->quirks)) { in msft_monitor_device_evt()
999 mgmt_handle = handle_data->mgmt_handle; in msft_monitor_device_evt()
1009 address_filter = msft_find_address_data(hdev, ev->addr_type, in msft_monitor_device_evt()
1010 &ev->bdaddr, in msft_monitor_device_evt()
1011 handle_data->msft_handle); in msft_monitor_device_evt()
1015 if (ev->monitor_state && handle_data->cond_type == in msft_monitor_device_evt()
1017 msft_add_address_filter(hdev, ev->addr_type, in msft_monitor_device_evt()
1018 &ev->bdaddr, handle_data); in msft_monitor_device_evt()
1026 list_for_each_entry(n, &msft->address_filters, list) { in msft_monitor_device_evt()
1027 if (n->state == AF_STATE_ADDED && in msft_monitor_device_evt()
1028 n->msft_handle == ev->monitor_handle) { in msft_monitor_device_evt()
1029 mgmt_handle = n->mgmt_handle; in msft_monitor_device_evt()
1037 &ev->bdaddr, ev->monitor_handle, ev->monitor_state); in msft_monitor_device_evt()
1042 switch (ev->addr_type) { in msft_monitor_device_evt()
1053 "MSFT vendor event 0x%02x: unknown addr type 0x%02x", in msft_monitor_device_evt()
1054 MSFT_EV_LE_MONITOR_DEVICE, ev->addr_type); in msft_monitor_device_evt()
1058 if (ev->monitor_state) { in msft_monitor_device_evt()
1059 msft_device_found(hdev, &ev->bdaddr, addr_type, mgmt_handle); in msft_monitor_device_evt()
1061 if (address_filter && address_filter->state == AF_STATE_ADDED) { in msft_monitor_device_evt()
1062 address_filter->state = AF_STATE_REMOVING; in msft_monitor_device_evt()
1068 msft_device_lost(hdev, &ev->bdaddr, addr_type, mgmt_handle); in msft_monitor_device_evt()
1074 struct msft_data *msft = hdev->msft_data; in msft_vendor_evt()
1084 if (msft->evt_prefix_len > 0) { in msft_vendor_evt()
1085 evt_prefix = msft_skb_pull(hdev, skb, 0, msft->evt_prefix_len); in msft_vendor_evt()
1089 if (memcmp(evt_prefix, msft->evt_prefix, msft->evt_prefix_len)) in msft_vendor_evt()
1096 if (skb->len < 1) in msft_vendor_evt()
1107 mutex_lock(&msft->filter_lock); in msft_vendor_evt()
1109 mutex_unlock(&msft->filter_lock); in msft_vendor_evt()
1113 bt_dev_dbg(hdev, "MSFT vendor event 0x%02x", *evt); in msft_vendor_evt()
1122 struct msft_data *msft = hdev->msft_data; in msft_get_features()
1124 return msft ? msft->features : 0; in msft_get_features()
1132 struct msft_data *msft = hdev->msft_data; in msft_le_set_advertisement_filter_enable_cb()
1146 msft->filter_enabled = cp->enable; in msft_le_set_advertisement_filter_enable_cb()
1150 cp->enable ? "on" : "off"); in msft_le_set_advertisement_filter_enable_cb()
1158 struct msft_data *msft = hdev->msft_data; in msft_add_monitor_pattern()
1161 return -EOPNOTSUPP; in msft_add_monitor_pattern()
1163 if (msft->resuming || msft->suspending) in msft_add_monitor_pattern()
1164 return -EBUSY; in msft_add_monitor_pattern()
1172 struct msft_data *msft = hdev->msft_data; in msft_remove_monitor()
1175 return -EOPNOTSUPP; in msft_remove_monitor()
1177 if (msft->resuming || msft->suspending) in msft_remove_monitor()
1178 return -EBUSY; in msft_remove_monitor()
1186 struct msft_data *msft = hdev->msft_data; in msft_set_filter_enable()
1190 return -EOPNOTSUPP; in msft_set_filter_enable()
1194 err = __hci_cmd_sync_status(hdev, hdev->msft_opcode, sizeof(cp), &cp, in msft_set_filter_enable()
1204 return hdev->msft_curve_validity; in msft_curve_validity()