Bluetooth: tester: Add command to send connectionless data

Add command `BTP_L2CAP_CONNLESS_SEND` to send connectionless data with
specific PSM.

Signed-off-by: Lyle Zhu <[email protected]>

Author: lylezhu2012

tests/bluetooth/tester/src/btp/btp_l2cap.h

@@ -148,6 +148,15 @@ struct btp_l2cap_listen_v2_cmd {
 	uint32_t options;
 } __packed;
 
+#define BTP_L2CAP_CONNLESS_SEND				0x0d
+struct btp_l2cap_connless_send_cmd {
+	bt_addr_le_t address;
+	uint16_t psm;
+	uint32_t options;
+	uint16_t data_length;
+	uint8_t data[];
+} __packed;
+
 /* events */
 #define BTP_L2CAP_EV_CONNECTION_REQ			0x80
 struct btp_l2cap_connection_req_ev {

tests/bluetooth/tester/src/btp_l2cap.c

@@ -1253,6 +1253,51 @@ static uint8_t send_echo_req(const void *cmd, uint16_t cmd_len, void *rsp, uint1
 }
 #endif /* CONFIG_BT_CLASSIC */
 
+#if defined(CONFIG_BT_L2CAP_CONNLESS)
+static uint8_t connless_send(const void *cmd, uint16_t cmd_len, void *rsp, uint16_t *rsp_len)
+{
+	const struct btp_l2cap_connless_send_cmd *cp = cmd;
+	struct bt_conn *conn;
+	struct net_buf *buf;
+	uint16_t psm;
+	uint16_t data_len;
+	int err;
+
+	if (cp->address.type != BTP_BR_ADDRESS_TYPE) {
+		LOG_ERR("Only support Classic");
+		return BTP_STATUS_FAILED;
+	}
+
+	conn = bt_conn_lookup_addr_br(&cp->address.a);
+	if (!conn) {
+		LOG_ERR("Unknown connection");
+		return BTP_STATUS_FAILED;
+	}
+
+	psm = sys_le16_to_cpu(cp->psm);
+	data_len = sys_le16_to_cpu(cp->data_length);
+
+	if (data_len > DATA_MTU) {
+		LOG_ERR("Data length exceeds MAX buffer len (%u > %u)", data_len, DATA_MTU);
+		return BTP_STATUS_FAILED;
+	}
+
+	buf = net_buf_alloc(&data_pool, K_FOREVER);
+	net_buf_reserve(buf, BT_L2CAP_CONNLESS_RESERVE);
+	net_buf_add_mem(buf, cp->data, data_len);
+
+	err = bt_l2cap_br_connless_send(conn, psm, buf);
+	bt_conn_unref(conn);
+	if (err < 0) {
+		LOG_ERR("Unable to send CLS data: %d", -err);
+		net_buf_unref(buf);
+		return BTP_STATUS_FAILED;
+	}
+
+	return BTP_STATUS_SUCCESS;
+}
+#endif /* CONFIG_BT_L2CAP_CONNLESS */
+
 static uint8_t supported_commands(const void *cmd, uint16_t cmd_len,
 				  void *rsp, uint16_t *rsp_len)
 {
@@ -1325,6 +1370,13 @@ static const struct btp_handler handlers[] = {
 		.func = send_echo_req,
 	},
 #endif /* CONFIG_BT_CLASSIC */
+#if defined(CONFIG_BT_L2CAP_CONNLESS)
+	{
+		.opcode = BTP_L2CAP_CONNLESS_SEND,
+		.expect_len = BTP_HANDLER_LENGTH_VARIABLE,
+		.func = connless_send,
+	},
+#endif /* CONFIG_BT_L2CAP_CONNLESS*/
 };
 
 #if defined(CONFIG_BT_CLASSIC)