From patchwork Tue Jun 22 01:01:27 2021 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Tedd Ho-Jeong An X-Patchwork-Id: 465294 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-10.7 required=3.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,FREEMAIL_FORGED_FROMDOMAIN,FREEMAIL_FROM, HEADER_FROM_DIFFERENT_DOMAINS, INCLUDES_PATCH, MAILING_LIST_MULTI, SPF_HELO_NONE, SPF_PASS, URIBL_BLOCKED, USER_AGENT_GIT autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 903A2C4743C for ; Tue, 22 Jun 2021 01:01:34 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id 6D5E761289 for ; Tue, 22 Jun 2021 01:01:34 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S229968AbhFVBDs (ORCPT ); Mon, 21 Jun 2021 21:03:48 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:60560 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229663AbhFVBDs (ORCPT ); Mon, 21 Jun 2021 21:03:48 -0400 Received: from mail-pf1-x42e.google.com (mail-pf1-x42e.google.com [IPv6:2607:f8b0:4864:20::42e]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 32808C061574 for ; Mon, 21 Jun 2021 18:01:33 -0700 (PDT) Received: by mail-pf1-x42e.google.com with SMTP id 21so121470pfp.3 for ; Mon, 21 Jun 2021 18:01:33 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:subject:date:message-id:mime-version :content-transfer-encoding; bh=VeeLQxuj66jGVpXa6UNilbd/H4ckQmm68Ab/6lrUDk0=; b=azXB+rqjSFGI9o+PX/k4DGNLkl/hXPSiMEeX/tjgkIYEYZeqJlrWU8zMzwUE9dePki bd3uUXTs3SCffIZbdwVnYiPzpnjzgHId5EiGwBh5l6Qwl5r07fBJYoRyuk11HSFAFqB8 QSdFmSWgnr2O+QerP/eWQnq370LbgVEMwApJUcc95lOHwIeVwM/b/zthdWhtleQV+gSN W0IiSBgsjXzLBkDdmOU9e5YiumvFLnw8dCmz5zFJ4iN2P1oUXjRgQJPq+rDJ2XS1GrRE fwQ40sSYMM9BwRYq1OujsFhbDnTf6hSHvj4wKUQybuYLL9k6XY92ZuidzZ8kdVeLJ/mH +f5w== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:subject:date:message-id:mime-version :content-transfer-encoding; bh=VeeLQxuj66jGVpXa6UNilbd/H4ckQmm68Ab/6lrUDk0=; b=nO+1GA57vvk9ZqKakxJT6cNxx7qOtmlF7D5k2qGJCj52CjuR7c1uoCSHd+hZK0nCcR lCXul83ba5enTvBxJehErDTcLvvTwzmNHkSyALhSzdatbtEgfRvxcQCSicD0yVvYV2k+ UZxuMXaueaLV6pTarRgWsMmxOcIEta7b31Z1QChquvyx9bzOgaNNvF+UIr8vSvlIKxcs Hai6WpVHTYOLTATVTwPtPrJjnHh3lpYZNr8UI/gFPJmLKMrHn+PEb38qQidY7W4+/N2h Tplzeg2OphvfR609PQFoqskIIm0mlNhffjaxJ6NYd5QOD32B37XX6q9q3tqgzup6eDNW SoyQ== X-Gm-Message-State: AOAM530qCGS9P3DMRkXpqDMOR11yETlyq3PtS1uKggfyu3XVoJDdB9NM QbivQPuNe5zVWYl8EPgm4dBI4lCe+QU= X-Google-Smtp-Source: ABdhPJzITqb06Ig/dNbsDJn76ZF3poW3wepi6tukMBZwuXiH7sIPEbGLLTO9c6pv76xLkwmeT5IThg== X-Received: by 2002:a05:6a00:be4:b029:300:effd:431f with SMTP id x36-20020a056a000be4b0290300effd431fmr904692pfu.69.1624323692452; Mon, 21 Jun 2021 18:01:32 -0700 (PDT) Received: from han1-mobl3.hsd1.or.comcast.net ([2601:1c0:6a01:d830::512a]) by smtp.gmail.com with ESMTPSA id f28sm17970120pgb.12.2021.06.21.18.01.31 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Mon, 21 Jun 2021 18:01:31 -0700 (PDT) From: Tedd Ho-Jeong An To: linux-bluetooth@vger.kernel.org Subject: [BlueZ PATCH 1/5] tools/mgmt-tester: Enable High-Speed(HS) test cases Date: Mon, 21 Jun 2021 18:01:27 -0700 Message-Id: <20210622010131.427059-1-hj.tedd.an@gmail.com> X-Mailer: git-send-email 2.26.3 MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: linux-bluetooth@vger.kernel.org From: Tedd Ho-Jeong An This patch enables the BT High-Speed(HS) test cases by enabling the HS in the kernel config. --- doc/tester.config | 1 + tools/mgmt-tester.c | 10 +++++----- 2 files changed, 6 insertions(+), 5 deletions(-) diff --git a/doc/tester.config b/doc/tester.config index 661d7a0b0..850fb6a38 100644 --- a/doc/tester.config +++ b/doc/tester.config @@ -29,6 +29,7 @@ CONFIG_BT_RFCOMM=y CONFIG_BT_BNEP=y CONFIG_BT_HIDP=y CONFIG_BT_LE=y +CONFIG_BT_HS=y CONFIG_BT_HCIVHCI=y diff --git a/tools/mgmt-tester.c b/tools/mgmt-tester.c index fcce699d3..8cae376f4 100644 --- a/tools/mgmt-tester.c +++ b/tools/mgmt-tester.c @@ -5315,7 +5315,7 @@ static const char ext_ctrl_info1[] = { 0x00, 0x00, 0x00, 0x01, 0xaa, 0x00, /* btaddr */ 0x09, /* version */ 0x3f, 0x00, /* manufacturer */ - 0xff, 0xbe, 0x01, 0x00, /* supported settings */ + 0xff, 0xbf, 0x01, 0x00, /* supported settings */ 0x80, 0x00, 0x00, 0x00, /* current settings */ 0x09, 0x00, /* eir length */ 0x04, /* dev class length */ @@ -5360,7 +5360,7 @@ static const char ext_ctrl_info2[] = { 0x00, 0x00, 0x00, 0x01, 0xaa, 0x00, /* btaddr */ 0x09, /* version */ 0x3f, 0x00, /* manufacturer */ - 0xff, 0xbe, 0x01, 0x00, /* supported settings */ + 0xff, 0xbf, 0x01, 0x00, /* supported settings */ 0x81, 0x02, 0x00, 0x00, /* current settings */ 0x0D, 0x00, /* eir length */ 0x04, /* dev class length */ @@ -5391,7 +5391,7 @@ static const char ext_ctrl_info3[] = { 0x00, 0x00, 0x00, 0x01, 0xaa, 0x00, /* btaddr */ 0x09, /* version */ 0x3f, 0x00, /* manufacturer */ - 0xff, 0xbe, 0x01, 0x00, /* supported settings */ + 0xff, 0xbf, 0x01, 0x00, /* supported settings */ 0x80, 0x02, 0x00, 0x00, /* current settings */ 0x16, 0x00, /* eir length */ 0x04, /* dev class length */ @@ -5426,7 +5426,7 @@ static const char ext_ctrl_info4[] = { 0x00, 0x00, 0x00, 0x01, 0xaa, 0x00, /* btaddr */ 0x09, /* version */ 0x3f, 0x00, /* manufacturer */ - 0xff, 0xbe, 0x01, 0x00, /* supported settings */ + 0xff, 0xbf, 0x01, 0x00, /* supported settings */ 0x80, 0x02, 0x00, 0x00, /* current settings */ 0x1a, 0x00, /* eir length */ 0x04, /* dev class length */ @@ -5485,7 +5485,7 @@ static const char ext_ctrl_info5[] = { 0x00, 0x00, 0x00, 0x01, 0xaa, 0x00, /* btaddr */ 0x09, /* version */ 0x3f, 0x00, /* manufacturer */ - 0xff, 0xbe, 0x01, 0x00, /* supported settings */ + 0xff, 0xbf, 0x01, 0x00, /* supported settings */ 0x81, 0x02, 0x00, 0x00, /* current settings */ 0x1a, 0x00, /* eir len */ 0x04, /* dev class len */ From patchwork Tue Jun 22 01:01:28 2021 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Tedd Ho-Jeong An X-Patchwork-Id: 465987 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-10.7 required=3.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,FREEMAIL_FORGED_FROMDOMAIN,FREEMAIL_FROM, HEADER_FROM_DIFFERENT_DOMAINS, INCLUDES_PATCH, MAILING_LIST_MULTI, SPF_HELO_NONE, SPF_PASS, URIBL_BLOCKED, USER_AGENT_GIT autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 68E59C48BE5 for ; Tue, 22 Jun 2021 01:01:35 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id 425F96128C for ; Tue, 22 Jun 2021 01:01:35 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S230039AbhFVBDt (ORCPT ); Mon, 21 Jun 2021 21:03:49 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:60562 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229663AbhFVBDt (ORCPT ); Mon, 21 Jun 2021 21:03:49 -0400 Received: from mail-pf1-x42c.google.com (mail-pf1-x42c.google.com [IPv6:2607:f8b0:4864:20::42c]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id C9EAEC061574 for ; Mon, 21 Jun 2021 18:01:33 -0700 (PDT) Received: by mail-pf1-x42c.google.com with SMTP id c8so1240901pfp.5 for ; Mon, 21 Jun 2021 18:01:33 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:subject:date:message-id:in-reply-to:references:mime-version :content-transfer-encoding; bh=vzLaaZ5H0lCVkV5bKu9NLFhOs+p3vCv4D/N9onvfrTA=; b=l+266sVcMV+pYG553UYko1mDa/5W/XutL+mTCceKm7J3BL1gMG9m3eewPj5S1IIWwr EPwg6qt8BAq5D58vxUQpPcpLgtyAINPfzRBvOWSsoeUQJIOXrJb37Txk3tcBeaTcx9pN IaKQuAUMovC9cqemOntDiVBujRz7/6Wga57HYsyHVj1xOXPJguK98l30OJAfkLJ6DDLM F1CvJk8rkilPeHxpsUD9rnfuADD5z4MEd+B44LsO3HxZPt7jU6CwNZ5blMhAasnHJsxO eu12xsrYu8CQMZ9PdnvD4llItYYoEvpzqT4y4/vLASlNdsDJdrVNvkidjjopT68JOJ/u jh6w== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=vzLaaZ5H0lCVkV5bKu9NLFhOs+p3vCv4D/N9onvfrTA=; b=GT8f4xI99QjwPGog54kCVOMV8XUJaubbpRvn+tY61QD2edR25LLRrSH8fFIAwYr34V hZy6Ge1y60RHg03RH1zz/CPiIjLZR6UE5JIqXfPg1+AX7qJ8AfyNitukIMyrT9EreQtj JpUA0tE2f+BUVKYT8/P4RQ9UvIcIaPNHmxrTYdhgkX9EP4GTIa/ey9UuxcTFrHLnYR60 z8QUERCWSOU4X9nYSDYMTbvnKK70fYGRUFfq6qyIAzo5q5p5bcrqrQOkWwInk//qAYg3 CE2uimyeV9/lBlbKoPU4sqMAYcLyWt9aFIro8tvI9SlTw9WWGyANAmNh1wHWQWnAGV5A gh/w== X-Gm-Message-State: AOAM530B6kEagegVMcYEbzCniwj9PLLewvH/Ve6q1BcYVyOn9KGnPyDG 99ZP0NNd1CfU9TCyOW9qUYRGEJ69FkU= X-Google-Smtp-Source: ABdhPJxzGwJNop8901c4IYGx8+DXLEPBANxxo9zVwWeSfS9QHmkLgXu/WoyMUlyIbEwyAppBdf9Vow== X-Received: by 2002:a63:5019:: with SMTP id e25mr1179617pgb.280.1624323693208; Mon, 21 Jun 2021 18:01:33 -0700 (PDT) Received: from han1-mobl3.hsd1.or.comcast.net ([2601:1c0:6a01:d830::512a]) by smtp.gmail.com with ESMTPSA id f28sm17970120pgb.12.2021.06.21.18.01.32 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Mon, 21 Jun 2021 18:01:32 -0700 (PDT) From: Tedd Ho-Jeong An To: linux-bluetooth@vger.kernel.org Subject: [BlueZ PATCH 2/5] monitor: Add Unknown Advertising ID error code Date: Mon, 21 Jun 2021 18:01:28 -0700 Message-Id: <20210622010131.427059-2-hj.tedd.an@gmail.com> X-Mailer: git-send-email 2.26.3 In-Reply-To: <20210622010131.427059-1-hj.tedd.an@gmail.com> References: <20210622010131.427059-1-hj.tedd.an@gmail.com> MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: linux-bluetooth@vger.kernel.org From: Tedd Ho-Jeong An This patch adds Unknown Advertising ID error code (0x42) --- monitor/bt.h | 1 + 1 file changed, 1 insertion(+) diff --git a/monitor/bt.h b/monitor/bt.h index ac4f976fc..d60bbdb20 100644 --- a/monitor/bt.h +++ b/monitor/bt.h @@ -3657,6 +3657,7 @@ struct bt_hci_evt_le_req_peer_sca_complete { #define BT_HCI_ERR_INVALID_PARAMETERS 0x12 #define BT_HCI_ERR_UNSPECIFIED_ERROR 0x1f #define BT_HCI_ERR_CONN_FAILED_TO_ESTABLISH 0x3e +#define BT_HCI_ERR_UNKNOWN_ADVERTISING_ID 0x42 struct bt_l2cap_hdr { uint16_t len; From patchwork Tue Jun 22 01:01:29 2021 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Tedd Ho-Jeong An X-Patchwork-Id: 465986 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-10.7 required=3.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,FREEMAIL_FORGED_FROMDOMAIN,FREEMAIL_FROM, HEADER_FROM_DIFFERENT_DOMAINS, INCLUDES_PATCH, MAILING_LIST_MULTI, SPF_HELO_NONE, SPF_PASS, URIBL_BLOCKED, USER_AGENT_GIT autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 97004C49EA2 for ; Tue, 22 Jun 2021 01:01:36 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id 74FB261289 for ; Tue, 22 Jun 2021 01:01:36 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S230061AbhFVBDu (ORCPT ); Mon, 21 Jun 2021 21:03:50 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:60570 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229663AbhFVBDt (ORCPT ); Mon, 21 Jun 2021 21:03:49 -0400 Received: from mail-pg1-x52e.google.com (mail-pg1-x52e.google.com [IPv6:2607:f8b0:4864:20::52e]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 0F4DAC061574 for ; Mon, 21 Jun 2021 18:01:35 -0700 (PDT) Received: by mail-pg1-x52e.google.com with SMTP id e33so15700381pgm.3 for ; Mon, 21 Jun 2021 18:01:35 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:subject:date:message-id:in-reply-to:references:mime-version :content-transfer-encoding; bh=RAzrurrLz4zNYxAle8fIDGmaCi5sMC5MxucAAd4LeHo=; b=L6zlISz/Md023NY/Y/M0ztpxzIoNRiWp4xtVMmjH9KIcXaLL/dj9A9sEWKHCrViCgU N628TFlUvxKmRaPvQSSlNqEOSbu2rst1oHneOtBXnL4BjamiXrJ2ONpZm7uC4iBs6ffG M3wla+ChDUXWzvE08WC3lgWyLSBtFWL45uVM2vjr3OYHttnkKa/o6/CcicZ2emQsI6bL nrI5J9j6X+dcsYxpCjE9sjzpYGKYX3s/OMBcEnBjDZ9df+hdi3KkNKjUbZe1GZrwFOk0 MFBwJuKR0LJllwSAr8HDB1kFI34NNeBTh/zf1HM/7svoeP69AMv32OT433JRCjYrUBc9 vnhw== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=RAzrurrLz4zNYxAle8fIDGmaCi5sMC5MxucAAd4LeHo=; b=gw0t0Q1goUGdu85/cMxHcY2aPI18IhrKhGQrVhxg1gpVSLgx7NkdPqFb1mtpK4VleO dfnIv2ifYob5CqewHOeBTAV4zMWtekjvDLbDqCKLENRPK6CFoMsLd73wncMIA70LJgZg MjskoPsY9TQ1SVp1rKynHPNsnBV2w12PxbsMPE2yJ7CIGO9Y9OZUq8aKQl71nSwo3pWa xXzmLuuHkQBqxEt2IqwT6YeGx6CBxB4op2OAoRBybHBnaBp2faIWxzc5t06uhBgse0fM AWKLVK6SUgIyTCaWModm3x3T4S4xaSg0GsqATVqaVdBkJLAdu7zR03lv6foJcpnTq60M vYqw== X-Gm-Message-State: AOAM533a99Q7zdziOtcKOb6jhqtbBspZOQvBbpUAG8DJWn4sdPyXtDEq LSjrJxbuXUo98CymOQVYsNEnGs+nl4Q= X-Google-Smtp-Source: ABdhPJxEqWeZqpnvWRKKU8Nco2XH9bFb8Xb1tASI2nccDIUai5M8PSCDaWQUNZ+2gSRBJtoORBbaOQ== X-Received: by 2002:aa7:8186:0:b029:2f7:f70a:b7be with SMTP id g6-20020aa781860000b02902f7f70ab7bemr966418pfi.64.1624323694142; Mon, 21 Jun 2021 18:01:34 -0700 (PDT) Received: from han1-mobl3.hsd1.or.comcast.net ([2601:1c0:6a01:d830::512a]) by smtp.gmail.com with ESMTPSA id f28sm17970120pgb.12.2021.06.21.18.01.33 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Mon, 21 Jun 2021 18:01:33 -0700 (PDT) From: Tedd Ho-Jeong An To: linux-bluetooth@vger.kernel.org Subject: [BlueZ PATCH 3/5] emulator/btdev: Add support multiple instance of extended advertising Date: Mon, 21 Jun 2021 18:01:29 -0700 Message-Id: <20210622010131.427059-3-hj.tedd.an@gmail.com> X-Mailer: git-send-email 2.26.3 In-Reply-To: <20210622010131.427059-1-hj.tedd.an@gmail.com> References: <20210622010131.427059-1-hj.tedd.an@gmail.com> MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: linux-bluetooth@vger.kernel.org From: Tedd Ho-Jeong An This patch adds support multiple instance of extended advertising. --- emulator/btdev.c | 417 ++++++++++++++++++++++++++++++++++++----------- 1 file changed, 321 insertions(+), 96 deletions(-) diff --git a/emulator/btdev.c b/emulator/btdev.c index eba9f57f9..dc9603b79 100644 --- a/emulator/btdev.c +++ b/emulator/btdev.c @@ -52,6 +52,7 @@ struct hook { }; #define MAX_HOOK_ENTRIES 16 +#define MAX_EXT_ADV_SETS 3 struct btdev_conn { uint16_t handle; @@ -72,6 +73,21 @@ struct btdev_rl { uint8_t local_irk[16]; }; +struct le_ext_adv { + uint8_t handle; + uint8_t enable; + uint8_t type; /* evt_properties */ + uint8_t own_addr_type; /* own_addr_type */ + uint8_t direct_addr_type; /* peer_addr_type */ + uint8_t direct_addr[6]; /* peer_addr */ + uint8_t filter_policy; /* filter_policy */ + uint8_t random_addr[6]; + uint8_t adv_data[252]; + uint8_t adv_data_len; + uint8_t scan_data[252]; + uint8_t scan_data_len; +}; + struct btdev { enum btdev_type type; @@ -185,6 +201,8 @@ struct btdev { uint16_t le_ext_adv_type; + struct queue *le_ext_adv; + btdev_debug_func_t debug_callback; btdev_destroy_func_t debug_destroy; void *debug_data; @@ -1010,8 +1028,9 @@ static struct btdev_conn *conn_link(struct btdev *dev, struct btdev *remote, conn2->link = conn1; util_debug(dev->debug_callback, dev->debug_data, - "conn1 %p handle 0x%04x conn2 %p handle 0x%04x", - conn1, conn1->handle, conn2, conn2->handle); + "conn1 %p handle 0x%04x", conn1, conn1->handle); + util_debug(dev->debug_callback, dev->debug_data, + "conn2 %p handle 0x%04x", conn2, conn2->handle); return conn1; } @@ -3083,18 +3102,6 @@ static const uint8_t *scan_addr(const struct btdev *btdev) return btdev->bdaddr; } -static bool ext_adv_match(struct btdev *scan, struct btdev *adv) -{ - /* Match everything if this is not directed advertising */ - if (!(adv->le_ext_adv_type & 0x04)) - return true; - - if (scan->le_scan_own_addr_type != adv->le_adv_direct_addr_type) - return false; - - return !memcmp(scan_addr(scan), adv->le_adv_direct_addr, 6); -} - static const uint8_t *adv_addr(const struct btdev *btdev) { if (btdev->le_adv_own_addr == 0x01) @@ -4192,13 +4199,103 @@ static int cmd_set_default_phy(struct btdev *dev, const void *data, return 0; } +static const uint8_t *ext_adv_addr(const struct btdev *btdev, + struct le_ext_adv *ext_adv) +{ + if (ext_adv->own_addr_type == 0x01) + return ext_adv->random_addr; + + return btdev->bdaddr; +} + +static bool ext_adv_match_addr(const struct btdev *btdev, + struct le_ext_adv *ext_adv) +{ + /* Match everything if this is not directed advertising */ + if (!(ext_adv->type & 0x04)) + return true; + + if (btdev->le_scan_own_addr_type != ext_adv->direct_addr_type) + return false; + + return !memcmp(scan_addr(btdev), ext_adv->direct_addr, 6); +} + +static bool match_ext_adv_handle(const void *data, const void *match_data) +{ + const struct le_ext_adv *ext_adv = data; + uint8_t handle = PTR_TO_UINT(match_data); + + return ext_adv->handle == handle; +} + +static void ext_adv_disable(void *data, void *user_data) +{ + struct le_ext_adv *ext_adv = data; + uint8_t handle = PTR_TO_UINT(user_data); + + if (handle && ext_adv->handle != handle) + return; + + ext_adv->enable = 0x00; +} + +static bool ext_adv_is_connectable(struct le_ext_adv *ext_adv) +{ + if (!ext_adv->enable) + return false; + + return ext_adv->type & 0x01; +} + +static struct le_ext_adv *le_ext_adv_new(struct btdev *btdev, uint8_t handle) +{ + struct le_ext_adv *ext_adv; + + ext_adv = new0(struct le_ext_adv, 1); + ext_adv->handle = handle; + + /* Add to queue */ + if (!queue_push_tail(btdev->le_ext_adv, ext_adv)) { + free(ext_adv); + return NULL; + } + + return ext_adv; +} + +static void le_ext_adv_free(void *data) +{ + struct le_ext_adv *ext_adv = data; + + free(ext_adv); +} + static int cmd_set_adv_rand_addr(struct btdev *dev, const void *data, uint8_t len) { const struct bt_hci_cmd_le_set_adv_set_rand_addr *cmd = data; + struct le_ext_adv *ext_adv; uint8_t status = BT_HCI_ERR_SUCCESS; - memcpy(dev->random_addr, cmd->bdaddr, 6); + /* Check if Ext Adv is already existed */ + ext_adv = queue_find(dev->le_ext_adv, match_ext_adv_handle, + UINT_TO_PTR(cmd->handle)); + if (!ext_adv) { + status = BT_HCI_ERR_UNKNOWN_ADVERTISING_ID; + cmd_complete(dev, BT_HCI_CMD_LE_SET_ADV_SET_RAND_ADDR, &status, + sizeof(status)); + return 0; + } + + if (ext_adv_is_connectable(ext_adv)) { + status = BT_HCI_ERR_COMMAND_DISALLOWED; + cmd_complete(dev, BT_HCI_CMD_LE_SET_ADV_SET_RAND_ADDR, &status, + sizeof(status)); + return 0; + } + + memcpy(ext_adv->random_addr, cmd->bdaddr, 6); cmd_complete(dev, BT_HCI_CMD_LE_SET_ADV_SET_RAND_ADDR, &status, sizeof(status)); @@ -4210,20 +4307,43 @@ static int cmd_set_ext_adv_params(struct btdev *dev, const void *data, { const struct bt_hci_cmd_le_set_ext_adv_params *cmd = data; struct bt_hci_rsp_le_set_ext_adv_params rsp; + struct le_ext_adv *ext_adv; uint8_t status; - if (dev->le_adv_enable) { + /* Check if Ext Adv is already existed */ + ext_adv = queue_find(dev->le_ext_adv, match_ext_adv_handle, + UINT_TO_PTR(cmd->handle)); + if (!ext_adv) { + /* No more than maximum number */ + if (queue_length(dev->le_ext_adv) >= MAX_EXT_ADV_SETS) { + status = BT_HCI_ERR_MEM_CAPACITY_EXCEEDED; + cmd_complete(dev, BT_HCI_CMD_LE_SET_EXT_ADV_PARAMS, + &status, sizeof(status)); + return 0; + } + + /* Create new set */ + ext_adv = le_ext_adv_new(dev, cmd->handle); + if (!ext_adv) { + status = BT_HCI_ERR_MEM_CAPACITY_EXCEEDED; + cmd_complete(dev, BT_HCI_CMD_LE_SET_EXT_ADV_PARAMS, + &status, sizeof(status)); + return 0; + } + } + + if (ext_adv->enable) { status = BT_HCI_ERR_COMMAND_DISALLOWED; cmd_complete(dev, BT_HCI_CMD_LE_SET_EXT_ADV_PARAMS, &status, sizeof(status)); return 0; } - dev->le_ext_adv_type = le16_to_cpu(cmd->evt_properties); - dev->le_adv_own_addr = cmd->own_addr_type; - dev->le_adv_direct_addr_type = cmd->peer_addr_type; - memcpy(dev->le_adv_direct_addr, cmd->peer_addr, 6); - dev->le_adv_filter_policy = cmd->filter_policy; + ext_adv->type = le16_to_cpu(cmd->evt_properties); + ext_adv->own_addr_type = cmd->own_addr_type; + ext_adv->direct_addr_type = cmd->peer_addr_type; + memcpy(ext_adv->direct_addr, cmd->peer_addr, 6); + ext_adv->filter_policy = cmd->filter_policy; rsp.status = BT_HCI_ERR_SUCCESS; rsp.tx_power = 0; @@ -4236,10 +4356,20 @@ static int cmd_set_ext_adv_data(struct btdev *dev, const void *data, uint8_t len) { const struct bt_hci_cmd_le_set_ext_adv_data *cmd = data; + struct le_ext_adv *ext_adv; uint8_t status = BT_HCI_ERR_SUCCESS; - dev->le_adv_data_len = cmd->data_len; - memcpy(dev->le_adv_data, cmd->data, 31); + ext_adv = queue_find(dev->le_ext_adv, match_ext_adv_handle, + UINT_TO_PTR(cmd->handle)); + if (!ext_adv) { + status = BT_HCI_ERR_UNKNOWN_ADVERTISING_ID; + cmd_complete(dev, BT_HCI_CMD_LE_SET_EXT_ADV_DATA, &status, + sizeof(status)); + return 0; + } + + ext_adv->adv_data_len = cmd->data_len; + memcpy(ext_adv->adv_data, cmd->data, cmd->data_len); cmd_complete(dev, BT_HCI_CMD_LE_SET_EXT_ADV_DATA, &status, sizeof(status)); @@ -4250,10 +4380,20 @@ static int cmd_set_ext_scan_rsp_data(struct btdev *dev, const void *data, uint8_t len) { const struct bt_hci_cmd_le_set_ext_scan_rsp_data *cmd = data; + struct le_ext_adv *ext_adv; uint8_t status = BT_HCI_ERR_SUCCESS; - dev->le_scan_data_len = cmd->data_len; - memcpy(dev->le_scan_data, cmd->data, 31); + ext_adv = queue_find(dev->le_ext_adv, match_ext_adv_handle, + UINT_TO_PTR(cmd->handle)); + if (!ext_adv) { + status = BT_HCI_ERR_UNKNOWN_ADVERTISING_ID; + cmd_complete(dev, BT_HCI_CMD_LE_SET_EXT_ADV_DATA, &status, + sizeof(status)); + return 0; + } + + ext_adv->scan_data_len = cmd->data_len; + memcpy(ext_adv->scan_data, cmd->data, cmd->data_len); cmd_complete(dev, BT_HCI_CMD_LE_SET_EXT_SCAN_RSP_DATA, &status, sizeof(status)); @@ -4261,6 +4401,7 @@ static int cmd_set_ext_scan_rsp_data(struct btdev *dev, const void *data, } static void send_ext_adv(struct btdev *btdev, const struct btdev *remote, + struct le_ext_adv *ext_adv, uint16_t type, bool is_scan_rsp) { struct __packed { @@ -4274,8 +4415,8 @@ static void send_ext_adv(struct btdev *btdev, const struct btdev *remote, memset(&meta_event.lear, 0, sizeof(meta_event.lear)); meta_event.num_reports = 1; meta_event.lear.event_type = cpu_to_le16(type); - meta_event.lear.addr_type = remote->le_adv_own_addr; - memcpy(meta_event.lear.addr, adv_addr(remote), 6); + meta_event.lear.addr_type = ext_adv->own_addr_type; + memcpy(meta_event.lear.addr, ext_adv_addr(remote, ext_adv), 6); meta_event.lear.rssi = 127; meta_event.lear.tx_power = 127; /* Right now we dont care about phy in adv report */ @@ -4284,12 +4425,12 @@ static void send_ext_adv(struct btdev *btdev, const struct btdev *remote, /* Scan or advertising response */ if (is_scan_rsp) { - meta_event.lear.data_len = remote->le_scan_data_len; - memcpy(meta_event.lear.data, remote->le_scan_data, + meta_event.lear.data_len = ext_adv->scan_data_len; + memcpy(meta_event.lear.data, ext_adv->scan_data, meta_event.lear.data_len); } else { - meta_event.lear.data_len = remote->le_adv_data_len; - memcpy(meta_event.lear.data, remote->le_adv_data, + meta_event.lear.data_len = ext_adv->adv_data_len; + memcpy(meta_event.lear.data, ext_adv->adv_data, meta_event.lear.data_len); } @@ -4297,12 +4438,13 @@ static void send_ext_adv(struct btdev *btdev, const struct btdev *remote, 1 + 24 + meta_event.lear.data_len); } -static void le_set_ext_adv_enable_complete(struct btdev *btdev) +static void le_set_ext_adv_enable_complete(struct btdev *btdev, + struct le_ext_adv *ext_adv) { uint16_t report_type; int i; - report_type = get_ext_adv_type(btdev->le_ext_adv_type); + report_type = get_ext_adv_type(ext_adv->type); for (i = 0; i < MAX_BTDEV_ENTRIES; i++) { if (!btdev_list[i] || btdev_list[i] == btdev) @@ -4311,26 +4453,27 @@ static void le_set_ext_adv_enable_complete(struct btdev *btdev) if (!btdev_list[i]->le_scan_enable) continue; - if (!ext_adv_match(btdev_list[i], btdev)) + if (!ext_adv_match_addr(btdev_list[i], ext_adv)) continue; - send_ext_adv(btdev_list[i], btdev, report_type, false); + send_ext_adv(btdev_list[i], btdev, ext_adv, report_type, false); if (btdev_list[i]->le_scan_type != 0x01) continue; /* if scannable bit is set the send scan response */ - if (btdev->le_ext_adv_type & 0x02) { - if (btdev->le_ext_adv_type == 0x13) + if (ext_adv->type & 0x02) { + if (ext_adv->type == 0x13) report_type = 0x1b; - else if (btdev->le_ext_adv_type == 0x12) + else if (ext_adv->type == 0x12) report_type = 0x1a; - else if (!(btdev->le_ext_adv_type & 0x10)) + else if (!(ext_adv->type & 0x10)) report_type &= 0x08; else continue; - send_ext_adv(btdev_list[i], btdev, report_type, true); + send_ext_adv(btdev_list[i], btdev, ext_adv, + report_type, true); } } } @@ -4339,31 +4482,62 @@ static int cmd_set_ext_adv_enable(struct btdev *dev, const void *data, uint8_t len) { const struct bt_hci_cmd_le_set_ext_adv_enable *cmd = data; - uint8_t status; + uint8_t status = BT_HCI_ERR_SUCCESS; + int i; - if (dev->le_adv_enable == cmd->enable) - status = BT_HCI_ERR_COMMAND_DISALLOWED; - else { + /* Num of set is zero */ + if (!cmd->num_of_sets) { + if (cmd->enable) { + status = BT_HCI_ERR_INVALID_PARAMETERS; + goto exit_complete; + } + + /* Disable all advertising sets */ + queue_foreach(dev->le_ext_adv, ext_adv_disable, NULL); + goto exit_complete; + } + + /* Process each sets */ + for (i = 0; i < cmd->num_of_sets; i++) { const struct bt_hci_cmd_ext_adv_set *eas; + struct le_ext_adv *ext_adv; - if (cmd->num_of_sets) { - eas = data + sizeof(*cmd); - if (eas->duration || cmd->num_of_sets > 1) - status = BT_HCI_ERR_INVALID_PARAMETERS; - else - status = BT_HCI_ERR_SUCCESS; - } else - status = BT_HCI_ERR_SUCCESS; + eas = data + sizeof(*cmd) + (sizeof(*eas) * i); + + ext_adv = queue_find(dev->le_ext_adv, match_ext_adv_handle, + UINT_TO_PTR(eas->handle)); + if (!ext_adv) { + status = BT_HCI_ERR_UNKNOWN_ADVERTISING_ID; + goto exit_complete; + } + + if (ext_adv->enable == cmd->enable) { + status = BT_HCI_ERR_COMMAND_DISALLOWED; + goto exit_complete; + } - if (status == BT_HCI_ERR_SUCCESS) - dev->le_adv_enable = cmd->enable; + ext_adv->enable = cmd->enable; } +exit_complete: cmd_complete(dev, BT_HCI_CMD_LE_SET_EXT_ADV_ENABLE, &status, sizeof(status)); - if (status == BT_HCI_ERR_SUCCESS && dev->le_adv_enable) - le_set_ext_adv_enable_complete(dev); + if (status == BT_HCI_ERR_SUCCESS && cmd->enable) { + /* Go through each sets and send adv event to peer device */ + for (i = 0; i < cmd->num_of_sets; i++) { + const struct bt_hci_cmd_ext_adv_set *eas; + struct le_ext_adv *ext_adv; + + eas = data + sizeof(*cmd) + (sizeof(*eas) * i); + + ext_adv = queue_find(dev->le_ext_adv, + match_ext_adv_handle, + UINT_TO_PTR(eas->handle)); + if (ext_adv) + le_set_ext_adv_enable_complete(dev, ext_adv); + } + } return 0; } @@ -4383,8 +4557,7 @@ static int cmd_read_num_adv_sets(struct btdev *dev, const void *data, memset(&rsp, 0, sizeof(rsp)); rsp.status = BT_HCI_ERR_SUCCESS; - /* Support one set as of now */ - rsp.num_of_sets = 1; + rsp.num_of_sets = MAX_EXT_ADV_SETS; cmd_complete(dev, BT_HCI_CMD_LE_READ_NUM_SUPPORTED_ADV_SETS, &rsp, sizeof(rsp)); @@ -4394,8 +4567,29 @@ static int cmd_read_num_adv_sets(struct btdev *dev, const void *data, static int cmd_remove_adv_set(struct btdev *dev, const void *data, uint8_t len) { + const struct bt_hci_cmd_le_remove_adv_set *cmd = data; + struct le_ext_adv *ext_adv; uint8_t status = BT_HCI_ERR_SUCCESS; + ext_adv = queue_find(dev->le_ext_adv, match_ext_adv_handle, + UINT_TO_PTR(cmd->handle)); + if (!ext_adv) { + status = BT_HCI_ERR_UNKNOWN_ADVERTISING_ID; + cmd_complete(dev, BT_HCI_CMD_LE_SET_EXT_ADV_DATA, &status, + sizeof(status)); + return 0; + } + + if (ext_adv->enable) { + status = BT_HCI_ERR_COMMAND_DISALLOWED; + cmd_complete(dev, BT_HCI_CMD_LE_REMOVE_ADV_SET, &status, + sizeof(status)); + return 0; + } + + queue_remove(dev->le_ext_adv, ext_adv); + free(ext_adv); + cmd_complete(dev, BT_HCI_CMD_LE_REMOVE_ADV_SET, &status, sizeof(status)); @@ -4405,8 +4599,23 @@ static int cmd_remove_adv_set(struct btdev *dev, const void *data, static int cmd_clear_adv_sets(struct btdev *dev, const void *data, uint8_t len) { + const struct queue_entry *entry; uint8_t status = BT_HCI_ERR_SUCCESS; + for (entry = queue_get_entries(dev->le_ext_adv); entry; + entry = entry->next) { + struct le_ext_adv *ext_adv = entry->data; + + if (ext_adv->enable) { + status = BT_HCI_ERR_COMMAND_DISALLOWED; + cmd_complete(dev, BT_HCI_CMD_LE_CLEAR_ADV_SETS, &status, + sizeof(status)); + return 0; + } + } + + queue_remove_all(dev->le_ext_adv, NULL, NULL, le_ext_adv_free); + cmd_complete(dev, BT_HCI_CMD_LE_CLEAR_ADV_SETS, &status, sizeof(status)); @@ -4513,68 +4722,72 @@ static int cmd_set_ext_scan_enable(struct btdev *dev, const void *data, return 0; } -static int cmd_set_ext_scan_enable_complete(struct btdev *dev, const void *data, - uint8_t len) +static void scan_ext_adv(struct btdev *dev, struct btdev *remote) { - const struct bt_hci_cmd_le_set_ext_scan_enable *cmd = data; - int i; - - if (!dev->le_scan_enable || !cmd->enable) - return 0; + const struct queue_entry *entry; - for (i = 0; i < MAX_BTDEV_ENTRIES; i++) { + for (entry = queue_get_entries(remote->le_ext_adv); entry; + entry = entry->next) { + struct le_ext_adv *ext_adv = entry->data; uint16_t report_type; - if (!btdev_list[i] || btdev_list[i] == dev) + if (!ext_adv->enable) continue; - if (!btdev_list[i]->le_adv_enable) + if (!ext_adv_match_addr(dev, ext_adv)) continue; - if (!ext_adv_match(dev, btdev_list[i])) - continue; - - report_type = get_ext_adv_type(btdev_list[i]->le_ext_adv_type); - send_ext_adv(dev, btdev_list[i], report_type, false); + report_type = get_ext_adv_type(ext_adv->type); + send_ext_adv(dev, remote, ext_adv, report_type, false); if (dev->le_scan_type != 0x01) continue; /* if scannable bit is set the send scan response */ - if (btdev_list[i]->le_ext_adv_type & 0x02) { - if (btdev_list[i]->le_ext_adv_type == 0x13) + if (ext_adv->type & 0x02) { + if (ext_adv->type == 0x13) report_type = 0x1b; - else if (btdev_list[i]->le_ext_adv_type == 0x12) + else if (ext_adv->type == 0x12) report_type = 0x1a; - else if (!(btdev_list[i]->le_ext_adv_type & 0x10)) + else if (!(ext_adv->type & 0x10)) report_type &= 0x08; else continue; - send_ext_adv(dev, btdev_list[i], report_type, true); + send_ext_adv(dev, remote, ext_adv, report_type, true); } } - - return 0; } -static int cmd_ext_create_conn(struct btdev *dev, const void *data, uint8_t len) +static int cmd_set_ext_scan_enable_complete(struct btdev *dev, const void *data, + uint8_t len) { - cmd_status(dev, BT_HCI_ERR_SUCCESS, BT_HCI_CMD_LE_EXT_CREATE_CONN); + const struct bt_hci_cmd_le_set_ext_scan_enable *cmd = data; + int i; + + if (!dev->le_scan_enable || !cmd->enable) + return 0; + + for (i = 0; i < MAX_BTDEV_ENTRIES; i++) { + if (!btdev_list[i] || btdev_list[i] == dev) + continue; + + scan_ext_adv(dev, btdev_list[i]); + } return 0; } -static bool ext_adv_connectable(struct btdev *btdev) +static int cmd_ext_create_conn(struct btdev *dev, const void *data, uint8_t len) { - if (!btdev->le_adv_enable) - return false; + cmd_status(dev, BT_HCI_ERR_SUCCESS, BT_HCI_CMD_LE_EXT_CREATE_CONN); - return btdev->le_ext_adv_type & 0x01; + return 0; } static void le_ext_conn_complete(struct btdev *btdev, const struct bt_hci_cmd_le_ext_create_conn *cmd, + struct le_ext_adv *ext_adv, uint8_t status) { struct bt_hci_evt_le_enhanced_conn_complete ev; @@ -4589,10 +4802,10 @@ static void le_ext_conn_complete(struct btdev *btdev, if (!conn) return; - if (!btdev->le_ext_adv_type) { - btdev->le_adv_enable = 0; - conn->link->dev->le_adv_enable = 0; - } + /* Disable EXT ADV */ + queue_foreach(btdev->le_ext_adv, ext_adv_disable, NULL); + queue_foreach(conn->link->dev->le_ext_adv, ext_adv_disable, + NULL); ev.status = status; ev.peer_addr_type = btdev->le_scan_own_addr_type; @@ -4625,19 +4838,30 @@ static int cmd_ext_create_conn_complete(struct btdev *dev, const void *data, uint8_t len) { const struct bt_hci_cmd_le_ext_create_conn *cmd = data; + const struct queue_entry *entry; struct btdev *remote; dev->le_scan_own_addr_type = cmd->own_addr_type; remote = find_btdev_by_bdaddr_type(cmd->peer_addr, cmd->peer_addr_type); - if (remote && ext_adv_connectable(remote) && - ext_adv_match(dev, remote) && - remote->le_adv_own_addr == cmd->peer_addr_type) - le_ext_conn_complete(dev, cmd, 0); - else - le_ext_conn_complete(dev, cmd, + if (!remote) { + le_ext_conn_complete(dev, cmd, NULL, BT_HCI_ERR_CONN_FAILED_TO_ESTABLISH); + return 0; + } + for (entry = queue_get_entries(remote->le_ext_adv); entry; + entry = entry->next) { + struct le_ext_adv *ext_adv = entry->data; + + if (ext_adv_is_connectable(ext_adv) && + ext_adv_match_addr(dev, ext_adv) && + ext_adv->own_addr_type == cmd->peer_addr_type) { + le_ext_conn_complete(dev, cmd, ext_adv, 0); + return 0; + } + + } return 0; } @@ -5748,6 +5972,7 @@ struct btdev *btdev_create(enum btdev_type type, uint16_t id) get_bdaddr(id, index, btdev->bdaddr); btdev->conns = queue_new(); + btdev->le_ext_adv = queue_new(); return btdev; } From patchwork Tue Jun 22 01:01:30 2021 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Tedd Ho-Jeong An X-Patchwork-Id: 465293 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-10.7 required=3.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,FREEMAIL_FORGED_FROMDOMAIN,FREEMAIL_FROM, HEADER_FROM_DIFFERENT_DOMAINS, INCLUDES_PATCH, MAILING_LIST_MULTI, SPF_HELO_NONE, SPF_PASS, URIBL_BLOCKED, USER_AGENT_GIT autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id F0342C48BC2 for ; Tue, 22 Jun 2021 01:01:36 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id D57D36134F for ; Tue, 22 Jun 2021 01:01:36 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S230076AbhFVBDv (ORCPT ); Mon, 21 Jun 2021 21:03:51 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:60572 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S230057AbhFVBDu (ORCPT ); Mon, 21 Jun 2021 21:03:50 -0400 Received: from mail-pf1-x435.google.com (mail-pf1-x435.google.com [IPv6:2607:f8b0:4864:20::435]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 533D0C061756 for ; Mon, 21 Jun 2021 18:01:35 -0700 (PDT) Received: by mail-pf1-x435.google.com with SMTP id a127so4540851pfa.10 for ; Mon, 21 Jun 2021 18:01:35 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:subject:date:message-id:in-reply-to:references:mime-version :content-transfer-encoding; bh=fijeLYxAajiOMQuAFN30hNSlRkp9xloU3BMCsZB7sQs=; b=e4dTfHsl+nmjGfAFuXN3OVEF7HtXde/nRK73JQBVUU6PvovzrvN07dXYnjh8YRrhR7 c/6EdB0WvSPnUjtrckipWUOODZm1cpjYe7oTJ18/zPCdnOUgPav6Nbo2e2bJFEVIeY5P I6bunC4ml/EnR7zwI06suBGrKejVXcEfzpRBnmM1Eec0qLs5wCeDysHzvV12iwidB/Ej xZNoTZf4q5Bj4D3AYoP442N5mtCY2kBI1zchhdJ3DECwyXROLzbv45VWrPS1BAycSCql xdAt2Ado2H1G/QfOA5P9xOSTWWSs4RJ3zWuHKovg646m34jFpRndviGrqhNSYPTEWTIn XjxQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=fijeLYxAajiOMQuAFN30hNSlRkp9xloU3BMCsZB7sQs=; b=AoFWComZRgNxISHc3sbF3j2iGIGnwYXzapLfCmXXpRJqGDnS3p+GAbHeINXXQ9Xxw6 4F6CAN8C3w8xIPf25NRDm7qWoDwJDmxyWlcwtbZHLV7F+MwvGD82o9d52aXcXg3TCGXu FVxdnyz6aocTD4AlClaN/i0b1zIFzf2Ga3N84OWxjgRsyeBZIMNh+NwvO+MbomMupIrG WSD6J2tEJl0Ag9G/1HF+QZbDqqvHMd/ku0QYu6fZuws+mx7NDdoxphHPA4TGAHKj3lJm QKp1xyQ80N2yXZkFTfD8MlDX60CvJZQ3rusHSTW1P700Dfc80y1LVN9atarCrLN6/ycA CyUQ== X-Gm-Message-State: AOAM533juPT/M6QeFiUPdENg3SCsRTfaOQISsyx571wygUgo+WM8zQVV R8F3n6/WRR0FXIFv7cJL8tq3GLVkZek= X-Google-Smtp-Source: ABdhPJxj3egqzWm7tbrbuvj3yiK6bxiYWff6cHMJNcBrzTEyOhoahem5DA/SMIuZlTCQ1nsMo9OKeg== X-Received: by 2002:a63:ff1f:: with SMTP id k31mr1143651pgi.315.1624323694697; Mon, 21 Jun 2021 18:01:34 -0700 (PDT) Received: from han1-mobl3.hsd1.or.comcast.net ([2601:1c0:6a01:d830::512a]) by smtp.gmail.com with ESMTPSA id f28sm17970120pgb.12.2021.06.21.18.01.34 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Mon, 21 Jun 2021 18:01:34 -0700 (PDT) From: Tedd Ho-Jeong An To: linux-bluetooth@vger.kernel.org Subject: [BlueZ PATCH 4/5] emulator/bthost: Create ext adv params before setting adv data Date: Mon, 21 Jun 2021 18:01:30 -0700 Message-Id: <20210622010131.427059-4-hj.tedd.an@gmail.com> X-Mailer: git-send-email 2.26.3 In-Reply-To: <20210622010131.427059-1-hj.tedd.an@gmail.com> References: <20210622010131.427059-1-hj.tedd.an@gmail.com> MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: linux-bluetooth@vger.kernel.org From: Tedd Ho-Jeong An Based on the SPEC 5.2 Vol 4, Part E, Section 7.8.54, the LE_Set_Extended_Advertising_Data_Command may be issued after an advertising set identifed by the Advertising_Handle has been created using the HCI_LE_Set_Extended_Advertising_Parameters command. --- emulator/bthost.c | 26 ++++++++++++++++++++------ emulator/bthost.h | 1 + 2 files changed, 21 insertions(+), 6 deletions(-) diff --git a/emulator/bthost.c b/emulator/bthost.c index 16934d35a..62f5a1bae 100644 --- a/emulator/bthost.c +++ b/emulator/bthost.c @@ -2549,6 +2549,7 @@ void bthost_set_ext_adv_data(struct bthost *bthost, const uint8_t *data, memset(adv_cp, 0, sizeof(*adv_cp)); memset(adv_cp->data, 0, 31); + adv_cp->handle = 1; adv_cp->operation = 0x03; adv_cp->fragment_preference = 0x01; @@ -2572,20 +2573,33 @@ void bthost_set_adv_enable(struct bthost *bthost, uint8_t enable) send_command(bthost, BT_HCI_CMD_LE_SET_ADV_ENABLE, &enable, 1); } -void bthost_set_ext_adv_enable(struct bthost *bthost, uint8_t enable) +void bthost_set_ext_adv_params(struct bthost *bthost) { struct bt_hci_cmd_le_set_ext_adv_params cp; - struct bt_hci_cmd_le_set_ext_adv_enable cp_enable; memset(&cp, 0, sizeof(cp)); + cp.handle = 0x01; cp.evt_properties = cpu_to_le16(0x0013); send_command(bthost, BT_HCI_CMD_LE_SET_EXT_ADV_PARAMS, &cp, sizeof(cp)); +} + +void bthost_set_ext_adv_enable(struct bthost *bthost, uint8_t enable) +{ + struct bt_hci_cmd_le_set_ext_adv_enable *cp_enable; + struct bt_hci_cmd_ext_adv_set *cp_set; + uint8_t cp[6]; + + memset(cp, 0, 6); + + cp_enable = (struct bt_hci_cmd_le_set_ext_adv_enable *)cp; + cp_set = (struct bt_hci_cmd_ext_adv_set *)(cp + sizeof(*cp_enable)); + + cp_enable->enable = enable; + cp_enable->num_of_sets = 1; + cp_set->handle = 1; - memset(&cp_enable, 0, sizeof(cp_enable)); - cp_enable.enable = enable; - send_command(bthost, BT_HCI_CMD_LE_SET_EXT_ADV_ENABLE, &cp_enable, - sizeof(cp_enable)); + send_command(bthost, BT_HCI_CMD_LE_SET_EXT_ADV_ENABLE, cp, 6); } void bthost_write_ssp_mode(struct bthost *bthost, uint8_t mode) diff --git a/emulator/bthost.h b/emulator/bthost.h index 7e5286df3..5a85b7232 100644 --- a/emulator/bthost.h +++ b/emulator/bthost.h @@ -80,6 +80,7 @@ void bthost_set_adv_enable(struct bthost *bthost, uint8_t enable); void bthost_set_ext_adv_data(struct bthost *bthost, const uint8_t *data, uint8_t len); +void bthost_set_ext_adv_params(struct bthost *bthost); void bthost_set_ext_adv_enable(struct bthost *bthost, uint8_t enable); void bthost_write_ssp_mode(struct bthost *bthost, uint8_t mode); From patchwork Tue Jun 22 01:01:31 2021 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Tedd Ho-Jeong An X-Patchwork-Id: 465292 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-10.7 required=3.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID,DKIM_VALID_AU,FREEMAIL_FORGED_FROMDOMAIN,FREEMAIL_FROM, HEADER_FROM_DIFFERENT_DOMAINS, INCLUDES_PATCH, MAILING_LIST_MULTI, SPF_HELO_NONE, SPF_PASS, URIBL_BLOCKED, USER_AGENT_GIT autolearn=ham autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 50B5DC4743C for ; Tue, 22 Jun 2021 01:01:37 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by mail.kernel.org (Postfix) with ESMTP id 3310161350 for ; Tue, 22 Jun 2021 01:01:37 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S230082AbhFVBDv (ORCPT ); Mon, 21 Jun 2021 21:03:51 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:60578 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S229663AbhFVBDu (ORCPT ); Mon, 21 Jun 2021 21:03:50 -0400 Received: from mail-pg1-x532.google.com (mail-pg1-x532.google.com [IPv6:2607:f8b0:4864:20::532]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id DA405C061574 for ; Mon, 21 Jun 2021 18:01:35 -0700 (PDT) Received: by mail-pg1-x532.google.com with SMTP id e22so9518574pgv.10 for ; Mon, 21 Jun 2021 18:01:35 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:subject:date:message-id:in-reply-to:references:mime-version :content-transfer-encoding; bh=uds3L49so16zNtVQwJGRT7zPx25Ama56a91u3XmbS1Y=; b=tzlslYtW+KyeSc+v0r5kC4SXyz0Z5UNVE4yzov2tWs09wK6u5t1btePWhi2j+01AzY tCNMkcjrr15phA8uZmsFypvAzYsNc5ETFPB1ivZg4Q/MVYdZZzTNGDXull3+CvOEveTk eYpAMeK7NK6IH9zrTm0O4dpn5Mperr8MKb9xswxt2tJpnRUPpZe//i0N/yRAoUH602mm jTrLo3zhjqpKldcQRQxfVfOfsSsfrjOweZpfIXWGNGfvJowojUiVKAS9D7KenRfnHjcW U2IZKDW4fyKKB84t4ZQUwOHXcahy1WIBgBf/IPsRTz0mTBVo58wuk/k7JMEKCez9XhLj JHJQ== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:subject:date:message-id:in-reply-to :references:mime-version:content-transfer-encoding; bh=uds3L49so16zNtVQwJGRT7zPx25Ama56a91u3XmbS1Y=; b=hi97uGHGKzIaoN3KNPQuwarMkDPIbHrJHJGxCh3+uBy6r6G77U3vTVyCvmqgtsGd/H wgXT9cvfKlvZaXRiDCefDP/WJHVbj4Y8qiI4hvH33kh26hMZOfCV2QB3752N7o85oKyA Kty6E8PgHrtnWrmadYSY8o5zboeLR+P+wzgaoXQu7vEvWSGLOUhILqe5gIT9AYnGlLlV VBXQl6dtSv3TOsl/tLndU0xYhii5Mb1gU1Qr/qLjRCdtxiE2XVGJRm0E39onzbwcCUkZ Lr+JylaVREPZDiA3e3WlFJHXmdeHC3w6f3gsalFnJReQD75vf+MOm8/64us25eB6Gk87 Y6Rg== X-Gm-Message-State: AOAM532TWrBH6afVqmdcVY3SXPFqqP/CdTAPeTJm1xyWEH3KQIiWsKHR CTQRx+Egp0d95TNmxlBXQiiHzEF0dDc= X-Google-Smtp-Source: ABdhPJz55Yol1PMkeNhPh4rt3v5mwuTAAvENUTe6cjyV1Ar5DkwLTK6GHei3DsR4p66guor7+80rlg== X-Received: by 2002:a05:6a00:1629:b029:2ef:f4de:244f with SMTP id e9-20020a056a001629b02902eff4de244fmr980804pfc.6.1624323695316; Mon, 21 Jun 2021 18:01:35 -0700 (PDT) Received: from han1-mobl3.hsd1.or.comcast.net ([2601:1c0:6a01:d830::512a]) by smtp.gmail.com with ESMTPSA id f28sm17970120pgb.12.2021.06.21.18.01.34 for (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Mon, 21 Jun 2021 18:01:34 -0700 (PDT) From: Tedd Ho-Jeong An To: linux-bluetooth@vger.kernel.org Subject: [BlueZ PATCH 5/5] tools/mgmt-tester: Update to support multiple extended adv instances Date: Mon, 21 Jun 2021 18:01:31 -0700 Message-Id: <20210622010131.427059-5-hj.tedd.an@gmail.com> X-Mailer: git-send-email 2.26.3 In-Reply-To: <20210622010131.427059-1-hj.tedd.an@gmail.com> References: <20210622010131.427059-1-hj.tedd.an@gmail.com> MIME-Version: 1.0 Precedence: bulk List-ID: X-Mailing-List: linux-bluetooth@vger.kernel.org From: Tedd Ho-Jeong An This patch updates to align with the multiple extended advertising support. --- tools/mgmt-tester.c | 11 ++++++----- 1 file changed, 6 insertions(+), 5 deletions(-) diff --git a/tools/mgmt-tester.c b/tools/mgmt-tester.c index 8cae376f4..aacabcbd3 100644 --- a/tools/mgmt-tester.c +++ b/tools/mgmt-tester.c @@ -5871,9 +5871,10 @@ static void setup_bthost(void) if (data->hciemu_type == HCIEMU_TYPE_LE || test->client_enable_adv) { - if (data->hciemu_type >= HCIEMU_TYPE_BREDRLE50) + if (data->hciemu_type >= HCIEMU_TYPE_BREDRLE50) { + bthost_set_ext_adv_params(bthost); bthost_set_ext_adv_enable(bthost, 0x01); - else + } else bthost_set_adv_enable(bthost, 0x01); } else bthost_write_scan_enable(bthost, 0x03); @@ -7554,7 +7555,7 @@ static const uint8_t read_adv_features_rsp_3[] = { 0xff, 0xff, 0x01, 0x00, /* supported flags */ 0x1f, /* max_adv_data_len */ 0x1f, /* max_scan_rsp_len */ - 0x01, /* max_instances */ + 0x03, /* max_instances */ 0x00, /* num_instances */ }; @@ -8120,7 +8121,7 @@ static const struct generic_data remove_ext_advertising_success_2 = { }; static const uint8_t set_ext_adv_data_test2[] = { - 0x01, /* handle */ + 0x02, /* handle */ 0x03, /* complete data */ 0x01, /* controller should not fragment */ 0x07, /* adv data len */ @@ -9654,6 +9655,7 @@ static void trigger_device_found(void *user_data) bthost_set_adv_enable(bthost, 0x01); } else if (data->hciemu_type >= HCIEMU_TYPE_BREDRLE50) { + bthost_set_ext_adv_params(bthost); if (test->set_adv) bthost_set_ext_adv_data(bthost, test->adv_data, test->adv_data_len); @@ -11067,7 +11069,6 @@ int main(int argc, char *argv[]) &add_advertising_name_data_appear, setup_command_generic, test_command_generic); - test_le_full("Adv. connectable & connected (slave) - Success", &conn_slave_adv_conneactable_test, setup_advertise_while_connected,