#include "src/shared/util.h"
#include "src/shared/btsnoop.h"
+#include "src/shared/queue.h"
#include "display.h"
#include "bt.h"
#include "ll.h"
int i;
for (i = 0; i < MAX_CONN; i++) {
- if (conn_list[i].handle == handle) {
- if (conn_list[i].destroy)
- conn_list[i].destroy(conn_list[i].data);
+ struct packet_conn_data *conn = &conn_list[i];
- memset(&conn_list[i], 0, sizeof(conn_list[i]));
+ if (conn->handle == handle) {
+ if (conn->destroy)
+ conn->destroy(conn->data);
+
+ queue_destroy(conn->tx_q, free);
+ memset(conn, 0, sizeof(*conn));
break;
}
}
return NULL;
}
-static void inquiry_complete_evt(uint16_t index, const void *data, uint8_t size)
+static void inquiry_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_inquiry_complete *evt = data;
print_status(evt->status);
}
-static void inquiry_result_evt(uint16_t index, const void *data, uint8_t size)
+static void inquiry_result_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_inquiry_result *evt = data;
packet_hexdump(data + sizeof(*evt), size - sizeof(*evt));
}
-static void conn_complete_evt(uint16_t index, const void *data, uint8_t size)
+static void conn_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_conn_complete *evt = data;
(void *)evt->bdaddr, BDADDR_BREDR);
}
-static void conn_request_evt(uint16_t index, const void *data, uint8_t size)
+static void conn_request_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_conn_request *evt = data;
print_link_type(evt->link_type);
}
-static void disconnect_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void disconnect_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_disconnect_complete *evt = data;
release_handle(le16_to_cpu(evt->handle));
}
-static void auth_complete_evt(uint16_t index, const void *data, uint8_t size)
+static void auth_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_auth_complete *evt = data;
print_handle(evt->handle);
}
-static void remote_name_request_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void remote_name_request_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_remote_name_request_complete *evt = data;
print_name(evt->name);
}
-static void encrypt_change_evt(uint16_t index, const void *data, uint8_t size)
+static void encrypt_change_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_encrypt_change *evt = data;
print_encr_mode_change(evt->encr_mode, evt->handle);
}
-static void change_conn_link_key_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void change_conn_link_key_complete_evt(struct timeval *tv,
+ uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_change_conn_link_key_complete *evt = data;
print_handle(evt->handle);
}
-static void link_key_type_changed_evt(uint16_t index, const void *data,
- uint8_t size)
+static void link_key_type_changed_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_link_key_type_changed *evt = data;
print_key_flag(evt->key_flag);
}
-static void remote_features_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void remote_features_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_remote_features_complete *evt = data;
print_features(0, evt->features, 0x00);
}
-static void remote_version_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void remote_version_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_remote_version_complete *evt = data;
}
}
-static void qos_setup_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void qos_setup_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_qos_setup_complete *evt = data;
print_field("Delay variation: %d", le32_to_cpu(evt->delay_variation));
}
-static void cmd_complete_evt(uint16_t index, const void *data, uint8_t size)
+static void cmd_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_cmd_complete *evt = data;
uint16_t opcode = le16_to_cpu(evt->opcode);
opcode_data->rsp_func(index, data + 3, size - 3);
}
-static void cmd_status_evt(uint16_t index, const void *data, uint8_t size)
+static void cmd_status_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_cmd_status *evt = data;
uint16_t opcode = le16_to_cpu(evt->opcode);
print_status(evt->status);
}
-static void hardware_error_evt(uint16_t index, const void *data, uint8_t size)
+static void hardware_error_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_hardware_error *evt = data;
print_field("Code: 0x%2.2x", evt->code);
}
-static void flush_occurred_evt(uint16_t index, const void *data, uint8_t size)
+static void flush_occurred_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_flush_occurred *evt = data;
print_handle(evt->handle);
}
-static void role_change_evt(uint16_t index, const void *data, uint8_t size)
+static void role_change_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_role_change *evt = data;
print_role(evt->role);
}
-static void num_completed_packets_evt(uint16_t index, const void *data,
- uint8_t size)
+#define TV_MSEC(_tv) (long long)(_tv.tv_sec * 1000 + _tv.tv_usec / 1000)
+
+static void packet_dequeue_tx(struct timeval *tv, uint16_t handle)
+{
+ struct packet_conn_data *conn;
+ struct timeval *tx;
+ struct timeval delta;
+
+ conn = packet_get_conn_data(handle);
+ if (!conn)
+ return;
+
+ tx = queue_pop_head(conn->tx_q);
+ if (!tx)
+ return;
+
+ timersub(tv, tx, &delta);
+
+ if ((!timerisset(&conn->tx_min) || timercmp(&delta, &conn->tx_min, <))
+ && delta.tv_sec >= 0 && delta.tv_usec >= 0)
+ conn->tx_min = delta;
+
+ if (!timerisset(&conn->tx_max) || timercmp(&delta, &conn->tx_max, >))
+ conn->tx_max = delta;
+
+ if (timerisset(&conn->tx_med)) {
+ struct timeval tmp;
+
+ timeradd(&conn->tx_med, &delta, &tmp);
+
+ tmp.tv_sec /= 2;
+ tmp.tv_usec /= 2;
+ if (tmp.tv_sec % 2) {
+ tmp.tv_usec += 500000;
+ if (tmp.tv_usec >= 1000000) {
+ tmp.tv_sec++;
+ tmp.tv_usec -= 1000000;
+ }
+ }
+
+ conn->tx_med = tmp;
+ } else
+ conn->tx_med = delta;
+
+ print_field("Latency: %lld msec (%lld-%lld msec ~%lld msec)",
+ TV_MSEC(delta), TV_MSEC(conn->tx_min),
+ TV_MSEC(conn->tx_max), TV_MSEC(conn->tx_med));
+}
+
+static void num_completed_packets_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
struct iovec iov = { (void *)data, size};
const struct bt_hci_evt_num_completed_packets *evt = data;
break;
print_field("Count: %d", le16_to_cpu(evt->count));
+
+ packet_dequeue_tx(tv, handle);
}
if (iov.iov_len)
packet_hexdump(iov.iov_base, iov.iov_len);
}
-static void mode_change_evt(uint16_t index, const void *data, uint8_t size)
+static void mode_change_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_mode_change *evt = data;
print_interval(evt->interval);
}
-static void return_link_keys_evt(uint16_t index, const void *data, uint8_t size)
+static void return_link_keys_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_return_link_keys *evt = data;
uint8_t i;
}
}
-static void pin_code_request_evt(uint16_t index, const void *data, uint8_t size)
+static void pin_code_request_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_pin_code_request *evt = data;
print_bdaddr(evt->bdaddr);
}
-static void link_key_request_evt(uint16_t index, const void *data, uint8_t size)
+static void link_key_request_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_link_key_request *evt = data;
print_bdaddr(evt->bdaddr);
}
-static void link_key_notify_evt(uint16_t index, const void *data, uint8_t size)
+static void link_key_notify_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_link_key_notify *evt = data;
print_key_type(evt->key_type);
}
-static void loopback_command_evt(uint16_t index, const void *data, uint8_t size)
+static void loopback_command_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
packet_hexdump(data, size);
}
-static void data_buffer_overflow_evt(uint16_t index, const void *data,
- uint8_t size)
+static void data_buffer_overflow_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_data_buffer_overflow *evt = data;
print_link_type(evt->link_type);
}
-static void max_slots_change_evt(uint16_t index, const void *data, uint8_t size)
+static void max_slots_change_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_max_slots_change *evt = data;
print_field("Max slots: %d", evt->max_slots);
}
-static void clock_offset_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void clock_offset_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_clock_offset_complete *evt = data;
print_clock_offset(evt->clock_offset);
}
-static void conn_pkt_type_changed_evt(uint16_t index, const void *data,
- uint8_t size)
+static void conn_pkt_type_changed_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_conn_pkt_type_changed *evt = data;
print_pkt_type(evt->pkt_type);
}
-static void qos_violation_evt(uint16_t index, const void *data, uint8_t size)
+static void qos_violation_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_qos_violation *evt = data;
print_handle(evt->handle);
}
-static void pscan_mode_change_evt(uint16_t index, const void *data,
- uint8_t size)
+static void pscan_mode_change_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_pscan_mode_change *evt = data;
print_pscan_mode(evt->pscan_mode);
}
-static void pscan_rep_mode_change_evt(uint16_t index, const void *data,
- uint8_t size)
+static void pscan_rep_mode_change_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_pscan_rep_mode_change *evt = data;
print_pscan_rep_mode(evt->pscan_rep_mode);
}
-static void flow_spec_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void flow_spec_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_flow_spec_complete *evt = data;
print_field("Access latency: %d", le32_to_cpu(evt->access_latency));
}
-static void inquiry_result_with_rssi_evt(uint16_t index, const void *data,
- uint8_t size)
+static void inquiry_result_with_rssi_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_inquiry_result_with_rssi *evt = data;
packet_hexdump(data + sizeof(*evt), size - sizeof(*evt));
}
-static void remote_ext_features_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void remote_ext_features_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_remote_ext_features_complete *evt = data;
print_features(evt->page, evt->features, 0x00);
}
-static void sync_conn_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void sync_conn_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_sync_conn_complete *evt = data;
print_air_mode(evt->air_mode);
}
-static void sync_conn_changed_evt(uint16_t index, const void *data,
- uint8_t size)
+static void sync_conn_changed_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_sync_conn_changed *evt = data;
print_field("TX packet length: %d", le16_to_cpu(evt->tx_pkt_len));
}
-static void sniff_subrating_evt(uint16_t index, const void *data, uint8_t size)
+static void sniff_subrating_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_sniff_subrating *evt = data;
print_slot_625("Min local timeout", evt->min_local_timeout);
}
-static void ext_inquiry_result_evt(uint16_t index, const void *data,
- uint8_t size)
+static void ext_inquiry_result_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_ext_inquiry_result *evt = data;
print_eir(evt->data, sizeof(evt->data), false);
}
-static void encrypt_key_refresh_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void encrypt_key_refresh_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_encrypt_key_refresh_complete *evt = data;
print_handle(evt->handle);
}
-static void io_capability_request_evt(uint16_t index, const void *data,
- uint8_t size)
+static void io_capability_request_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_io_capability_request *evt = data;
print_bdaddr(evt->bdaddr);
}
-static void io_capability_response_evt(uint16_t index, const void *data,
- uint8_t size)
+static void io_capability_response_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_io_capability_response *evt = data;
print_authentication(evt->authentication);
}
-static void user_confirm_request_evt(uint16_t index, const void *data,
- uint8_t size)
+static void user_confirm_request_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_user_confirm_request *evt = data;
print_passkey(evt->passkey);
}
-static void user_passkey_request_evt(uint16_t index, const void *data,
- uint8_t size)
+static void user_passkey_request_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_user_passkey_request *evt = data;
print_bdaddr(evt->bdaddr);
}
-static void remote_oob_data_request_evt(uint16_t index, const void *data,
- uint8_t size)
+static void remote_oob_data_request_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_remote_oob_data_request *evt = data;
print_bdaddr(evt->bdaddr);
}
-static void simple_pairing_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void simple_pairing_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_simple_pairing_complete *evt = data;
print_bdaddr(evt->bdaddr);
}
-static void link_supv_timeout_changed_evt(uint16_t index, const void *data,
- uint8_t size)
+static void link_supv_timeout_changed_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_link_supv_timeout_changed *evt = data;
print_timeout(evt->timeout);
}
-static void enhanced_flush_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void enhanced_flush_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_enhanced_flush_complete *evt = data;
print_handle(evt->handle);
}
-static void user_passkey_notify_evt(uint16_t index, const void *data,
- uint8_t size)
+static void user_passkey_notify_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_user_passkey_notify *evt = data;
print_passkey(evt->passkey);
}
-static void keypress_notify_evt(uint16_t index, const void *data, uint8_t size)
+static void keypress_notify_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_keypress_notify *evt = data;
const char *str;
print_field("Notification type: %s (0x%2.2x)", str, evt->type);
}
-static void remote_host_features_notify_evt(uint16_t index, const void *data,
- uint8_t size)
+static void remote_host_features_notify_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_remote_host_features_notify *evt = data;
print_features(1, evt->features, 0x00);
}
-static void phy_link_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void phy_link_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_phy_link_complete *evt = data;
print_phy_handle(evt->phy_handle);
}
-static void channel_selected_evt(uint16_t index, const void *data, uint8_t size)
+static void channel_selected_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_channel_selected *evt = data;
print_phy_handle(evt->phy_handle);
}
-static void disconn_phy_link_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void disconn_phy_link_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_disconn_phy_link_complete *evt = data;
print_reason(evt->reason);
}
-static void phy_link_loss_early_warning_evt(uint16_t index, const void *data,
- uint8_t size)
+static void phy_link_loss_early_warning_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_phy_link_loss_early_warning *evt = data;
const char *str;
print_field("Reason: %s (0x%2.2x)", str, evt->reason);
}
-static void phy_link_recovery_evt(uint16_t index, const void *data,
- uint8_t size)
+static void phy_link_recovery_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_phy_link_recovery *evt = data;
print_phy_handle(evt->phy_handle);
}
-static void logic_link_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void logic_link_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_logic_link_complete *evt = data;
print_field("TX flow spec: 0x%2.2x", evt->flow_spec);
}
-static void disconn_logic_link_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void disconn_logic_link_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_disconn_logic_link_complete *evt = data;
print_reason(evt->reason);
}
-static void flow_spec_modify_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void flow_spec_modify_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_flow_spec_modify_complete *evt = data;
print_handle(evt->handle);
}
-static void num_completed_data_blocks_evt(uint16_t index, const void *data,
- uint8_t size)
+static void num_completed_data_blocks_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_num_completed_data_blocks *evt = data;
packet_hexdump(data + sizeof(*evt), size - sizeof(*evt));
}
-static void short_range_mode_change_evt(uint16_t index, const void *data,
- uint8_t size)
+static void short_range_mode_change_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_short_range_mode_change *evt = data;
print_enable("Short range mode", evt->mode);
}
-static void amp_status_change_evt(uint16_t index, const void *data,
- uint8_t size)
+static void amp_status_change_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_amp_status_change *evt = data;
print_amp_status(evt->amp_status);
}
-static void triggered_clock_capture_evt(uint16_t index, const void *data,
- uint8_t size)
+static void triggered_clock_capture_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_triggered_clock_capture *evt = data;
print_clock_offset(evt->clock_offset);
}
-static void sync_train_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void sync_train_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_sync_train_complete *evt = data;
print_status(evt->status);
}
-static void sync_train_received_evt(uint16_t index, const void *data,
- uint8_t size)
+static void sync_train_received_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_sync_train_received *evt = data;
print_field("Service Data: 0x%2.2x", evt->service_data);
}
-static void peripheral_broadcast_receive_evt(uint16_t index, const void *data,
- uint8_t size)
+static void peripheral_broadcast_receive_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_peripheral_broadcast_receive *evt = data;
packet_hexdump(data + 18, size - 18);
}
-static void peripheral_broadcast_timeout_evt(uint16_t index, const void *data,
- uint8_t size)
+static void peripheral_broadcast_timeout_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_peripheral_broadcast_timeout *evt = data;
print_lt_addr(evt->lt_addr);
}
-static void truncated_page_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void truncated_page_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_truncated_page_complete *evt = data;
print_bdaddr(evt->bdaddr);
}
-static void peripheral_page_response_timeout_evt(uint16_t index,
- const void *data, uint8_t size)
+static void peripheral_page_response_timeout_evt(struct timeval *tv,
+ uint16_t index, const void *data,
+ uint8_t size)
{
}
-static void channel_map_change_evt(uint16_t index, const void *data,
- uint8_t size)
+static void channel_map_change_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_channel_map_change *evt = data;
print_channel_map(evt->map);
}
-static void inquiry_response_notify_evt(uint16_t index, const void *data,
- uint8_t size)
+static void inquiry_response_notify_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_inquiry_response_notify *evt = data;
print_rssi(evt->rssi);
}
-static void auth_payload_timeout_expired_evt(uint16_t index, const void *data,
- uint8_t size)
+static void auth_payload_timeout_expired_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_auth_payload_timeout_expired *evt = data;
print_handle(evt->handle);
}
-static void le_conn_complete_evt(uint16_t index, const void *data, uint8_t size)
+static void le_conn_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_conn_complete *evt = data;
(void *)evt->peer_addr, evt->peer_addr_type);
}
-static void le_adv_report_evt(uint16_t index, const void *data, uint8_t size)
+static void le_adv_report_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_adv_report *evt = data;
uint8_t evt_len;
}
}
-static void le_conn_update_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_conn_update_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_conn_update_complete *evt = data;
le16_to_cpu(evt->supv_timeout));
}
-static void le_remote_features_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_remote_features_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_remote_features_complete *evt = data;
print_features(0, evt->features, 0x01);
}
-static void le_long_term_key_request_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_long_term_key_request_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_long_term_key_request *evt = data;
print_encrypted_diversifier(evt->ediv);
}
-static void le_conn_param_request_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_conn_param_request_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_conn_param_request *evt = data;
le16_to_cpu(evt->supv_timeout));
}
-static void le_data_length_change_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_data_length_change_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_data_length_change *evt = data;
print_field("Max RX time: %d", le16_to_cpu(evt->max_rx_time));
}
-static void le_read_local_pk256_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_read_local_pk256_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_read_local_pk256_complete *evt = data;
print_pk256("Local P-256 public key", evt->local_pk256);
}
-static void le_generate_dhkey_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_generate_dhkey_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_generate_dhkey_complete *evt = data;
print_dhkey(evt->dhkey);
}
-static void le_enhanced_conn_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_enhanced_conn_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_enhanced_conn_complete *evt = data;
(void *)evt->peer_addr, evt->peer_addr_type);
}
-static void le_direct_adv_report_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_direct_adv_report_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_direct_adv_report *evt = data;
packet_hexdump(data + sizeof(*evt), size - sizeof(*evt));
}
-static void le_phy_update_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_phy_update_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_phy_update_complete *evt = data;
print_field(" Legacy PDU Type: %s (0x%4.4x)", str, flags);
}
-static void le_ext_adv_report_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_ext_adv_report_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_ext_adv_report *evt = data;
const struct bt_hci_le_ext_adv_report *report;
}
}
-static void le_pa_sync(uint16_t index, const void *data, uint8_t size)
+static void le_pa_sync_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_per_sync_established *evt = data;
print_field("Advertiser clock accuracy: 0x%2.2x", evt->clock_accuracy);
}
-static void le_pa_report_evt(uint16_t index, const void *data, uint8_t size)
+static void le_pa_report_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_le_pa_report *evt = data;
const char *color_on;
packet_hexdump(evt->data, evt->data_len);
}
-static void le_pa_sync_lost(uint16_t index, const void *data, uint8_t size)
+static void le_pa_sync_lost_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_per_sync_lost *evt = data;
print_field("Sync handle: %d", evt->handle);
}
-static void le_adv_set_term_evt(uint16_t index, const void *data, uint8_t size)
+static void le_adv_set_term_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_adv_set_term *evt = data;
evt->num_evts);
}
-static void le_scan_req_received_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_scan_req_received_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_scan_req_received *evt = data;
evt->scanner_addr_type);
}
-static void le_chan_select_alg_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_chan_select_alg_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_chan_select_alg *evt = data;
const char *str;
print_field("Algorithm: %s (0x%2.2x)", str, evt->algorithm);
}
-static void le_cte_request_failed_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_cte_request_failed_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_cte_request_failed *evt = data;
print_field("Connection handle: %d", evt->handle);
}
-static void le_pa_sync_trans_rec_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_pa_sync_trans_rec_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_pa_sync_trans_rec *evt = data;
print_clock_accuracy(evt->clock_accuracy);
}
-static void le_cis_established_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_cis_established_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_cis_established *evt = data;
print_field("ISO Interval: %u", le16_to_cpu(evt->interval));
}
-static void le_req_cis_evt(uint16_t index, const void *data, uint8_t size)
+static void le_req_cis_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_cis_req *evt = data;
print_field("Connection Handle #%d: %d", i, handle);
}
-static void le_big_complete_evt(uint16_t index, const void *data, uint8_t size)
+static void le_big_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_big_complete *evt = data;
sizeof(*evt->bis_handle), print_bis_handle);
}
-static void le_big_terminate_evt(uint16_t index, const void *data, uint8_t size)
+static void le_big_terminate_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_big_terminate *evt = data;
print_reason(evt->reason);
}
-static void le_big_sync_estabilished_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_big_sync_estabilished_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_big_sync_estabilished *evt = data;
print_bis_handle);
}
-static void le_big_sync_lost_evt(uint16_t index, const void *data, uint8_t size)
+static void le_big_sync_lost_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_big_sync_lost *evt = data;
print_reason(evt->reason);
}
-static void le_req_sca_complete_evt(uint16_t index, const void *data,
- uint8_t size)
+static void le_req_sca_complete_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_req_peer_sca_complete *evt = data;
print_sca(evt->sca);
}
-static void le_big_info_evt(uint16_t index, const void *data, uint8_t size)
+static void le_big_info_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
const struct bt_hci_evt_le_big_info_adv_report *evt = data;
struct subevent_data {
uint8_t subevent;
const char *str;
- void (*func) (uint16_t index, const void *data, uint8_t size);
+ void (*func) (struct timeval *tv, uint16_t index, const void *data,
+ uint8_t size);
uint8_t size;
bool fixed;
};
-static void print_subevent(uint16_t index,
+static void print_subevent(struct timeval *tv, uint16_t index,
const struct subevent_data *subevent_data,
const void *data, uint8_t size)
{
}
}
- subevent_data->func(index, data, size);
+ subevent_data->func(tv, index, data, size);
}
static const struct subevent_data le_meta_event_table[] = {
{ 0x0d, "LE Extended Advertising Report",
le_ext_adv_report_evt, 1, false},
{ 0x0e, "LE Periodic Advertising Sync Established",
- le_pa_sync, 15, true },
+ le_pa_sync_evt, 15, true },
{ 0x0f, "LE Periodic Advertising Report",
le_pa_report_evt, 7, false},
{ 0x10, "LE Periodic Advertising Sync Lost",
- le_pa_sync_lost, 2, true},
+ le_pa_sync_lost_evt, 2, true},
{ 0x11, "LE Scan Timeout" },
{ 0x12, "LE Advertising Set Terminated",
le_adv_set_term_evt, 5, true},
{ }
};
-static void le_meta_event_evt(uint16_t index, const void *data, uint8_t size)
+static void le_meta_event_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
uint8_t subevent = *((const uint8_t *) data);
struct subevent_data unknown;
}
}
- print_subevent(index, subevent_data, data + 1, size - 1);
+ print_subevent(tv, index, subevent_data, data + 1, size - 1);
}
-static void vendor_evt(uint16_t index, const void *data, uint8_t size)
+static void vendor_evt(struct timeval *tv, uint16_t index,
+ const void *data, uint8_t size)
{
struct subevent_data vendor_data;
char vendor_str[150];
vendor_data.size = vnd->evt_size;
vendor_data.fixed = vnd->evt_fixed;
- print_subevent(index, &vendor_data, data + consumed_size,
+ print_subevent(tv, index, &vendor_data, data + consumed_size,
size - consumed_size);
} else {
uint16_t manufacturer;
struct event_data {
uint8_t event;
const char *str;
- void (*func) (uint16_t index, const void *data, uint8_t size);
+ void (*func) (struct timeval *tv, uint16_t index, const void *data,
+ uint8_t size);
uint8_t size;
bool fixed;
};
}
}
- event_data->func(index, data, hdr->plen);
+ event_data->func(tv, index, data, hdr->plen);
+}
+
+static void packet_queue_tx(struct timeval *tv, uint16_t handle)
+{
+ struct packet_conn_data *conn;
+ struct timeval *tx;
+
+ conn = packet_get_conn_data(handle);
+ if (!conn)
+ return;
+
+ if (!conn->tx_q)
+ conn->tx_q = queue_new();
+
+ tx = new0(struct timeval, 1);
+ memcpy(tx, tv, sizeof(*tv));
+ queue_push_tail(conn->tx_q, tx);
}
void packet_hci_acldata(struct timeval *tv, struct ucred *cred, uint16_t index,
in ? "ACL Data RX" : "ACL Data TX",
handle_str, extra_str);
+ if (!in)
+ packet_queue_tx(tv, acl_handle(handle));
+
if (size != dlen) {
print_text(COLOR_ERROR, "invalid packet size (%d != %d)",
size, dlen);
in ? "SCO Data RX" : "SCO Data TX",
handle_str, extra_str);
+ if (!in)
+ packet_queue_tx(tv, acl_handle(handle));
+
if (size != hdr->dlen) {
print_text(COLOR_ERROR, "invalid packet size (%d != %d)",
size, hdr->dlen);
in ? "ISO Data RX" : "ISO Data TX",
handle_str, extra_str);
+ if (!in)
+ packet_queue_tx(tv, acl_handle(handle));
+
if (size != hdr->dlen) {
print_text(COLOR_ERROR, "invalid packet size (%d != %d)",
size, hdr->dlen);
projects / platform / upstream / bluez.git / commitdiff