From: Luiz Augusto von Dentz <luiz.dentz@gmail.com>
To: linux-bluetooth@vger.kernel.org
Subject: [PATCH v3 4/6] emulator/bthost: Add support for ECRED Connection request/response
Date: Wed, 18 Mar 2020 14:51:22 -0700 [thread overview]
Message-ID: <20200318215124.21880-4-luiz.dentz@gmail.com> (raw)
In-Reply-To: <20200318215124.21880-1-luiz.dentz@gmail.com>
From: Luiz Augusto von Dentz <luiz.von.dentz@intel.com>
This adds support for ECRED Connection request/response which will be
used by l2cap-runner to test L2CAP_MODE_EXT_FLOWCTL mode.
---
emulator/bthost.c | 72 +++++++++++++++++++++++++++++++++++++++++++++++
1 file changed, 72 insertions(+)
diff --git a/emulator/bthost.c b/emulator/bthost.c
index 6482bbecc..0fa283464 100644
--- a/emulator/bthost.c
+++ b/emulator/bthost.c
@@ -1773,6 +1773,69 @@ static bool l2cap_le_conn_rsp(struct bthost *bthost, struct btconn *conn,
return true;
}
+static bool l2cap_ecred_conn_req(struct bthost *bthost, struct btconn *conn,
+ uint8_t ident, const void *data, uint16_t len)
+{
+ const struct bt_l2cap_pdu_ecred_conn_req *req = data;
+ struct {
+ struct bt_l2cap_pdu_ecred_conn_rsp pdu;
+ uint16_t dcid[5];
+ } __attribute__ ((packed)) rsp;
+ uint16_t psm;
+ int num_scid, i = 0;
+
+ if (len < sizeof(*req))
+ return false;
+
+ psm = le16_to_cpu(req->psm);
+
+ memset(&rsp, 0, sizeof(rsp));
+
+ rsp.pdu.mtu = 64;
+ rsp.pdu.mps = 64;
+ rsp.pdu.credits = 1;
+
+ if (!bthost_find_l2cap_cb_by_psm(bthost, psm)) {
+ rsp.pdu.result = cpu_to_le16(0x0002); /* PSM Not Supported */
+ goto respond;
+ }
+
+ len -= sizeof(rsp.pdu);
+ num_scid = len / sizeof(*req->scid);
+
+ for (; i < num_scid; i++)
+ rsp.dcid[i] = cpu_to_le16(conn->next_cid++);
+
+respond:
+ l2cap_sig_send(bthost, conn, BT_L2CAP_PDU_ECRED_CONN_RSP, ident, &rsp,
+ sizeof(rsp.pdu) + i * sizeof(*rsp.dcid));
+
+ return true;
+}
+
+static bool l2cap_ecred_conn_rsp(struct bthost *bthost, struct btconn *conn,
+ uint8_t ident, const void *data, uint16_t len)
+{
+ const struct {
+ const struct bt_l2cap_pdu_ecred_conn_rsp *pdu;
+ uint16_t scid[5];
+ } __attribute__ ((packed)) *rsp = data;
+ int num_scid, i;
+
+ if (len < sizeof(*rsp))
+ return false;
+
+ num_scid = len / sizeof(*rsp->scid);
+
+ for (i = 0; i < num_scid; i++)
+ /* TODO add L2CAP connection before with proper PSM */
+ bthost_add_l2cap_conn(bthost, conn, 0,
+ le16_to_cpu(rsp->scid[i]), 0);
+
+
+ return true;
+}
+
static void l2cap_le_sig(struct bthost *bthost, struct btconn *conn,
const void *data, uint16_t len)
{
@@ -1819,6 +1882,15 @@ static void l2cap_le_sig(struct bthost *bthost, struct btconn *conn,
ret = l2cap_le_conn_rsp(bthost, conn, hdr->ident,
data + sizeof(*hdr), hdr_len);
break;
+ case BT_L2CAP_PDU_ECRED_CONN_REQ:
+ ret = l2cap_ecred_conn_req(bthost, conn, hdr->ident,
+ data + sizeof(*hdr), hdr_len);
+ break;
+
+ case BT_L2CAP_PDU_ECRED_CONN_RSP:
+ ret = l2cap_ecred_conn_rsp(bthost, conn, hdr->ident,
+ data + sizeof(*hdr), hdr_len);
+ break;
default:
printf("Unknown L2CAP code 0x%02x\n", hdr->code);
--
2.21.1
next prev parent reply other threads:[~2020-03-18 21:51 UTC|newest]
Thread overview: 6+ messages / expand[flat|nested] mbox.gz Atom feed top
2020-03-18 21:51 [PATCH v3 1/6] lib: Add definitions for Enhanced Credits Based Mode Luiz Augusto von Dentz
2020-03-18 21:51 ` [PATCH v3 2/6] btio: Add mode to for Enhanced Credit Mode Luiz Augusto von Dentz
2020-03-18 21:51 ` [PATCH v3 3/6] l2test: Add support for BT_MODE_EXT_FLOWCTL Luiz Augusto von Dentz
2020-03-18 21:51 ` Luiz Augusto von Dentz [this message]
2020-03-18 21:51 ` [PATCH v3 5/6] tools/l2cap-tester: Add test for Ext-Flowctl mode Luiz Augusto von Dentz
2020-03-18 21:51 ` [PATCH v3 6/6] gatt: Enable connecting to EATT channel using " Luiz Augusto von Dentz
Reply instructions:
You may reply publicly to this message via plain-text email
using any one of the following methods:
* Save the following mbox file, import it into your mail client,
and reply-to-all from there: mbox
Avoid top-posting and favor interleaved quoting:
https://en.wikipedia.org/wiki/Posting_style#Interleaved_style
* Reply using the --to, --cc, and --in-reply-to
switches of git-send-email(1):
git send-email \
--in-reply-to=20200318215124.21880-4-luiz.dentz@gmail.com \
--to=luiz.dentz@gmail.com \
--cc=linux-bluetooth@vger.kernel.org \
/path/to/YOUR_REPLY
https://kernel.org/pub/software/scm/git/docs/git-send-email.html
* If your mail client supports setting the In-Reply-To header
via mailto: links, try the mailto: link
Be sure your reply has a Subject: header at the top and a blank line
before the message body.
This is a public inbox, see mirroring instructions
for how to clone and mirror all data and code used for this inbox;
as well as URLs for NNTP newsgroup(s).