Return-Path: From: Lukasz Rymanowski To: CC: , Lukasz Rymanowski Subject: [PATCH v4 01/10] emulator: Use timeout for sending inquiry results Date: Thu, 20 Mar 2014 10:49:23 +0100 Message-ID: <1395308972-4320-2-git-send-email-lukasz.rymanowski@tieto.com> In-Reply-To: <1395308972-4320-1-git-send-email-lukasz.rymanowski@tieto.com> References: <1395308972-4320-1-git-send-email-lukasz.rymanowski@tieto.com> MIME-Version: 1.0 Content-Type: text/plain Sender: linux-bluetooth-owner@vger.kernel.org List-ID: With this patch btdev uses timeout to schedule inquiry results It also allows btdev to receive hci commands during inquiry. Previously btdev was blocked since all the inquiry result were sent in single loop --- Makefile.tools | 18 ++++++++---- android/Makefile.am | 2 ++ emulator/btdev.c | 84 +++++++++++++++++++++++++++++++++++++++++++++++++---- 3 files changed, 92 insertions(+), 12 deletions(-) diff --git a/Makefile.tools b/Makefile.tools index 0583f3b..a5491ac 100644 --- a/Makefile.tools +++ b/Makefile.tools @@ -88,7 +88,8 @@ tools_mgmt_tester_SOURCES = tools/mgmt-tester.c monitor/bt.h \ src/shared/util.h src/shared/util.c \ src/shared/mgmt.h src/shared/mgmt.c \ src/shared/hciemu.h src/shared/hciemu.c \ - src/shared/tester.h src/shared/tester.c + src/shared/tester.h src/shared/tester.c \ + src/shared/timeout.h src/shared/timeout-glib.c tools_mgmt_tester_LDADD = lib/libbluetooth-internal.la @GLIB_LIBS@ tools_l2cap_tester_SOURCES = tools/l2cap-tester.c monitor/bt.h \ @@ -101,7 +102,8 @@ tools_l2cap_tester_SOURCES = tools/l2cap-tester.c monitor/bt.h \ src/shared/util.h src/shared/util.c \ src/shared/mgmt.h src/shared/mgmt.c \ src/shared/hciemu.h src/shared/hciemu.c \ - src/shared/tester.h src/shared/tester.c + src/shared/tester.h src/shared/tester.c \ + src/shared/timeout.h src/shared/timeout-glib.c tools_l2cap_tester_LDADD = lib/libbluetooth-internal.la @GLIB_LIBS@ tools_rfcomm_tester_SOURCES = tools/rfcomm-tester.c monitor/bt.h \ @@ -114,7 +116,8 @@ tools_rfcomm_tester_SOURCES = tools/rfcomm-tester.c monitor/bt.h \ src/shared/util.h src/shared/util.c \ src/shared/mgmt.h src/shared/mgmt.c \ src/shared/hciemu.h src/shared/hciemu.c \ - src/shared/tester.h src/shared/tester.c + src/shared/tester.h src/shared/tester.c \ + src/shared/timeout.h src/shared/timeout-glib.c tools_rfcomm_tester_LDADD = lib/libbluetooth-internal.la @GLIB_LIBS@ tools_smp_tester_SOURCES = tools/smp-tester.c monitor/bt.h \ @@ -127,7 +130,8 @@ tools_smp_tester_SOURCES = tools/smp-tester.c monitor/bt.h \ src/shared/util.h src/shared/util.c \ src/shared/mgmt.h src/shared/mgmt.c \ src/shared/hciemu.h src/shared/hciemu.c \ - src/shared/tester.h src/shared/tester.c + src/shared/tester.h src/shared/tester.c \ + src/shared/timeout.h src/shared/timeout-glib.c tools_smp_tester_LDADD = lib/libbluetooth-internal.la @GLIB_LIBS@ tools_gap_tester_SOURCES = tools/gap-tester.c monitor/bt.h \ @@ -138,7 +142,8 @@ tools_gap_tester_SOURCES = tools/gap-tester.c monitor/bt.h \ src/shared/util.h src/shared/util.c \ src/shared/queue.h src/shared/queue.c \ src/shared/hciemu.h src/shared/hciemu.c \ - src/shared/tester.h src/shared/tester.c + src/shared/tester.h src/shared/tester.c \ + src/shared/timeout.h src/shared/timeout-glib.c tools_gap_tester_LDADD = lib/libbluetooth-internal.la \ gdbus/libgdbus-internal.la \ @GLIB_LIBS@ @DBUS_LIBS@ @@ -153,7 +158,8 @@ tools_sco_tester_SOURCES = tools/sco-tester.c monitor/bt.h \ src/shared/util.h src/shared/util.c \ src/shared/mgmt.h src/shared/mgmt.c \ src/shared/hciemu.h src/shared/hciemu.c \ - src/shared/tester.h src/shared/tester.c + src/shared/tester.h src/shared/tester.c \ + src/shared/timeout.h src/shared/timeout-glib.c tools_sco_tester_LDADD = lib/libbluetooth-internal.la @GLIB_LIBS@ tools_hci_tester_SOURCES = tools/hci-tester.c monitor/bt.h \ diff --git a/android/Makefile.am b/android/Makefile.am index 3c503da..58ee3c9 100644 --- a/android/Makefile.am +++ b/android/Makefile.am @@ -126,6 +126,7 @@ android_android_tester_SOURCES = emulator/btdev.h emulator/btdev.c \ src/shared/mgmt.h src/shared/mgmt.c \ src/shared/hciemu.h src/shared/hciemu.c \ src/shared/tester.h src/shared/tester.c \ + src/shared/timeout.h src/shared/timeout-glib.c \ monitor/rfcomm.h \ android/hardware/hardware.c \ android/android-tester.c @@ -149,6 +150,7 @@ android_ipc_tester_SOURCES = emulator/btdev.h emulator/btdev.c \ src/shared/mgmt.h src/shared/mgmt.c \ src/shared/hciemu.h src/shared/hciemu.c \ src/shared/tester.h src/shared/tester.c \ + src/shared/timeout.h src/shared/timeout-glib.c \ android/hal-utils.h android/hal-utils.c \ android/ipc-common.h android/ipc-tester.c diff --git a/emulator/btdev.c b/emulator/btdev.c index 6a3b163..d0292a6 100644 --- a/emulator/btdev.c +++ b/emulator/btdev.c @@ -33,6 +33,7 @@ #include #include "src/shared/util.h" +#include "src/shared/timeout.h" #include "monitor/bt.h" #include "btdev.h" @@ -68,6 +69,8 @@ struct btdev { btdev_send_func send_handler; void *send_data; + unsigned int inquiry_id; + struct hook *hook_list[MAX_HOOK_ENTRIES]; uint16_t manufacturer; @@ -131,6 +134,14 @@ struct btdev { uint8_t sync_train_service_data; }; +struct inquiry_data { + struct btdev *btdev; + int sent_count; + int iter; +}; + +#define DEFAULT_INQUIRY_INTERVAL 100 /* 100 miliseconds */ + #define MAX_BTDEV_ENTRIES 16 static const uint8_t LINK_KEY_NONE[16] = { 0 }; @@ -536,6 +547,9 @@ void btdev_destroy(struct btdev *btdev) if (!btdev) return; + if (btdev->inquiry_id) + timeout_remove(btdev->inquiry_id); + del_btdev(btdev); free(btdev); @@ -692,12 +706,18 @@ static void num_completed_packets(struct btdev *btdev) } } -static void inquiry_complete(struct btdev *btdev, uint8_t status) +static bool inquiry_callback(void *user_data) { - struct bt_hci_evt_inquiry_complete ic; + struct inquiry_data *data = user_data; + struct btdev *btdev = data->btdev; + int sent = data->sent_count; int i; - for (i = 0; i < MAX_BTDEV_ENTRIES; i++) { + for (i = data->iter; i < MAX_BTDEV_ENTRIES; i++) { + /*Lets sent 10 inquiry results at once */ + if (sent + 10 == data->sent_count) + break; + if (!btdev_list[i] || btdev_list[i] == btdev) continue; @@ -719,6 +739,7 @@ static void inquiry_complete(struct btdev *btdev, uint8_t status) send_event(btdev, BT_HCI_EVT_EXT_INQUIRY_RESULT, &ir, sizeof(ir)); + data->sent_count++; continue; } @@ -735,6 +756,7 @@ static void inquiry_complete(struct btdev *btdev, uint8_t status) send_event(btdev, BT_HCI_EVT_INQUIRY_RESULT_WITH_RSSI, &ir, sizeof(ir)); + data->sent_count++; } else { struct bt_hci_evt_inquiry_result ir; @@ -748,11 +770,61 @@ static void inquiry_complete(struct btdev *btdev, uint8_t status) send_event(btdev, BT_HCI_EVT_INQUIRY_RESULT, &ir, sizeof(ir)); + data->sent_count++; } - } + } - ic.status = status; + data->iter = i; + + if (i == MAX_BTDEV_ENTRIES) { + struct bt_hci_evt_inquiry_complete ic; + + ic.status = BT_HCI_ERR_SUCCESS; + send_event(btdev, BT_HCI_EVT_INQUIRY_COMPLETE, &ic, sizeof(ic)); + + return false; + } + return true; +} + +static void inquiry_destroy(void *user_data) +{ + struct inquiry_data *data = user_data; + + if (data->btdev) + data->btdev->inquiry_id = 0; + + free(data); +} + +static void inquiry_cmd(struct btdev *btdev, const void *cmd) +{ + struct inquiry_data *data; + struct bt_hci_evt_inquiry_complete ic; + int status = BT_HCI_ERR_HARDWARE_FAILURE; + + if (btdev->inquiry_id > 0) { + status = BT_HCI_ERR_COMMAND_DISALLOWED; + goto failed; + } + + data = malloc(sizeof(*data)); + if (!data) + goto failed; + + memset(data, 0, sizeof(*data)); + data->btdev = btdev; + + btdev->inquiry_id = timeout_add(DEFAULT_INQUIRY_INTERVAL, + inquiry_callback, data, + inquiry_destroy); + /* Return if success */ + if (btdev->inquiry_id > 0) + return; + +failed: + ic.status = status; send_event(btdev, BT_HCI_EVT_INQUIRY_COMPLETE, &ic, sizeof(ic)); } @@ -2647,7 +2719,7 @@ static void default_cmd_completion(struct btdev *btdev, uint16_t opcode, case BT_HCI_CMD_INQUIRY: if (btdev->type == BTDEV_TYPE_LE) return; - inquiry_complete(btdev, BT_HCI_ERR_SUCCESS); + inquiry_cmd(btdev, data); break; case BT_HCI_CMD_CREATE_CONN: -- 1.8.4