Received: by 2002:a25:683:0:0:0:0:0 with SMTP id 125csp641565ybg; Wed, 10 Jun 2020 09:48:43 -0700 (PDT) X-Google-Smtp-Source: ABdhPJynQRvSncFZ0h98mvofhz6kALuXn+p3PU7QQ63viaSpIEXwckNIzazezKGtjEvtsVe93gqX X-Received: by 2002:a17:906:4989:: with SMTP id p9mr4413590eju.417.1591807723512; Wed, 10 Jun 2020 09:48:43 -0700 (PDT) ARC-Seal: i=1; a=rsa-sha256; t=1591807723; cv=none; d=google.com; s=arc-20160816; b=s3crWLYD4W3BfJqHtoweZ4Odrkjor0U6x0Inc12OJac9huxClSAWARUAagXNLHF3yG ZV7fD5DH/WKGgjj3kI43nOUIzqBq4FCi4BmWoafacIVATf1Gm1nPlNmadR3XoUczJvbd bhf/P3OYQfHkPnhrmYczEZozQ/hAyq6479tJ0XdcNZDXCavh5ePkL2EeF4e+jCnv0nKV sZI6Iw5CVPNF8Lad8uvxO1Zrc/Y7KhjmnzW9ke398HHCA5e/XR6W2U2rT4TZz6HrKeyP PehdlJGat9n9BTLAEgJPXuwDnxTpoKRrr8f+B6ykvuUTFXu43/W0xDUSNEXFVTmR8axA 2MPw== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:sender:content-transfer-encoding:mime-version :message-id:date:subject:cc:to:from:dkim-signature; bh=oozrSzwL03UXgH/RApYDk/nUGJiPMkdvmhvFbjzYHeM=; b=vup/84FuHrap0xdlpJpheEI8RWpFZK9JjHlKiRgJkBWp2ka5v4atzKUuaisj8fHTtc tsQsa2uGx0T8LB/Bnp+SGixe2rbqnxCcj5gG/DNSaY71kiV9FCrnYwGRI5imV+2wgL5R y8s1/6veCG89jPORHHU39xlkK2kEHZH0fk5Tmg0H2ae99LVxzaFKPiI8p76QXKs29ADn fEHDR5VhHn1lWEgOycfIJfdU4uMsutnMikoBuRsyEYLPhoeI9NBstoBgsofYLDAjxA6Q I4upAuK6suJQhXBBrPfU/UfdYwFeqAmkHPV80/gLy3EUz6LEJepptlHN4T8YeMX/ItFv 6VKw== ARC-Authentication-Results: i=1; mx.google.com; dkim=pass header.i=@chromium.org header.s=google header.b=dRUMyUTe; spf=pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-bluetooth-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=chromium.org Return-Path: Received: from vger.kernel.org (vger.kernel.org. [23.128.96.18]) by mx.google.com with ESMTP id q24si111119eds.133.2020.06.10.09.48.18; Wed, 10 Jun 2020 09:48:43 -0700 (PDT) Received-SPF: pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) client-ip=23.128.96.18; Authentication-Results: mx.google.com; dkim=pass header.i=@chromium.org header.s=google header.b=dRUMyUTe; spf=pass (google.com: domain of linux-bluetooth-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=linux-bluetooth-owner@vger.kernel.org; dmarc=pass (p=NONE sp=NONE dis=NONE) header.from=chromium.org Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1729870AbgFJOba (ORCPT + 99 others); Wed, 10 Jun 2020 10:31:30 -0400 Received: from lindbergh.monkeyblade.net ([23.128.96.19]:35754 "EHLO lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1729869AbgFJOb3 (ORCPT ); Wed, 10 Jun 2020 10:31:29 -0400 Received: from mail-ua1-x944.google.com (mail-ua1-x944.google.com [IPv6:2607:f8b0:4864:20::944]) by lindbergh.monkeyblade.net (Postfix) with ESMTPS id B83F9C03E96B for ; Wed, 10 Jun 2020 07:31:28 -0700 (PDT) Received: by mail-ua1-x944.google.com with SMTP id 59so913376uam.7 for ; Wed, 10 Jun 2020 07:31:28 -0700 (PDT) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=chromium.org; s=google; h=from:to:cc:subject:date:message-id:mime-version :content-transfer-encoding; bh=oozrSzwL03UXgH/RApYDk/nUGJiPMkdvmhvFbjzYHeM=; b=dRUMyUTe3THBoDfg7DYeolkQuDFDHPsFqjpwcE6M0fnXdiH4+A98GbUwiDI30Qzy80 EOyNuc2KfndE66vVk0bb4JcR+pScN2RykOmmq0WRM9h0aWpZXKr0NTMv4G9IlqHSuE63 8dsXF89l7zucn9SX0gaEokja/jIYamM0W92+s= X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:mime-version :content-transfer-encoding; bh=oozrSzwL03UXgH/RApYDk/nUGJiPMkdvmhvFbjzYHeM=; b=hk/5bgJGexK9TROGoRNIg1TfK9E+AsMUtPJ+rcMDEdgKms/JuYVAxBB9xkN3waurmT 6HGN8KxMo/ITjic+hydhGl7p8DWZOFH4MGwQdkzsRs6PyiHjTaRw+IofNtCJTgU1MIPp XKuhC27vRcsF1Aok+1QQ/wzSyQmwvFwGX7C4Ziqp7BAzc+71EaJFrbbJ+fQTXn3OXUyU Lt/LCGKXg88Tk7K5wAv3GUjYeboiDjF1bOVs4Lyg1JSlK8BWIR33mEo2Dg/Sd/0OkBNq W5YIQgutyeZHKOh91Bc7WQIVnjzWbrKIaqD+L/GvW0VY+U2KgT1nDSHLCpKao9AiNDoP 2d6A== X-Gm-Message-State: AOAM532aL1rANpqs3Zvv4CMeBT5vBLyOzmUxVqjLaYuLbTAJ7N+cAWMY btdeFVRbumxSpaZcaG8PRcbLtbG90YM= X-Received: by 2002:a9f:37e1:: with SMTP id q88mr2396230uaq.125.1591799486072; Wed, 10 Jun 2020 07:31:26 -0700 (PDT) Received: from alain.c.googlers.com.com (252.177.243.35.bc.googleusercontent.com. [35.243.177.252]) by smtp.gmail.com with ESMTPSA id s126sm1112636vkh.6.2020.06.10.07.31.24 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Wed, 10 Jun 2020 07:31:25 -0700 (PDT) From: Alain Michaud To: linux-bluetooth@vger.kernel.org Cc: Alain Michaud Subject: [PATCH v4] sco:Add support for BT_PKT_STATUS CMSG data Date: Wed, 10 Jun 2020 14:31:22 +0000 Message-Id: <20200610143122.15453-1-alainm@chromium.org> X-Mailer: git-send-email 2.27.0.290.gba653c62da-goog MIME-Version: 1.0 Content-Transfer-Encoding: 8bit Sender: linux-bluetooth-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-bluetooth@vger.kernel.org This change adds support for reporting the BT_PKT_STATUS to the socket CMSG data to allow the implementation of a packet loss correction on erronous data received on the SCO socket. The patch was partially developed by Marcel Holtmann and validated by Hsin-yu Chao Signed-off-by: Alain Michaud --- Changes in v4: - Addressing feedback from Marcel include/net/bluetooth/bluetooth.h | 11 ++++++++++ net/bluetooth/af_bluetooth.c | 3 +++ net/bluetooth/hci_core.c | 1 + net/bluetooth/sco.c | 34 +++++++++++++++++++++++++++++++ 4 files changed, 49 insertions(+) diff --git a/include/net/bluetooth/bluetooth.h b/include/net/bluetooth/bluetooth.h index 3fa7b1e3c5d9..ff7258200efb 100644 --- a/include/net/bluetooth/bluetooth.h +++ b/include/net/bluetooth/bluetooth.h @@ -147,6 +147,11 @@ struct bt_voice { #define BT_MODE_LE_FLOWCTL 0x03 #define BT_MODE_EXT_FLOWCTL 0x04 +#define BT_PKT_STATUS 16 + +/* CMSG flags */ +#define BT_CMSG_PKT_STATUS 0x0003 + __printf(1, 2) void bt_info(const char *fmt, ...); __printf(1, 2) @@ -275,6 +280,7 @@ struct bt_sock { struct sock *parent; unsigned long flags; void (*skb_msg_name)(struct sk_buff *, void *, int *); + void (*skb_put_cmsg)(struct sk_buff *, struct msghdr *, struct sock *); }; enum { @@ -324,6 +330,10 @@ struct l2cap_ctrl { struct l2cap_chan *chan; }; +struct sco_ctrl { + u8 pkt_status; +}; + struct hci_dev; typedef void (*hci_req_complete_t)(struct hci_dev *hdev, u8 status, u16 opcode); @@ -350,6 +360,7 @@ struct bt_skb_cb { u8 incoming:1; union { struct l2cap_ctrl l2cap; + struct sco_ctrl sco; struct hci_ctrl hci; }; }; diff --git a/net/bluetooth/af_bluetooth.c b/net/bluetooth/af_bluetooth.c index 3fd124927d4d..d0abea8d08cc 100644 --- a/net/bluetooth/af_bluetooth.c +++ b/net/bluetooth/af_bluetooth.c @@ -286,6 +286,9 @@ int bt_sock_recvmsg(struct socket *sock, struct msghdr *msg, size_t len, if (msg->msg_name && bt_sk(sk)->skb_msg_name) bt_sk(sk)->skb_msg_name(skb, msg->msg_name, &msg->msg_namelen); + + if (bt_sk(sk)->skb_put_cmsg) + bt_sk(sk)->skb_put_cmsg(skb, msg, sk); } skb_free_datagram(sk, skb); diff --git a/net/bluetooth/hci_core.c b/net/bluetooth/hci_core.c index 51d399273276..7b5e46198d99 100644 --- a/net/bluetooth/hci_core.c +++ b/net/bluetooth/hci_core.c @@ -4549,6 +4549,7 @@ static void hci_scodata_packet(struct hci_dev *hdev, struct sk_buff *skb) if (conn) { /* Send to upper protocol */ + bt_cb(skb)->sco.pkt_status = flags & 0x03; sco_recv_scodata(conn, skb); return; } else { diff --git a/net/bluetooth/sco.c b/net/bluetooth/sco.c index c8c3d38cdc7b..abcefa00ae11 100644 --- a/net/bluetooth/sco.c +++ b/net/bluetooth/sco.c @@ -66,6 +66,7 @@ struct sco_pinfo { bdaddr_t dst; __u32 flags; __u16 setting; + unsigned long cmsg_mask; struct sco_conn *conn; }; @@ -449,6 +450,15 @@ static void sco_sock_close(struct sock *sk) sco_sock_kill(sk); } +static void sco_skb_put_cmsg(struct sk_buff *skb, struct msghdr *msg, + struct sock *sk) +{ + if (test_bit(BT_CMSG_PKT_STATUS, &sco_pi(sk)->cmsg_mask)) + put_cmsg(msg, SOL_BLUETOOTH, BT_CMSG_PKT_STATUS, + sizeof(bt_cb(skb)->sco.pkt_status), + &bt_cb(skb)->sco.pkt_status); +} + static void sco_sock_init(struct sock *sk, struct sock *parent) { BT_DBG("sk %p", sk); @@ -457,6 +467,8 @@ static void sco_sock_init(struct sock *sk, struct sock *parent) sk->sk_type = parent->sk_type; bt_sk(sk)->flags = bt_sk(parent)->flags; security_sk_clone(parent, sk); + } else { + bt_sk(sk)->skb_put_cmsg = sco_skb_put_cmsg; } } @@ -797,6 +809,7 @@ static int sco_sock_setsockopt(struct socket *sock, int level, int optname, int len, err = 0; struct bt_voice voice; u32 opt; + int pkt_status; BT_DBG("sk %p", sk); @@ -846,6 +859,18 @@ static int sco_sock_setsockopt(struct socket *sock, int level, int optname, sco_pi(sk)->setting = voice.setting; break; + case BT_PKT_STATUS: + if (get_user(pkt_status, (int __user *)optval)) { + err = -EFAULT; + break; + } + + if (pkt_status) + set_bit(BT_CMSG_PKT_STATUS, &sco_pi(sk)->cmsg_mask); + else + clear_bit(BT_CMSG_PKT_STATUS, &sco_pi(sk)->cmsg_mask); + break; + default: err = -ENOPROTOOPT; break; @@ -923,6 +948,7 @@ static int sco_sock_getsockopt(struct socket *sock, int level, int optname, int len, err = 0; struct bt_voice voice; u32 phys; + int pkt_status; BT_DBG("sk %p", sk); @@ -969,6 +995,14 @@ static int sco_sock_getsockopt(struct socket *sock, int level, int optname, err = -EFAULT; break; + case BT_PKT_STATUS: + pkt_status = test_bit(BT_CMSG_PKT_STATUS, + &(sco_pi(sk)->cmsg_mask)); + + if (put_user(pkt_status, (int __user *)optval)) + err = -EFAULT; + break; + default: err = -ENOPROTOOPT; break; -- 2.27.0.290.gba653c62da-goog