Hi Andrei,
* Emeltchenko Andrei <Andrei.Emeltchenko.news@xxxxxxxxx> [2011-08-18 10:45:01 +0300]:
> 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)
Please provide more details in your commit message.
> ---
> 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;
If this patches only adds supports for Best Effort why should care about the
others services types now like the code you added above. Why is the if
(local_service == L2CAP_SERVTYPE_BESTEFFORT) needed then?
Gustavo
--
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
