From: Andrei Emeltchenko <andrei.emeltchenko@xxxxxxxxx>
Adds extended flowspec option when building l2cap config request
Based upon haijun.liu <haijun.liu@xxxxxxxxxxx> series of patches
(sent Sun, 22 Aug 2010)
---
include/net/bluetooth/l2cap.h | 2 +
net/bluetooth/l2cap_core.c | 79 ++++++++++++++++++++++++++++++++++++++++-
2 files changed, 80 insertions(+), 1 deletions(-)
diff --git a/include/net/bluetooth/l2cap.h b/include/net/bluetooth/l2cap.h
index d2154e0..2350057 100644
--- a/include/net/bluetooth/l2cap.h
+++ b/include/net/bluetooth/l2cap.h
@@ -446,6 +446,8 @@ struct l2cap_conn {
__u32 rx_len;
__u8 tx_ident;
+ __u8 flowspec_ident;
+
__u8 disc_reason;
__u8 preq[7]; /* SMP Pairing Request */
diff --git a/net/bluetooth/l2cap_core.c b/net/bluetooth/l2cap_core.c
index f64c9cb..f3663ac 100644
--- a/net/bluetooth/l2cap_core.c
+++ b/net/bluetooth/l2cap_core.c
@@ -541,6 +541,26 @@ static u8 l2cap_get_ident(struct l2cap_conn *conn)
return id;
}
+static inline u8 l2cap_flowspec_ident(struct l2cap_conn *conn)
+{
+ u8 id;
+
+ /* Get next available ident for the flow spec of guaranteed channel.
+ * 2 - 255 are used.
+ */
+
+ spin_lock_bh(&conn->lock);
+
+ if (++conn->flowspec_ident > 256)
+ conn->flowspec_ident = 2;
+
+ id = conn->flowspec_ident;
+
+ spin_unlock_bh(&conn->lock);
+
+ return id;
+}
+
static void l2cap_send_cmd(struct l2cap_conn *conn, u8 ident, u8 code, u16 len, void *data)
{
struct sk_buff *skb = l2cap_build_cmd(conn, code, ident, len, data);
@@ -1900,6 +1920,7 @@ static int l2cap_build_conf_req(struct l2cap_chan *chan, void *data)
{
struct l2cap_conf_req *req = data;
struct l2cap_conf_rfc rfc = { .mode = chan->mode };
+ struct l2cap_conf_efs efs = { .service_type = L2CAP_SERVTYPE_BESTEFFORT };
void *ptr = req->data;
BT_DBG("chan %p", chan);
@@ -1913,7 +1934,20 @@ static int l2cap_build_conf_req(struct l2cap_chan *chan, void *data)
if (test_bit(CONF_STATE2_DEVICE, &chan->conf_state))
break;
- /* fall through */
+ if (__l2cap_efs_supported(chan)) {
+ chan->ext_flowspec_enable = 1;
+
+ chan->local_stype = L2CAP_SERVTYPE_BESTEFFORT;
+ chan->local_msdu = L2CAP_DEFAULT_MAX_SDU_SIZE;
+ chan->local_sdu_itime = L2CAP_DEFAULT_SDU_ARRIVAL_TIME;
+ chan->local_acc_lat = L2CAP_DEFAULT_ACCESS_LATENCY;
+ chan->local_flush_to = L2CAP_DEFAULT_FLUSH_TO;
+ }
+
+ if (!l2cap_mode_supported(chan->mode, chan->conn->feat_mask))
+ l2cap_send_disconn_req(chan->conn, chan, ECONNRESET);
+ break;
+
default:
chan->mode = l2cap_select_mode(rfc.mode, chan->conn->feat_mask);
break;
@@ -1961,6 +1995,34 @@ done:
chan->fcs = L2CAP_FCS_NONE;
l2cap_add_conf_opt(&ptr, L2CAP_CONF_FCS, 1, chan->fcs);
}
+
+ if (chan->ext_flowspec_enable) {
+ efs.service_type = chan->local_stype;
+ efs.max_sdu_size = cpu_to_le16(chan->local_msdu);
+ efs.sdu_inter_time = cpu_to_le32(chan->local_sdu_itime);
+
+ if (chan->local_stype == L2CAP_SERVTYPE_BESTEFFORT) {
+ chan->local_id = 1;
+ efs.id = chan->local_id;
+ efs.access_latency =
+ cpu_to_le32(L2CAP_DEFAULT_ACCESS_LATENCY);
+ efs.flush_timeout =
+ cpu_to_le32(L2CAP_DEFAULT_FLUSH_TO);
+ } else {
+ /* As spec, the ident shall be unique within
+ the scope of a physical link.
+ */
+ chan->local_id = l2cap_flowspec_ident(chan->conn);
+ efs.id = chan->local_id;
+ efs.access_latency =
+ cpu_to_le32(chan->local_acc_lat);
+ efs.flush_timeout =
+ cpu_to_le32(chan->local_flush_to);
+ }
+ l2cap_add_conf_opt(&ptr, L2CAP_CONF_EFS,
+ sizeof(efs), (unsigned long) &efs);
+ }
+
break;
case L2CAP_MODE_STREAMING:
@@ -1984,6 +2046,21 @@ done:
chan->fcs = L2CAP_FCS_NONE;
l2cap_add_conf_opt(&ptr, L2CAP_CONF_FCS, 1, chan->fcs);
}
+
+ if (chan->ext_flowspec_enable) {
+ efs.id = 1;
+ efs.service_type = L2CAP_SERVTYPE_BESTEFFORT;
+ efs.max_sdu_size =
+ cpu_to_le16(chan->local_msdu);
+ efs.sdu_inter_time =
+ cpu_to_le32(chan->local_sdu_itime);
+ efs.access_latency = 0;
+ efs.flush_timeout = 0;
+
+ l2cap_add_conf_opt(&ptr, L2CAP_CONF_EFS,
+ sizeof(efs), (unsigned long) &efs);
+ }
+
break;
}
--
1.7.4.1
--
To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
