* Emeltchenko Andrei <Andrei.Emeltchenko.news@xxxxxxxxx> [2011-09-07 17:05:10 +0300]:
> From: Andrei Emeltchenko <andrei.emeltchenko@xxxxxxxxx>
>
> Adds support for EWS option. Code partly based on Qualcomm and Atheros
> patches sent upstream a year ago.
>
> Signed-off-by: Andrei Emeltchenko <andrei.emeltchenko@xxxxxxxxx>
> ---
> include/net/bluetooth/l2cap.h | 11 +++++--
> net/bluetooth/l2cap_core.c | 62 +++++++++++++++++++++++++++++++++++++++--
> net/bluetooth/l2cap_sock.c | 10 +++---
> 3 files changed, 72 insertions(+), 11 deletions(-)
>
> diff --git a/include/net/bluetooth/l2cap.h b/include/net/bluetooth/l2cap.h
> index 1f26a39..92eac16 100644
> --- a/include/net/bluetooth/l2cap.h
> +++ b/include/net/bluetooth/l2cap.h
> @@ -31,7 +31,7 @@
> #define L2CAP_DEFAULT_MTU 672
> #define L2CAP_DEFAULT_MIN_MTU 48
> #define L2CAP_DEFAULT_FLUSH_TO 0xffff
> -#define L2CAP_DEFAULT_TX_WINDOW 63
> +#define L2CAP_DEFAULT_MAX_TX_WINDOW 63
> #define L2CAP_DEFAULT_MAX_TX 3
> #define L2CAP_DEFAULT_RETRANS_TO 2000 /* 2 seconds */
> #define L2CAP_DEFAULT_MONITOR_TO 12000 /* 12 seconds */
> @@ -42,6 +42,8 @@
> #define L2CAP_DEFAULT_SDU_ARRIVAL_TIME 0xFFFFFFFF
> #define L2CAP_DEFAULT_ACCESS_LATENCY 0xFFFFFFFF
>
> +#define L2CAP_DEFAULT_MAX_EXT_WINDOW 0x3FFF
> +
> #define L2CAP_CONN_TIMEOUT (40000) /* 40 seconds */
> #define L2CAP_INFO_TIMEOUT (4000) /* 4 seconds */
>
> @@ -240,6 +242,7 @@ struct l2cap_conf_opt {
> #define L2CAP_CONF_RFC 0x04
> #define L2CAP_CONF_FCS 0x05
> #define L2CAP_CONF_EFS 0x06
> +#define L2CAP_CONF_EWS 0x07
>
> #define L2CAP_CONF_MAX_SIZE 22
>
> @@ -357,7 +360,7 @@ struct l2cap_chan {
>
> __u8 fcs;
>
> - __u8 tx_win;
> + __u16 tx_win;
> __u8 max_tx;
> __u16 retrans_timeout;
> __u16 monitor_timeout;
> @@ -381,7 +384,7 @@ struct l2cap_chan {
> struct sk_buff *sdu;
> struct sk_buff *sdu_last_frag;
>
> - __u8 remote_tx_win;
> + __u16 remote_tx_win;
> __u8 remote_max_tx;
> __u16 remote_mps;
>
> @@ -488,6 +491,7 @@ enum {
> CONF_STATE2_DEVICE,
> CONF_LOCAL_PEND,
> CONF_REMOTE_PEND,
> + CONF_EWS_RECV,
> };
>
> #define L2CAP_CONF_MAX_CONF_REQ 2
> @@ -508,6 +512,7 @@ enum {
> /* Definitions for flags in l2cap_chan */
> enum {
> FLAG_EFS_ENABLE,
> + FLAG_EXT_CTRL,
> };
>
> #define __set_chan_timer(c, t) l2cap_set_timer(c, &c->chan_timer, (t))
> diff --git a/net/bluetooth/l2cap_core.c b/net/bluetooth/l2cap_core.c
> index e0958de..81b8d02 100644
> --- a/net/bluetooth/l2cap_core.c
> +++ b/net/bluetooth/l2cap_core.c
> @@ -58,6 +58,7 @@
>
> int disable_ertm;
> int disable_flowspec = 1;
> +int disable_extwindow = 1;
>
> static u32 l2cap_feat_mask = L2CAP_FEAT_FIXED_CHAN;
> static u8 l2cap_fixed_chan[8] = { 0x02, };
> @@ -1909,6 +1910,28 @@ static inline bool __l2cap_efs_supported(struct l2cap_chan *chan)
> chan->conn->feat_mask & L2CAP_FEAT_EXT_FLOW;
> }
>
> +static inline bool __l2cap_ews_supported(struct l2cap_chan *chan)
> +{
> + return !disable_extwindow &&
> + chan->conn->feat_mask & L2CAP_FEAT_EXT_WINDOW;
> +}
> +
> +static inline void l2cap_txwin_setup(struct l2cap_chan *chan)
> +{
> + if (chan->tx_win > L2CAP_DEFAULT_MAX_TX_WINDOW &&
> + __l2cap_ews_supported(chan)) {
> + /* use extended control field */
> + set_bit(FLAG_EXT_CTRL, &chan->flags);
> + if (chan->tx_win > L2CAP_DEFAULT_MAX_EXT_WINDOW)
> + chan->tx_win = L2CAP_DEFAULT_MAX_EXT_WINDOW;
This check is already done on setsockopt.
> + } else {
> + if (chan->tx_win > L2CAP_DEFAULT_MAX_TX_WINDOW)
> + chan->tx_win = L2CAP_DEFAULT_MAX_TX_WINDOW;
> +
> + clear_bit(FLAG_EXT_CTRL, &chan->flags);
The flag is already cleared at this point.
> + }
> +}
> +
> static int l2cap_build_conf_req(struct l2cap_chan *chan, void *data)
> {
> struct l2cap_conf_req *req = data;
> @@ -1960,7 +1983,6 @@ done:
>
> case L2CAP_MODE_ERTM:
> rfc.mode = L2CAP_MODE_ERTM;
> - rfc.txwin_size = chan->tx_win;
> rfc.max_transmit = chan->max_tx;
> rfc.retrans_timeout = 0;
> rfc.monitor_timeout = 0;
> @@ -1968,6 +1990,10 @@ done:
> if (L2CAP_DEFAULT_MAX_PDU_SIZE > chan->conn->mtu - 10)
> rfc.max_pdu_size = cpu_to_le16(chan->conn->mtu - 10);
>
> + l2cap_txwin_setup(chan);
> + rfc.txwin_size = chan->tx_win > L2CAP_DEFAULT_MAX_TX_WINDOW ?
> + L2CAP_DEFAULT_MAX_TX_WINDOW : chan->tx_win;
And this check is inside l2cap_txwin_setup()
> +
> l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC, sizeof(rfc),
> (unsigned long) &rfc);
>
> @@ -1999,6 +2025,10 @@ done:
> l2cap_add_conf_opt(&ptr, L2CAP_CONF_FCS, 1, chan->fcs);
> }
>
> + if (__l2cap_ews_supported(chan) &&
> + test_bit(FLAG_EXT_CTRL, &chan->flags))
> + l2cap_add_conf_opt(&ptr, L2CAP_CONF_EWS, 2,
> + chan->tx_win);
Fix your indentation:
l2cap_add_conf_opt(&ptr, L2CAP_CONF_EWS, 2,
chan->tx_win);
There should be more wrong indentations on your code, please check.
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
