Bluetooth: Fix L2CAP coding style
Follow the net subsystem coding style Acked-by: Marcel Holtmann <marcel@holtmann.org> Signed-off-by: Gustavo Padovan <gustavo.padovan@collabora.co.uk>
This commit is contained in:
Родитель
4c89b6aad5
Коммит
2d7928184c
|
@ -48,19 +48,20 @@ static LIST_HEAD(chan_list);
|
|||
static DEFINE_RWLOCK(chan_list_lock);
|
||||
|
||||
static struct sk_buff *l2cap_build_cmd(struct l2cap_conn *conn,
|
||||
u8 code, u8 ident, u16 dlen, void *data);
|
||||
u8 code, u8 ident, u16 dlen, void *data);
|
||||
static void l2cap_send_cmd(struct l2cap_conn *conn, u8 ident, u8 code, u16 len,
|
||||
void *data);
|
||||
void *data);
|
||||
static int l2cap_build_conf_req(struct l2cap_chan *chan, void *data);
|
||||
static void l2cap_send_disconn_req(struct l2cap_conn *conn,
|
||||
struct l2cap_chan *chan, int err);
|
||||
|
||||
static void l2cap_tx(struct l2cap_chan *chan, struct l2cap_ctrl *control,
|
||||
struct sk_buff_head *skbs, u8 event);
|
||||
struct sk_buff_head *skbs, u8 event);
|
||||
|
||||
/* ---- L2CAP channels ---- */
|
||||
|
||||
static struct l2cap_chan *__l2cap_get_chan_by_dcid(struct l2cap_conn *conn, u16 cid)
|
||||
static struct l2cap_chan *__l2cap_get_chan_by_dcid(struct l2cap_conn *conn,
|
||||
u16 cid)
|
||||
{
|
||||
struct l2cap_chan *c;
|
||||
|
||||
|
@ -71,7 +72,8 @@ static struct l2cap_chan *__l2cap_get_chan_by_dcid(struct l2cap_conn *conn, u16
|
|||
return NULL;
|
||||
}
|
||||
|
||||
static struct l2cap_chan *__l2cap_get_chan_by_scid(struct l2cap_conn *conn, u16 cid)
|
||||
static struct l2cap_chan *__l2cap_get_chan_by_scid(struct l2cap_conn *conn,
|
||||
u16 cid)
|
||||
{
|
||||
struct l2cap_chan *c;
|
||||
|
||||
|
@ -84,7 +86,8 @@ static struct l2cap_chan *__l2cap_get_chan_by_scid(struct l2cap_conn *conn, u16
|
|||
|
||||
/* Find channel with given SCID.
|
||||
* Returns locked channel. */
|
||||
static struct l2cap_chan *l2cap_get_chan_by_scid(struct l2cap_conn *conn, u16 cid)
|
||||
static struct l2cap_chan *l2cap_get_chan_by_scid(struct l2cap_conn *conn,
|
||||
u16 cid)
|
||||
{
|
||||
struct l2cap_chan *c;
|
||||
|
||||
|
@ -97,7 +100,8 @@ static struct l2cap_chan *l2cap_get_chan_by_scid(struct l2cap_conn *conn, u16 ci
|
|||
return c;
|
||||
}
|
||||
|
||||
static struct l2cap_chan *__l2cap_get_chan_by_ident(struct l2cap_conn *conn, u8 ident)
|
||||
static struct l2cap_chan *__l2cap_get_chan_by_ident(struct l2cap_conn *conn,
|
||||
u8 ident)
|
||||
{
|
||||
struct l2cap_chan *c;
|
||||
|
||||
|
@ -178,7 +182,7 @@ static u16 l2cap_alloc_cid(struct l2cap_conn *conn)
|
|||
static void __l2cap_state_change(struct l2cap_chan *chan, int state)
|
||||
{
|
||||
BT_DBG("chan %p %s -> %s", chan, state_to_string(chan->state),
|
||||
state_to_string(state));
|
||||
state_to_string(state));
|
||||
|
||||
chan->state = state;
|
||||
chan->ops->state_change(chan, state);
|
||||
|
@ -361,7 +365,7 @@ static void l2cap_seq_list_append(struct l2cap_seq_list *seq_list, u16 seq)
|
|||
static void l2cap_chan_timeout(struct work_struct *work)
|
||||
{
|
||||
struct l2cap_chan *chan = container_of(work, struct l2cap_chan,
|
||||
chan_timer.work);
|
||||
chan_timer.work);
|
||||
struct l2cap_conn *conn = chan->conn;
|
||||
int reason;
|
||||
|
||||
|
@ -373,7 +377,7 @@ static void l2cap_chan_timeout(struct work_struct *work)
|
|||
if (chan->state == BT_CONNECTED || chan->state == BT_CONFIG)
|
||||
reason = ECONNREFUSED;
|
||||
else if (chan->state == BT_CONNECT &&
|
||||
chan->sec_level != BT_SECURITY_SDP)
|
||||
chan->sec_level != BT_SECURITY_SDP)
|
||||
reason = ECONNREFUSED;
|
||||
else
|
||||
reason = ETIMEDOUT;
|
||||
|
@ -573,8 +577,8 @@ void l2cap_chan_close(struct l2cap_chan *chan, int reason)
|
|||
struct l2cap_conn *conn = chan->conn;
|
||||
struct sock *sk = chan->sk;
|
||||
|
||||
BT_DBG("chan %p state %s sk %p", chan,
|
||||
state_to_string(chan->state), sk);
|
||||
BT_DBG("chan %p state %s sk %p", chan, state_to_string(chan->state),
|
||||
sk);
|
||||
|
||||
switch (chan->state) {
|
||||
case BT_LISTEN:
|
||||
|
@ -585,7 +589,7 @@ void l2cap_chan_close(struct l2cap_chan *chan, int reason)
|
|||
case BT_CONNECTED:
|
||||
case BT_CONFIG:
|
||||
if (chan->chan_type == L2CAP_CHAN_CONN_ORIENTED &&
|
||||
conn->hcon->type == ACL_LINK) {
|
||||
conn->hcon->type == ACL_LINK) {
|
||||
__set_chan_timer(chan, sk->sk_sndtimeo);
|
||||
l2cap_send_disconn_req(conn, chan, reason);
|
||||
} else
|
||||
|
@ -594,7 +598,7 @@ void l2cap_chan_close(struct l2cap_chan *chan, int reason)
|
|||
|
||||
case BT_CONNECT2:
|
||||
if (chan->chan_type == L2CAP_CHAN_CONN_ORIENTED &&
|
||||
conn->hcon->type == ACL_LINK) {
|
||||
conn->hcon->type == ACL_LINK) {
|
||||
struct l2cap_conn_rsp rsp;
|
||||
__u16 result;
|
||||
|
||||
|
@ -609,7 +613,7 @@ void l2cap_chan_close(struct l2cap_chan *chan, int reason)
|
|||
rsp.result = cpu_to_le16(result);
|
||||
rsp.status = __constant_cpu_to_le16(L2CAP_CS_NO_INFO);
|
||||
l2cap_send_cmd(conn, chan->ident, L2CAP_CONN_RSP,
|
||||
sizeof(rsp), &rsp);
|
||||
sizeof(rsp), &rsp);
|
||||
}
|
||||
|
||||
l2cap_chan_del(chan, reason);
|
||||
|
@ -691,7 +695,8 @@ static u8 l2cap_get_ident(struct l2cap_conn *conn)
|
|||
return id;
|
||||
}
|
||||
|
||||
static void l2cap_send_cmd(struct l2cap_conn *conn, u8 ident, u8 code, u16 len, void *data)
|
||||
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);
|
||||
u8 flags;
|
||||
|
@ -718,10 +723,10 @@ static void l2cap_do_send(struct l2cap_chan *chan, struct sk_buff *skb)
|
|||
u16 flags;
|
||||
|
||||
BT_DBG("chan %p, skb %p len %d priority %u", chan, skb, skb->len,
|
||||
skb->priority);
|
||||
skb->priority);
|
||||
|
||||
if (!test_bit(FLAG_FLUSHABLE, &chan->flags) &&
|
||||
lmp_no_flush_capable(hcon->hdev))
|
||||
lmp_no_flush_capable(hcon->hdev))
|
||||
flags = ACL_START_NO_FLUSH;
|
||||
else
|
||||
flags = ACL_START;
|
||||
|
@ -1008,7 +1013,7 @@ static void l2cap_do_start(struct l2cap_chan *chan)
|
|||
return;
|
||||
|
||||
if (l2cap_chan_check_security(chan) &&
|
||||
__l2cap_no_conn_pending(chan)) {
|
||||
__l2cap_no_conn_pending(chan)) {
|
||||
l2cap_start_connection(chan);
|
||||
}
|
||||
} else {
|
||||
|
@ -1020,8 +1025,8 @@ static void l2cap_do_start(struct l2cap_chan *chan)
|
|||
|
||||
schedule_delayed_work(&conn->info_timer, L2CAP_INFO_TIMEOUT);
|
||||
|
||||
l2cap_send_cmd(conn, conn->info_ident,
|
||||
L2CAP_INFO_REQ, sizeof(req), &req);
|
||||
l2cap_send_cmd(conn, conn->info_ident, L2CAP_INFO_REQ,
|
||||
sizeof(req), &req);
|
||||
}
|
||||
}
|
||||
|
||||
|
@ -1041,7 +1046,8 @@ static inline int l2cap_mode_supported(__u8 mode, __u32 feat_mask)
|
|||
}
|
||||
}
|
||||
|
||||
static void l2cap_send_disconn_req(struct l2cap_conn *conn, struct l2cap_chan *chan, int err)
|
||||
static void l2cap_send_disconn_req(struct l2cap_conn *conn,
|
||||
struct l2cap_chan *chan, int err)
|
||||
{
|
||||
struct sock *sk = chan->sk;
|
||||
struct l2cap_disconn_req req;
|
||||
|
@ -1062,8 +1068,8 @@ static void l2cap_send_disconn_req(struct l2cap_conn *conn, struct l2cap_chan *c
|
|||
|
||||
req.dcid = cpu_to_le16(chan->dcid);
|
||||
req.scid = cpu_to_le16(chan->scid);
|
||||
l2cap_send_cmd(conn, l2cap_get_ident(conn),
|
||||
L2CAP_DISCONN_REQ, sizeof(req), &req);
|
||||
l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_DISCONN_REQ,
|
||||
sizeof(req), &req);
|
||||
|
||||
lock_sock(sk);
|
||||
__l2cap_state_change(chan, BT_DISCONN);
|
||||
|
@ -1092,13 +1098,13 @@ static void l2cap_conn_start(struct l2cap_conn *conn)
|
|||
|
||||
if (chan->state == BT_CONNECT) {
|
||||
if (!l2cap_chan_check_security(chan) ||
|
||||
!__l2cap_no_conn_pending(chan)) {
|
||||
!__l2cap_no_conn_pending(chan)) {
|
||||
l2cap_chan_unlock(chan);
|
||||
continue;
|
||||
}
|
||||
|
||||
if (!l2cap_mode_supported(chan->mode, conn->feat_mask)
|
||||
&& test_bit(CONF_STATE2_DEVICE,
|
||||
&& test_bit(CONF_STATE2_DEVICE,
|
||||
&chan->conf_state)) {
|
||||
l2cap_chan_close(chan, ECONNRESET);
|
||||
l2cap_chan_unlock(chan);
|
||||
|
@ -1135,17 +1141,17 @@ static void l2cap_conn_start(struct l2cap_conn *conn)
|
|||
}
|
||||
|
||||
l2cap_send_cmd(conn, chan->ident, L2CAP_CONN_RSP,
|
||||
sizeof(rsp), &rsp);
|
||||
sizeof(rsp), &rsp);
|
||||
|
||||
if (test_bit(CONF_REQ_SENT, &chan->conf_state) ||
|
||||
rsp.result != L2CAP_CR_SUCCESS) {
|
||||
rsp.result != L2CAP_CR_SUCCESS) {
|
||||
l2cap_chan_unlock(chan);
|
||||
continue;
|
||||
}
|
||||
|
||||
set_bit(CONF_REQ_SENT, &chan->conf_state);
|
||||
l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ,
|
||||
l2cap_build_conf_req(chan, buf), buf);
|
||||
l2cap_build_conf_req(chan, buf), buf);
|
||||
chan->num_conf_req++;
|
||||
}
|
||||
|
||||
|
@ -1302,7 +1308,7 @@ static void l2cap_conn_unreliable(struct l2cap_conn *conn, int err)
|
|||
static void l2cap_info_timeout(struct work_struct *work)
|
||||
{
|
||||
struct l2cap_conn *conn = container_of(work, struct l2cap_conn,
|
||||
info_timer.work);
|
||||
info_timer.work);
|
||||
|
||||
conn->info_state |= L2CAP_INFO_FEAT_MASK_REQ_DONE;
|
||||
conn->info_ident = 0;
|
||||
|
@ -1356,7 +1362,7 @@ static void l2cap_conn_del(struct hci_conn *hcon, int err)
|
|||
static void security_timeout(struct work_struct *work)
|
||||
{
|
||||
struct l2cap_conn *conn = container_of(work, struct l2cap_conn,
|
||||
security_timer.work);
|
||||
security_timer.work);
|
||||
|
||||
BT_DBG("conn %p", conn);
|
||||
|
||||
|
@ -1496,7 +1502,7 @@ int l2cap_chan_connect(struct l2cap_chan *chan, __le16 psm, u16 cid,
|
|||
|
||||
/* PSM must be odd and lsb of upper byte must be 0 */
|
||||
if ((__le16_to_cpu(psm) & 0x0101) != 0x0001 && !cid &&
|
||||
chan->chan_type != L2CAP_CHAN_RAW) {
|
||||
chan->chan_type != L2CAP_CHAN_RAW) {
|
||||
err = -EINVAL;
|
||||
goto done;
|
||||
}
|
||||
|
@ -1805,7 +1811,7 @@ static void l2cap_ertm_resend(struct l2cap_chan *chan)
|
|||
skb = l2cap_ertm_seq_in_queue(&chan->tx_q, seq);
|
||||
if (!skb) {
|
||||
BT_DBG("Error: Can't retransmit seq %d, frame missing",
|
||||
seq);
|
||||
seq);
|
||||
continue;
|
||||
}
|
||||
|
||||
|
@ -1890,7 +1896,7 @@ static void l2cap_retransmit_all(struct l2cap_chan *chan,
|
|||
if (chan->unacked_frames) {
|
||||
skb_queue_walk(&chan->tx_q, skb) {
|
||||
if (bt_cb(skb)->control.txseq == control->reqseq ||
|
||||
skb == chan->tx_send_head)
|
||||
skb == chan->tx_send_head)
|
||||
break;
|
||||
}
|
||||
|
||||
|
@ -2191,7 +2197,7 @@ static int l2cap_segment_sdu(struct l2cap_chan *chan,
|
|||
}
|
||||
|
||||
int l2cap_chan_send(struct l2cap_chan *chan, struct msghdr *msg, size_t len,
|
||||
u32 priority)
|
||||
u32 priority)
|
||||
{
|
||||
struct sk_buff *skb;
|
||||
int err;
|
||||
|
@ -2653,7 +2659,8 @@ fail:
|
|||
return NULL;
|
||||
}
|
||||
|
||||
static inline int l2cap_get_conf_opt(void **ptr, int *type, int *olen, unsigned long *val)
|
||||
static inline int l2cap_get_conf_opt(void **ptr, int *type, int *olen,
|
||||
unsigned long *val)
|
||||
{
|
||||
struct l2cap_conf_opt *opt = *ptr;
|
||||
int len;
|
||||
|
@ -2833,13 +2840,13 @@ static inline bool __l2cap_efs_supported(struct l2cap_chan *chan)
|
|||
static inline void l2cap_txwin_setup(struct l2cap_chan *chan)
|
||||
{
|
||||
if (chan->tx_win > L2CAP_DEFAULT_TX_WINDOW &&
|
||||
__l2cap_ews_supported(chan)) {
|
||||
__l2cap_ews_supported(chan)) {
|
||||
/* use extended control field */
|
||||
set_bit(FLAG_EXT_CTRL, &chan->flags);
|
||||
chan->tx_win_max = L2CAP_DEFAULT_EXT_WINDOW;
|
||||
} else {
|
||||
chan->tx_win = min_t(u16, chan->tx_win,
|
||||
L2CAP_DEFAULT_TX_WINDOW);
|
||||
L2CAP_DEFAULT_TX_WINDOW);
|
||||
chan->tx_win_max = L2CAP_DEFAULT_TX_WINDOW;
|
||||
}
|
||||
chan->ack_win = chan->tx_win;
|
||||
|
@ -2879,7 +2886,7 @@ done:
|
|||
switch (chan->mode) {
|
||||
case L2CAP_MODE_BASIC:
|
||||
if (!(chan->conn->feat_mask & L2CAP_FEAT_ERTM) &&
|
||||
!(chan->conn->feat_mask & L2CAP_FEAT_STREAMING))
|
||||
!(chan->conn->feat_mask & L2CAP_FEAT_STREAMING))
|
||||
break;
|
||||
|
||||
rfc.mode = L2CAP_MODE_BASIC;
|
||||
|
@ -2890,7 +2897,7 @@ done:
|
|||
rfc.max_pdu_size = 0;
|
||||
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC, sizeof(rfc),
|
||||
(unsigned long) &rfc);
|
||||
(unsigned long) &rfc);
|
||||
break;
|
||||
|
||||
case L2CAP_MODE_ERTM:
|
||||
|
@ -2900,18 +2907,17 @@ done:
|
|||
rfc.monitor_timeout = 0;
|
||||
|
||||
size = min_t(u16, L2CAP_DEFAULT_MAX_PDU_SIZE, chan->conn->mtu -
|
||||
L2CAP_EXT_HDR_SIZE -
|
||||
L2CAP_SDULEN_SIZE -
|
||||
L2CAP_FCS_SIZE);
|
||||
L2CAP_EXT_HDR_SIZE - L2CAP_SDULEN_SIZE -
|
||||
L2CAP_FCS_SIZE);
|
||||
rfc.max_pdu_size = cpu_to_le16(size);
|
||||
|
||||
l2cap_txwin_setup(chan);
|
||||
|
||||
rfc.txwin_size = min_t(u16, chan->tx_win,
|
||||
L2CAP_DEFAULT_TX_WINDOW);
|
||||
L2CAP_DEFAULT_TX_WINDOW);
|
||||
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC, sizeof(rfc),
|
||||
(unsigned long) &rfc);
|
||||
(unsigned long) &rfc);
|
||||
|
||||
if (test_bit(FLAG_EFS_ENABLE, &chan->flags))
|
||||
l2cap_add_opt_efs(&ptr, chan);
|
||||
|
@ -2920,14 +2926,14 @@ done:
|
|||
break;
|
||||
|
||||
if (chan->fcs == L2CAP_FCS_NONE ||
|
||||
test_bit(CONF_NO_FCS_RECV, &chan->conf_state)) {
|
||||
test_bit(CONF_NO_FCS_RECV, &chan->conf_state)) {
|
||||
chan->fcs = L2CAP_FCS_NONE;
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_FCS, 1, chan->fcs);
|
||||
}
|
||||
|
||||
if (test_bit(FLAG_EXT_CTRL, &chan->flags))
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_EWS, 2,
|
||||
chan->tx_win);
|
||||
chan->tx_win);
|
||||
break;
|
||||
|
||||
case L2CAP_MODE_STREAMING:
|
||||
|
@ -2939,13 +2945,12 @@ done:
|
|||
rfc.monitor_timeout = 0;
|
||||
|
||||
size = min_t(u16, L2CAP_DEFAULT_MAX_PDU_SIZE, chan->conn->mtu -
|
||||
L2CAP_EXT_HDR_SIZE -
|
||||
L2CAP_SDULEN_SIZE -
|
||||
L2CAP_FCS_SIZE);
|
||||
L2CAP_EXT_HDR_SIZE - L2CAP_SDULEN_SIZE -
|
||||
L2CAP_FCS_SIZE);
|
||||
rfc.max_pdu_size = cpu_to_le16(size);
|
||||
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC, sizeof(rfc),
|
||||
(unsigned long) &rfc);
|
||||
(unsigned long) &rfc);
|
||||
|
||||
if (test_bit(FLAG_EFS_ENABLE, &chan->flags))
|
||||
l2cap_add_opt_efs(&ptr, chan);
|
||||
|
@ -2954,7 +2959,7 @@ done:
|
|||
break;
|
||||
|
||||
if (chan->fcs == L2CAP_FCS_NONE ||
|
||||
test_bit(CONF_NO_FCS_RECV, &chan->conf_state)) {
|
||||
test_bit(CONF_NO_FCS_RECV, &chan->conf_state)) {
|
||||
chan->fcs = L2CAP_FCS_NONE;
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_FCS, 1, chan->fcs);
|
||||
}
|
||||
|
@ -3046,7 +3051,7 @@ static int l2cap_parse_conf_req(struct l2cap_chan *chan, void *data)
|
|||
case L2CAP_MODE_ERTM:
|
||||
if (!test_bit(CONF_STATE2_DEVICE, &chan->conf_state)) {
|
||||
chan->mode = l2cap_select_mode(rfc.mode,
|
||||
chan->conn->feat_mask);
|
||||
chan->conn->feat_mask);
|
||||
break;
|
||||
}
|
||||
|
||||
|
@ -3071,8 +3076,8 @@ done:
|
|||
if (chan->num_conf_rsp == 1)
|
||||
return -ECONNREFUSED;
|
||||
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC,
|
||||
sizeof(rfc), (unsigned long) &rfc);
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC, sizeof(rfc),
|
||||
(unsigned long) &rfc);
|
||||
}
|
||||
|
||||
if (result == L2CAP_CONF_SUCCESS) {
|
||||
|
@ -3089,8 +3094,8 @@ done:
|
|||
|
||||
if (remote_efs) {
|
||||
if (chan->local_stype != L2CAP_SERV_NOTRAFIC &&
|
||||
efs.stype != L2CAP_SERV_NOTRAFIC &&
|
||||
efs.stype != chan->local_stype) {
|
||||
efs.stype != L2CAP_SERV_NOTRAFIC &&
|
||||
efs.stype != chan->local_stype) {
|
||||
|
||||
result = L2CAP_CONF_UNACCEPT;
|
||||
|
||||
|
@ -3098,8 +3103,8 @@ done:
|
|||
return -ECONNREFUSED;
|
||||
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_EFS,
|
||||
sizeof(efs),
|
||||
(unsigned long) &efs);
|
||||
sizeof(efs),
|
||||
(unsigned long) &efs);
|
||||
} else {
|
||||
/* Send PENDING Conf Rsp */
|
||||
result = L2CAP_CONF_PENDING;
|
||||
|
@ -3122,10 +3127,8 @@ done:
|
|||
chan->remote_max_tx = rfc.max_transmit;
|
||||
|
||||
size = min_t(u16, le16_to_cpu(rfc.max_pdu_size),
|
||||
chan->conn->mtu -
|
||||
L2CAP_EXT_HDR_SIZE -
|
||||
L2CAP_SDULEN_SIZE -
|
||||
L2CAP_FCS_SIZE);
|
||||
chan->conn->mtu - L2CAP_EXT_HDR_SIZE -
|
||||
L2CAP_SDULEN_SIZE - L2CAP_FCS_SIZE);
|
||||
rfc.max_pdu_size = cpu_to_le16(size);
|
||||
chan->remote_mps = size;
|
||||
|
||||
|
@ -3137,36 +3140,35 @@ done:
|
|||
set_bit(CONF_MODE_DONE, &chan->conf_state);
|
||||
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC,
|
||||
sizeof(rfc), (unsigned long) &rfc);
|
||||
sizeof(rfc), (unsigned long) &rfc);
|
||||
|
||||
if (test_bit(FLAG_EFS_ENABLE, &chan->flags)) {
|
||||
chan->remote_id = efs.id;
|
||||
chan->remote_stype = efs.stype;
|
||||
chan->remote_msdu = le16_to_cpu(efs.msdu);
|
||||
chan->remote_flush_to =
|
||||
le32_to_cpu(efs.flush_to);
|
||||
le32_to_cpu(efs.flush_to);
|
||||
chan->remote_acc_lat =
|
||||
le32_to_cpu(efs.acc_lat);
|
||||
le32_to_cpu(efs.acc_lat);
|
||||
chan->remote_sdu_itime =
|
||||
le32_to_cpu(efs.sdu_itime);
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_EFS,
|
||||
sizeof(efs), (unsigned long) &efs);
|
||||
sizeof(efs),
|
||||
(unsigned long) &efs);
|
||||
}
|
||||
break;
|
||||
|
||||
case L2CAP_MODE_STREAMING:
|
||||
size = min_t(u16, le16_to_cpu(rfc.max_pdu_size),
|
||||
chan->conn->mtu -
|
||||
L2CAP_EXT_HDR_SIZE -
|
||||
L2CAP_SDULEN_SIZE -
|
||||
L2CAP_FCS_SIZE);
|
||||
chan->conn->mtu - L2CAP_EXT_HDR_SIZE -
|
||||
L2CAP_SDULEN_SIZE - L2CAP_FCS_SIZE);
|
||||
rfc.max_pdu_size = cpu_to_le16(size);
|
||||
chan->remote_mps = size;
|
||||
|
||||
set_bit(CONF_MODE_DONE, &chan->conf_state);
|
||||
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC,
|
||||
sizeof(rfc), (unsigned long) &rfc);
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC, sizeof(rfc),
|
||||
(unsigned long) &rfc);
|
||||
|
||||
break;
|
||||
|
||||
|
@ -3187,7 +3189,8 @@ done:
|
|||
return ptr - data;
|
||||
}
|
||||
|
||||
static int l2cap_parse_conf_rsp(struct l2cap_chan *chan, void *rsp, int len, void *data, u16 *result)
|
||||
static int l2cap_parse_conf_rsp(struct l2cap_chan *chan, void *rsp, int len,
|
||||
void *data, u16 *result)
|
||||
{
|
||||
struct l2cap_conf_req *req = data;
|
||||
void *ptr = req->data;
|
||||
|
@ -3214,7 +3217,7 @@ static int l2cap_parse_conf_rsp(struct l2cap_chan *chan, void *rsp, int len, voi
|
|||
case L2CAP_CONF_FLUSH_TO:
|
||||
chan->flush_to = val;
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_FLUSH_TO,
|
||||
2, chan->flush_to);
|
||||
2, chan->flush_to);
|
||||
break;
|
||||
|
||||
case L2CAP_CONF_RFC:
|
||||
|
@ -3222,13 +3225,13 @@ static int l2cap_parse_conf_rsp(struct l2cap_chan *chan, void *rsp, int len, voi
|
|||
memcpy(&rfc, (void *)val, olen);
|
||||
|
||||
if (test_bit(CONF_STATE2_DEVICE, &chan->conf_state) &&
|
||||
rfc.mode != chan->mode)
|
||||
rfc.mode != chan->mode)
|
||||
return -ECONNREFUSED;
|
||||
|
||||
chan->fcs = 0;
|
||||
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC,
|
||||
sizeof(rfc), (unsigned long) &rfc);
|
||||
sizeof(rfc), (unsigned long) &rfc);
|
||||
break;
|
||||
|
||||
case L2CAP_CONF_EWS:
|
||||
|
@ -3242,12 +3245,12 @@ static int l2cap_parse_conf_rsp(struct l2cap_chan *chan, void *rsp, int len, voi
|
|||
memcpy(&efs, (void *)val, olen);
|
||||
|
||||
if (chan->local_stype != L2CAP_SERV_NOTRAFIC &&
|
||||
efs.stype != L2CAP_SERV_NOTRAFIC &&
|
||||
efs.stype != chan->local_stype)
|
||||
efs.stype != L2CAP_SERV_NOTRAFIC &&
|
||||
efs.stype != chan->local_stype)
|
||||
return -ECONNREFUSED;
|
||||
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_EFS,
|
||||
sizeof(efs), (unsigned long) &efs);
|
||||
l2cap_add_conf_opt(&ptr, L2CAP_CONF_EFS, sizeof(efs),
|
||||
(unsigned long) &efs);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
@ -3270,10 +3273,10 @@ static int l2cap_parse_conf_rsp(struct l2cap_chan *chan, void *rsp, int len, voi
|
|||
if (test_bit(FLAG_EFS_ENABLE, &chan->flags)) {
|
||||
chan->local_msdu = le16_to_cpu(efs.msdu);
|
||||
chan->local_sdu_itime =
|
||||
le32_to_cpu(efs.sdu_itime);
|
||||
le32_to_cpu(efs.sdu_itime);
|
||||
chan->local_acc_lat = le32_to_cpu(efs.acc_lat);
|
||||
chan->local_flush_to =
|
||||
le32_to_cpu(efs.flush_to);
|
||||
le32_to_cpu(efs.flush_to);
|
||||
}
|
||||
break;
|
||||
|
||||
|
@ -3288,7 +3291,8 @@ static int l2cap_parse_conf_rsp(struct l2cap_chan *chan, void *rsp, int len, voi
|
|||
return ptr - data;
|
||||
}
|
||||
|
||||
static int l2cap_build_conf_rsp(struct l2cap_chan *chan, void *data, u16 result, u16 flags)
|
||||
static int l2cap_build_conf_rsp(struct l2cap_chan *chan, void *data,
|
||||
u16 result, u16 flags)
|
||||
{
|
||||
struct l2cap_conf_rsp *rsp = data;
|
||||
void *ptr = rsp->data;
|
||||
|
@ -3312,14 +3316,13 @@ void __l2cap_connect_rsp_defer(struct l2cap_chan *chan)
|
|||
rsp.dcid = cpu_to_le16(chan->scid);
|
||||
rsp.result = __constant_cpu_to_le16(L2CAP_CR_SUCCESS);
|
||||
rsp.status = __constant_cpu_to_le16(L2CAP_CS_NO_INFO);
|
||||
l2cap_send_cmd(conn, chan->ident,
|
||||
L2CAP_CONN_RSP, sizeof(rsp), &rsp);
|
||||
l2cap_send_cmd(conn, chan->ident, L2CAP_CONN_RSP, sizeof(rsp), &rsp);
|
||||
|
||||
if (test_and_set_bit(CONF_REQ_SENT, &chan->conf_state))
|
||||
return;
|
||||
|
||||
l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ,
|
||||
l2cap_build_conf_req(chan, buf), buf);
|
||||
l2cap_build_conf_req(chan, buf), buf);
|
||||
chan->num_conf_req++;
|
||||
}
|
||||
|
||||
|
@ -3374,7 +3377,8 @@ static void l2cap_conf_rfc_get(struct l2cap_chan *chan, void *rsp, int len)
|
|||
}
|
||||
}
|
||||
|
||||
static inline int l2cap_command_rej(struct l2cap_conn *conn, struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
static inline int l2cap_command_rej(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
{
|
||||
struct l2cap_cmd_rej_unk *rej = (struct l2cap_cmd_rej_unk *) data;
|
||||
|
||||
|
@ -3382,7 +3386,7 @@ static inline int l2cap_command_rej(struct l2cap_conn *conn, struct l2cap_cmd_hd
|
|||
return 0;
|
||||
|
||||
if ((conn->info_state & L2CAP_INFO_FEAT_MASK_REQ_SENT) &&
|
||||
cmd->ident == conn->info_ident) {
|
||||
cmd->ident == conn->info_ident) {
|
||||
cancel_delayed_work(&conn->info_timer);
|
||||
|
||||
conn->info_state |= L2CAP_INFO_FEAT_MASK_REQ_DONE;
|
||||
|
@ -3422,7 +3426,7 @@ static void __l2cap_connect(struct l2cap_conn *conn, struct l2cap_cmd_hdr *cmd,
|
|||
|
||||
/* Check if the ACL is secure enough (if not SDP) */
|
||||
if (psm != __constant_cpu_to_le16(L2CAP_PSM_SDP) &&
|
||||
!hci_conn_check_link_mode(conn->hcon)) {
|
||||
!hci_conn_check_link_mode(conn->hcon)) {
|
||||
conn->disc_reason = HCI_ERROR_AUTH_FAILURE;
|
||||
result = L2CAP_CR_SEC_BLOCK;
|
||||
goto response;
|
||||
|
@ -3500,16 +3504,16 @@ sendresp:
|
|||
|
||||
schedule_delayed_work(&conn->info_timer, L2CAP_INFO_TIMEOUT);
|
||||
|
||||
l2cap_send_cmd(conn, conn->info_ident,
|
||||
L2CAP_INFO_REQ, sizeof(info), &info);
|
||||
l2cap_send_cmd(conn, conn->info_ident, L2CAP_INFO_REQ,
|
||||
sizeof(info), &info);
|
||||
}
|
||||
|
||||
if (chan && !test_bit(CONF_REQ_SENT, &chan->conf_state) &&
|
||||
result == L2CAP_CR_SUCCESS) {
|
||||
result == L2CAP_CR_SUCCESS) {
|
||||
u8 buf[128];
|
||||
set_bit(CONF_REQ_SENT, &chan->conf_state);
|
||||
l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ,
|
||||
l2cap_build_conf_req(chan, buf), buf);
|
||||
l2cap_build_conf_req(chan, buf), buf);
|
||||
chan->num_conf_req++;
|
||||
}
|
||||
}
|
||||
|
@ -3521,7 +3525,8 @@ static int l2cap_connect_req(struct l2cap_conn *conn,
|
|||
return 0;
|
||||
}
|
||||
|
||||
static inline int l2cap_connect_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
static inline int l2cap_connect_rsp(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
{
|
||||
struct l2cap_conn_rsp *rsp = (struct l2cap_conn_rsp *) data;
|
||||
u16 scid, dcid, result, status;
|
||||
|
@ -3535,7 +3540,7 @@ static inline int l2cap_connect_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hd
|
|||
status = __le16_to_cpu(rsp->status);
|
||||
|
||||
BT_DBG("dcid 0x%4.4x scid 0x%4.4x result 0x%2.2x status 0x%2.2x",
|
||||
dcid, scid, result, status);
|
||||
dcid, scid, result, status);
|
||||
|
||||
mutex_lock(&conn->chan_lock);
|
||||
|
||||
|
@ -3568,7 +3573,7 @@ static inline int l2cap_connect_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hd
|
|||
break;
|
||||
|
||||
l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ,
|
||||
l2cap_build_conf_req(chan, req), req);
|
||||
l2cap_build_conf_req(chan, req), req);
|
||||
chan->num_conf_req++;
|
||||
break;
|
||||
|
||||
|
@ -3616,7 +3621,9 @@ static void l2cap_send_efs_conf_rsp(struct l2cap_chan *chan, void *data,
|
|||
L2CAP_CONF_SUCCESS, flags), data);
|
||||
}
|
||||
|
||||
static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr *cmd, u16 cmd_len, u8 *data)
|
||||
static inline int l2cap_config_req(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u16 cmd_len,
|
||||
u8 *data)
|
||||
{
|
||||
struct l2cap_conf_req *req = (struct l2cap_conf_req *) data;
|
||||
u16 dcid, flags;
|
||||
|
@ -3641,7 +3648,7 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr
|
|||
rej.dcid = cpu_to_le16(chan->dcid);
|
||||
|
||||
l2cap_send_cmd(conn, cmd->ident, L2CAP_COMMAND_REJ,
|
||||
sizeof(rej), &rej);
|
||||
sizeof(rej), &rej);
|
||||
goto unlock;
|
||||
}
|
||||
|
||||
|
@ -3649,8 +3656,8 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr
|
|||
len = cmd_len - sizeof(*req);
|
||||
if (len < 0 || chan->conf_len + len > sizeof(chan->conf_req)) {
|
||||
l2cap_send_cmd(conn, cmd->ident, L2CAP_CONF_RSP,
|
||||
l2cap_build_conf_rsp(chan, rsp,
|
||||
L2CAP_CONF_REJECT, flags), rsp);
|
||||
l2cap_build_conf_rsp(chan, rsp,
|
||||
L2CAP_CONF_REJECT, flags), rsp);
|
||||
goto unlock;
|
||||
}
|
||||
|
||||
|
@ -3661,8 +3668,8 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr
|
|||
if (flags & L2CAP_CONF_FLAG_CONTINUATION) {
|
||||
/* Incomplete config. Send empty response. */
|
||||
l2cap_send_cmd(conn, cmd->ident, L2CAP_CONF_RSP,
|
||||
l2cap_build_conf_rsp(chan, rsp,
|
||||
L2CAP_CONF_SUCCESS, flags), rsp);
|
||||
l2cap_build_conf_rsp(chan, rsp,
|
||||
L2CAP_CONF_SUCCESS, flags), rsp);
|
||||
goto unlock;
|
||||
}
|
||||
|
||||
|
@ -3700,7 +3707,7 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr
|
|||
if (!test_and_set_bit(CONF_REQ_SENT, &chan->conf_state)) {
|
||||
u8 buf[64];
|
||||
l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ,
|
||||
l2cap_build_conf_req(chan, buf), buf);
|
||||
l2cap_build_conf_req(chan, buf), buf);
|
||||
chan->num_conf_req++;
|
||||
}
|
||||
|
||||
|
@ -3719,7 +3726,8 @@ unlock:
|
|||
return err;
|
||||
}
|
||||
|
||||
static inline int l2cap_config_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
static inline int l2cap_config_rsp(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
{
|
||||
struct l2cap_conf_rsp *rsp = (struct l2cap_conf_rsp *)data;
|
||||
u16 scid, flags, result;
|
||||
|
@ -3751,7 +3759,7 @@ static inline int l2cap_config_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hdr
|
|||
char buf[64];
|
||||
|
||||
len = l2cap_parse_conf_rsp(chan, rsp->data, len,
|
||||
buf, &result);
|
||||
buf, &result);
|
||||
if (len < 0) {
|
||||
l2cap_send_disconn_req(conn, chan, ECONNRESET);
|
||||
goto done;
|
||||
|
@ -3775,14 +3783,14 @@ static inline int l2cap_config_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hdr
|
|||
/* throw out any old stored conf requests */
|
||||
result = L2CAP_CONF_SUCCESS;
|
||||
len = l2cap_parse_conf_rsp(chan, rsp->data, len,
|
||||
req, &result);
|
||||
req, &result);
|
||||
if (len < 0) {
|
||||
l2cap_send_disconn_req(conn, chan, ECONNRESET);
|
||||
goto done;
|
||||
}
|
||||
|
||||
l2cap_send_cmd(conn, l2cap_get_ident(conn),
|
||||
L2CAP_CONF_REQ, len, req);
|
||||
L2CAP_CONF_REQ, len, req);
|
||||
chan->num_conf_req++;
|
||||
if (result != L2CAP_CONF_SUCCESS)
|
||||
goto done;
|
||||
|
@ -3820,7 +3828,8 @@ done:
|
|||
return err;
|
||||
}
|
||||
|
||||
static inline int l2cap_disconnect_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
static inline int l2cap_disconnect_req(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
{
|
||||
struct l2cap_disconn_req *req = (struct l2cap_disconn_req *) data;
|
||||
struct l2cap_disconn_rsp rsp;
|
||||
|
@ -3866,7 +3875,8 @@ static inline int l2cap_disconnect_req(struct l2cap_conn *conn, struct l2cap_cmd
|
|||
return 0;
|
||||
}
|
||||
|
||||
static inline int l2cap_disconnect_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
static inline int l2cap_disconnect_rsp(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
{
|
||||
struct l2cap_disconn_rsp *rsp = (struct l2cap_disconn_rsp *) data;
|
||||
u16 dcid, scid;
|
||||
|
@ -3900,7 +3910,8 @@ static inline int l2cap_disconnect_rsp(struct l2cap_conn *conn, struct l2cap_cmd
|
|||
return 0;
|
||||
}
|
||||
|
||||
static inline int l2cap_information_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
static inline int l2cap_information_req(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
{
|
||||
struct l2cap_info_req *req = (struct l2cap_info_req *) data;
|
||||
u16 type;
|
||||
|
@ -3917,14 +3928,14 @@ static inline int l2cap_information_req(struct l2cap_conn *conn, struct l2cap_cm
|
|||
rsp->result = __constant_cpu_to_le16(L2CAP_IR_SUCCESS);
|
||||
if (!disable_ertm)
|
||||
feat_mask |= L2CAP_FEAT_ERTM | L2CAP_FEAT_STREAMING
|
||||
| L2CAP_FEAT_FCS;
|
||||
| L2CAP_FEAT_FCS;
|
||||
if (enable_hs)
|
||||
feat_mask |= L2CAP_FEAT_EXT_FLOW
|
||||
| L2CAP_FEAT_EXT_WINDOW;
|
||||
| L2CAP_FEAT_EXT_WINDOW;
|
||||
|
||||
put_unaligned_le32(feat_mask, rsp->data);
|
||||
l2cap_send_cmd(conn, cmd->ident,
|
||||
L2CAP_INFO_RSP, sizeof(buf), buf);
|
||||
l2cap_send_cmd(conn, cmd->ident, L2CAP_INFO_RSP, sizeof(buf),
|
||||
buf);
|
||||
} else if (type == L2CAP_IT_FIXED_CHAN) {
|
||||
u8 buf[12];
|
||||
struct l2cap_info_rsp *rsp = (struct l2cap_info_rsp *) buf;
|
||||
|
@ -3937,20 +3948,21 @@ static inline int l2cap_information_req(struct l2cap_conn *conn, struct l2cap_cm
|
|||
rsp->type = __constant_cpu_to_le16(L2CAP_IT_FIXED_CHAN);
|
||||
rsp->result = __constant_cpu_to_le16(L2CAP_IR_SUCCESS);
|
||||
memcpy(rsp->data, l2cap_fixed_chan, sizeof(l2cap_fixed_chan));
|
||||
l2cap_send_cmd(conn, cmd->ident,
|
||||
L2CAP_INFO_RSP, sizeof(buf), buf);
|
||||
l2cap_send_cmd(conn, cmd->ident, L2CAP_INFO_RSP, sizeof(buf),
|
||||
buf);
|
||||
} else {
|
||||
struct l2cap_info_rsp rsp;
|
||||
rsp.type = cpu_to_le16(type);
|
||||
rsp.result = __constant_cpu_to_le16(L2CAP_IR_NOTSUPP);
|
||||
l2cap_send_cmd(conn, cmd->ident,
|
||||
L2CAP_INFO_RSP, sizeof(rsp), &rsp);
|
||||
l2cap_send_cmd(conn, cmd->ident, L2CAP_INFO_RSP, sizeof(rsp),
|
||||
&rsp);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static inline int l2cap_information_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
static inline int l2cap_information_rsp(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
{
|
||||
struct l2cap_info_rsp *rsp = (struct l2cap_info_rsp *) data;
|
||||
u16 type, result;
|
||||
|
@ -3962,7 +3974,7 @@ static inline int l2cap_information_rsp(struct l2cap_conn *conn, struct l2cap_cm
|
|||
|
||||
/* L2CAP Info req/rsp are unbound to channels, add extra checks */
|
||||
if (cmd->ident != conn->info_ident ||
|
||||
conn->info_state & L2CAP_INFO_FEAT_MASK_REQ_DONE)
|
||||
conn->info_state & L2CAP_INFO_FEAT_MASK_REQ_DONE)
|
||||
return 0;
|
||||
|
||||
cancel_delayed_work(&conn->info_timer);
|
||||
|
@ -3987,7 +3999,7 @@ static inline int l2cap_information_rsp(struct l2cap_conn *conn, struct l2cap_cm
|
|||
conn->info_ident = l2cap_get_ident(conn);
|
||||
|
||||
l2cap_send_cmd(conn, conn->info_ident,
|
||||
L2CAP_INFO_REQ, sizeof(req), &req);
|
||||
L2CAP_INFO_REQ, sizeof(req), &req);
|
||||
} else {
|
||||
conn->info_state |= L2CAP_INFO_FEAT_MASK_REQ_DONE;
|
||||
conn->info_ident = 0;
|
||||
|
@ -4009,8 +4021,8 @@ static inline int l2cap_information_rsp(struct l2cap_conn *conn, struct l2cap_cm
|
|||
}
|
||||
|
||||
static inline int l2cap_create_channel_req(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u16 cmd_len,
|
||||
void *data)
|
||||
struct l2cap_cmd_hdr *cmd,
|
||||
u16 cmd_len, void *data)
|
||||
{
|
||||
struct l2cap_create_chan_req *req = data;
|
||||
struct l2cap_create_chan_rsp rsp;
|
||||
|
@ -4039,6 +4051,15 @@ static inline int l2cap_create_channel_req(struct l2cap_conn *conn,
|
|||
return 0;
|
||||
}
|
||||
|
||||
static inline int l2cap_create_channel_rsp(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd,
|
||||
void *data)
|
||||
{
|
||||
BT_DBG("conn %p", conn);
|
||||
|
||||
return l2cap_connect_rsp(conn, cmd, data);
|
||||
}
|
||||
|
||||
static void l2cap_send_move_chan_rsp(struct l2cap_conn *conn, u8 ident,
|
||||
u16 icid, u16 result)
|
||||
{
|
||||
|
@ -4165,7 +4186,7 @@ static inline int l2cap_move_channel_confirm_rsp(struct l2cap_conn *conn,
|
|||
}
|
||||
|
||||
static inline int l2cap_check_conn_param(u16 min, u16 max, u16 latency,
|
||||
u16 to_multiplier)
|
||||
u16 to_multiplier)
|
||||
{
|
||||
u16 max_latency;
|
||||
|
||||
|
@ -4186,7 +4207,8 @@ static inline int l2cap_check_conn_param(u16 min, u16 max, u16 latency,
|
|||
}
|
||||
|
||||
static inline int l2cap_conn_param_update_req(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
struct l2cap_cmd_hdr *cmd,
|
||||
u8 *data)
|
||||
{
|
||||
struct hci_conn *hcon = conn->hcon;
|
||||
struct l2cap_conn_param_update_req *req;
|
||||
|
@ -4208,7 +4230,7 @@ static inline int l2cap_conn_param_update_req(struct l2cap_conn *conn,
|
|||
to_multiplier = __le16_to_cpu(req->to_multiplier);
|
||||
|
||||
BT_DBG("min 0x%4.4x max 0x%4.4x latency: 0x%4.4x Timeout: 0x%4.4x",
|
||||
min, max, latency, to_multiplier);
|
||||
min, max, latency, to_multiplier);
|
||||
|
||||
memset(&rsp, 0, sizeof(rsp));
|
||||
|
||||
|
@ -4219,7 +4241,7 @@ static inline int l2cap_conn_param_update_req(struct l2cap_conn *conn,
|
|||
rsp.result = __constant_cpu_to_le16(L2CAP_CONN_PARAM_ACCEPTED);
|
||||
|
||||
l2cap_send_cmd(conn, cmd->ident, L2CAP_CONN_PARAM_UPDATE_RSP,
|
||||
sizeof(rsp), &rsp);
|
||||
sizeof(rsp), &rsp);
|
||||
|
||||
if (!err)
|
||||
hci_le_conn_update(hcon, min, max, latency, to_multiplier);
|
||||
|
@ -4228,7 +4250,8 @@ static inline int l2cap_conn_param_update_req(struct l2cap_conn *conn,
|
|||
}
|
||||
|
||||
static inline int l2cap_bredr_sig_cmd(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u16 cmd_len, u8 *data)
|
||||
struct l2cap_cmd_hdr *cmd, u16 cmd_len,
|
||||
u8 *data)
|
||||
{
|
||||
int err = 0;
|
||||
|
||||
|
@ -4307,7 +4330,7 @@ static inline int l2cap_bredr_sig_cmd(struct l2cap_conn *conn,
|
|||
}
|
||||
|
||||
static inline int l2cap_le_sig_cmd(struct l2cap_conn *conn,
|
||||
struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
struct l2cap_cmd_hdr *cmd, u8 *data)
|
||||
{
|
||||
switch (cmd->code) {
|
||||
case L2CAP_COMMAND_REJ:
|
||||
|
@ -4326,7 +4349,7 @@ static inline int l2cap_le_sig_cmd(struct l2cap_conn *conn,
|
|||
}
|
||||
|
||||
static inline void l2cap_sig_channel(struct l2cap_conn *conn,
|
||||
struct sk_buff *skb)
|
||||
struct sk_buff *skb)
|
||||
{
|
||||
u8 *data = skb->data;
|
||||
int len = skb->len;
|
||||
|
@ -4343,7 +4366,8 @@ static inline void l2cap_sig_channel(struct l2cap_conn *conn,
|
|||
|
||||
cmd_len = le16_to_cpu(cmd.len);
|
||||
|
||||
BT_DBG("code 0x%2.2x len %d id 0x%2.2x", cmd.code, cmd_len, cmd.ident);
|
||||
BT_DBG("code 0x%2.2x len %d id 0x%2.2x", cmd.code, cmd_len,
|
||||
cmd.ident);
|
||||
|
||||
if (cmd_len > len || !cmd.ident) {
|
||||
BT_DBG("corrupted command");
|
||||
|
@ -4362,7 +4386,8 @@ static inline void l2cap_sig_channel(struct l2cap_conn *conn,
|
|||
|
||||
/* FIXME: Map err to a valid reason */
|
||||
rej.reason = __constant_cpu_to_le16(L2CAP_REJ_NOT_UNDERSTOOD);
|
||||
l2cap_send_cmd(conn, cmd.ident, L2CAP_COMMAND_REJ, sizeof(rej), &rej);
|
||||
l2cap_send_cmd(conn, cmd.ident, L2CAP_COMMAND_REJ,
|
||||
sizeof(rej), &rej);
|
||||
}
|
||||
|
||||
data += cmd_len;
|
||||
|
@ -4427,8 +4452,8 @@ static void l2cap_send_i_or_rr_or_rnr(struct l2cap_chan *chan)
|
|||
}
|
||||
}
|
||||
|
||||
static void append_skb_frag(struct sk_buff *skb,
|
||||
struct sk_buff *new_frag, struct sk_buff **last_frag)
|
||||
static void append_skb_frag(struct sk_buff *skb, struct sk_buff *new_frag,
|
||||
struct sk_buff **last_frag)
|
||||
{
|
||||
/* skb->len reflects data in skb as well as all fragments
|
||||
* skb->data_len reflects only data in fragments
|
||||
|
@ -4677,7 +4702,7 @@ static u8 l2cap_classify_txseq(struct l2cap_chan *chan, u16 txseq)
|
|||
|
||||
if (chan->rx_state == L2CAP_RX_STATE_SREJ_SENT) {
|
||||
if (__seq_offset(chan, txseq, chan->last_acked_seq) >=
|
||||
chan->tx_win) {
|
||||
chan->tx_win) {
|
||||
/* See notes below regarding "double poll" and
|
||||
* invalid packets.
|
||||
*/
|
||||
|
@ -4718,8 +4743,7 @@ static u8 l2cap_classify_txseq(struct l2cap_chan *chan, u16 txseq)
|
|||
}
|
||||
|
||||
if (__seq_offset(chan, txseq, chan->last_acked_seq) <
|
||||
__seq_offset(chan, chan->expected_tx_seq,
|
||||
chan->last_acked_seq)){
|
||||
__seq_offset(chan, chan->expected_tx_seq, chan->last_acked_seq)) {
|
||||
BT_DBG("Duplicate - expected_tx_seq later than txseq");
|
||||
return L2CAP_TXSEQ_DUPLICATE;
|
||||
}
|
||||
|
@ -5479,7 +5503,7 @@ int l2cap_security_cfm(struct hci_conn *hcon, u8 status, u8 encrypt)
|
|||
}
|
||||
|
||||
if (!status && (chan->state == BT_CONNECTED ||
|
||||
chan->state == BT_CONFIG)) {
|
||||
chan->state == BT_CONFIG)) {
|
||||
struct sock *sk = chan->sk;
|
||||
|
||||
clear_bit(BT_SK_SUSPEND, &bt_sk(sk)->flags);
|
||||
|
@ -5530,7 +5554,7 @@ int l2cap_security_cfm(struct hci_conn *hcon, u8 status, u8 encrypt)
|
|||
rsp.result = cpu_to_le16(res);
|
||||
rsp.status = cpu_to_le16(stat);
|
||||
l2cap_send_cmd(conn, chan->ident, L2CAP_CONN_RSP,
|
||||
sizeof(rsp), &rsp);
|
||||
sizeof(rsp), &rsp);
|
||||
|
||||
if (!test_bit(CONF_REQ_SENT, &chan->conf_state) &&
|
||||
res == L2CAP_CR_SUCCESS) {
|
||||
|
@ -5596,7 +5620,7 @@ int l2cap_recv_acldata(struct hci_conn *hcon, struct sk_buff *skb, u16 flags)
|
|||
|
||||
if (skb->len > len) {
|
||||
BT_ERR("Frame is too long (len %d, expected len %d)",
|
||||
skb->len, len);
|
||||
skb->len, len);
|
||||
l2cap_conn_unreliable(conn, ECOMM);
|
||||
goto drop;
|
||||
}
|
||||
|
@ -5607,7 +5631,7 @@ int l2cap_recv_acldata(struct hci_conn *hcon, struct sk_buff *skb, u16 flags)
|
|||
goto drop;
|
||||
|
||||
skb_copy_from_linear_data(skb, skb_put(conn->rx_skb, skb->len),
|
||||
skb->len);
|
||||
skb->len);
|
||||
conn->rx_len = len - skb->len;
|
||||
} else {
|
||||
BT_DBG("Cont: frag len %d (expecting %d)", skb->len, conn->rx_len);
|
||||
|
@ -5620,7 +5644,7 @@ int l2cap_recv_acldata(struct hci_conn *hcon, struct sk_buff *skb, u16 flags)
|
|||
|
||||
if (skb->len > conn->rx_len) {
|
||||
BT_ERR("Fragment is too long (len %d, expected %d)",
|
||||
skb->len, conn->rx_len);
|
||||
skb->len, conn->rx_len);
|
||||
kfree_skb(conn->rx_skb);
|
||||
conn->rx_skb = NULL;
|
||||
conn->rx_len = 0;
|
||||
|
@ -5629,7 +5653,7 @@ int l2cap_recv_acldata(struct hci_conn *hcon, struct sk_buff *skb, u16 flags)
|
|||
}
|
||||
|
||||
skb_copy_from_linear_data(skb, skb_put(conn->rx_skb, skb->len),
|
||||
skb->len);
|
||||
skb->len);
|
||||
conn->rx_len -= skb->len;
|
||||
|
||||
if (!conn->rx_len) {
|
||||
|
@ -5688,8 +5712,8 @@ int __init l2cap_init(void)
|
|||
return err;
|
||||
|
||||
if (bt_debugfs) {
|
||||
l2cap_debugfs = debugfs_create_file("l2cap", 0444,
|
||||
bt_debugfs, NULL, &l2cap_debugfs_fops);
|
||||
l2cap_debugfs = debugfs_create_file("l2cap", 0444, bt_debugfs,
|
||||
NULL, &l2cap_debugfs_fops);
|
||||
if (!l2cap_debugfs)
|
||||
BT_ERR("Failed to create L2CAP debug file");
|
||||
}
|
||||
|
|
|
@ -40,7 +40,8 @@ static struct bt_sock_list l2cap_sk_list = {
|
|||
|
||||
static const struct proto_ops l2cap_sock_ops;
|
||||
static void l2cap_sock_init(struct sock *sk, struct sock *parent);
|
||||
static struct sock *l2cap_sock_alloc(struct net *net, struct socket *sock, int proto, gfp_t prio);
|
||||
static struct sock *l2cap_sock_alloc(struct net *net, struct socket *sock,
|
||||
int proto, gfp_t prio);
|
||||
|
||||
static int l2cap_sock_bind(struct socket *sock, struct sockaddr *addr, int alen)
|
||||
{
|
||||
|
@ -106,7 +107,8 @@ done:
|
|||
return err;
|
||||
}
|
||||
|
||||
static int l2cap_sock_connect(struct socket *sock, struct sockaddr *addr, int alen, int flags)
|
||||
static int l2cap_sock_connect(struct socket *sock, struct sockaddr *addr,
|
||||
int alen, int flags)
|
||||
{
|
||||
struct sock *sk = sock->sk;
|
||||
struct l2cap_chan *chan = l2cap_pi(sk)->chan;
|
||||
|
@ -134,7 +136,7 @@ static int l2cap_sock_connect(struct socket *sock, struct sockaddr *addr, int al
|
|||
lock_sock(sk);
|
||||
|
||||
err = bt_sock_wait_state(sk, BT_CONNECTED,
|
||||
sock_sndtimeo(sk, flags & O_NONBLOCK));
|
||||
sock_sndtimeo(sk, flags & O_NONBLOCK));
|
||||
|
||||
release_sock(sk);
|
||||
|
||||
|
@ -185,7 +187,8 @@ done:
|
|||
return err;
|
||||
}
|
||||
|
||||
static int l2cap_sock_accept(struct socket *sock, struct socket *newsock, int flags)
|
||||
static int l2cap_sock_accept(struct socket *sock, struct socket *newsock,
|
||||
int flags)
|
||||
{
|
||||
DECLARE_WAITQUEUE(wait, current);
|
||||
struct sock *sk = sock->sk, *nsk;
|
||||
|
@ -241,7 +244,8 @@ done:
|
|||
return err;
|
||||
}
|
||||
|
||||
static int l2cap_sock_getname(struct socket *sock, struct sockaddr *addr, int *len, int peer)
|
||||
static int l2cap_sock_getname(struct socket *sock, struct sockaddr *addr,
|
||||
int *len, int peer)
|
||||
{
|
||||
struct sockaddr_l2 *la = (struct sockaddr_l2 *) addr;
|
||||
struct sock *sk = sock->sk;
|
||||
|
@ -265,7 +269,8 @@ static int l2cap_sock_getname(struct socket *sock, struct sockaddr *addr, int *l
|
|||
return 0;
|
||||
}
|
||||
|
||||
static int l2cap_sock_getsockopt_old(struct socket *sock, int optname, char __user *optval, int __user *optlen)
|
||||
static int l2cap_sock_getsockopt_old(struct socket *sock, int optname,
|
||||
char __user *optval, int __user *optlen)
|
||||
{
|
||||
struct sock *sk = sock->sk;
|
||||
struct l2cap_chan *chan = l2cap_pi(sk)->chan;
|
||||
|
@ -308,7 +313,7 @@ static int l2cap_sock_getsockopt_old(struct socket *sock, int optname, char __us
|
|||
break;
|
||||
case BT_SECURITY_HIGH:
|
||||
opt = L2CAP_LM_AUTH | L2CAP_LM_ENCRYPT |
|
||||
L2CAP_LM_SECURE;
|
||||
L2CAP_LM_SECURE;
|
||||
break;
|
||||
default:
|
||||
opt = 0;
|
||||
|
@ -352,7 +357,8 @@ static int l2cap_sock_getsockopt_old(struct socket *sock, int optname, char __us
|
|||
return err;
|
||||
}
|
||||
|
||||
static int l2cap_sock_getsockopt(struct socket *sock, int level, int optname, char __user *optval, int __user *optlen)
|
||||
static int l2cap_sock_getsockopt(struct socket *sock, int level, int optname,
|
||||
char __user *optval, int __user *optlen)
|
||||
{
|
||||
struct sock *sk = sock->sk;
|
||||
struct l2cap_chan *chan = l2cap_pi(sk)->chan;
|
||||
|
@ -376,7 +382,7 @@ static int l2cap_sock_getsockopt(struct socket *sock, int level, int optname, ch
|
|||
switch (optname) {
|
||||
case BT_SECURITY:
|
||||
if (chan->chan_type != L2CAP_CHAN_CONN_ORIENTED &&
|
||||
chan->chan_type != L2CAP_CHAN_RAW) {
|
||||
chan->chan_type != L2CAP_CHAN_RAW) {
|
||||
err = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
@ -411,14 +417,14 @@ static int l2cap_sock_getsockopt(struct socket *sock, int level, int optname, ch
|
|||
|
||||
case BT_FLUSHABLE:
|
||||
if (put_user(test_bit(FLAG_FLUSHABLE, &chan->flags),
|
||||
(u32 __user *) optval))
|
||||
(u32 __user *) optval))
|
||||
err = -EFAULT;
|
||||
|
||||
break;
|
||||
|
||||
case BT_POWER:
|
||||
if (sk->sk_type != SOCK_SEQPACKET && sk->sk_type != SOCK_STREAM
|
||||
&& sk->sk_type != SOCK_RAW) {
|
||||
&& sk->sk_type != SOCK_RAW) {
|
||||
err = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
@ -466,7 +472,8 @@ static bool l2cap_valid_mtu(struct l2cap_chan *chan, u16 mtu)
|
|||
return true;
|
||||
}
|
||||
|
||||
static int l2cap_sock_setsockopt_old(struct socket *sock, int optname, char __user *optval, unsigned int optlen)
|
||||
static int l2cap_sock_setsockopt_old(struct socket *sock, int optname,
|
||||
char __user *optval, unsigned int optlen)
|
||||
{
|
||||
struct sock *sk = sock->sk;
|
||||
struct l2cap_chan *chan = l2cap_pi(sk)->chan;
|
||||
|
@ -565,7 +572,8 @@ static int l2cap_sock_setsockopt_old(struct socket *sock, int optname, char __us
|
|||
return err;
|
||||
}
|
||||
|
||||
static int l2cap_sock_setsockopt(struct socket *sock, int level, int optname, char __user *optval, unsigned int optlen)
|
||||
static int l2cap_sock_setsockopt(struct socket *sock, int level, int optname,
|
||||
char __user *optval, unsigned int optlen)
|
||||
{
|
||||
struct sock *sk = sock->sk;
|
||||
struct l2cap_chan *chan = l2cap_pi(sk)->chan;
|
||||
|
@ -588,7 +596,7 @@ static int l2cap_sock_setsockopt(struct socket *sock, int level, int optname, ch
|
|||
switch (optname) {
|
||||
case BT_SECURITY:
|
||||
if (chan->chan_type != L2CAP_CHAN_CONN_ORIENTED &&
|
||||
chan->chan_type != L2CAP_CHAN_RAW) {
|
||||
chan->chan_type != L2CAP_CHAN_RAW) {
|
||||
err = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
@ -602,7 +610,7 @@ static int l2cap_sock_setsockopt(struct socket *sock, int level, int optname, ch
|
|||
}
|
||||
|
||||
if (sec.level < BT_SECURITY_LOW ||
|
||||
sec.level > BT_SECURITY_HIGH) {
|
||||
sec.level > BT_SECURITY_HIGH) {
|
||||
err = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
@ -628,7 +636,7 @@ static int l2cap_sock_setsockopt(struct socket *sock, int level, int optname, ch
|
|||
|
||||
/* or for ACL link */
|
||||
} else if ((sk->sk_state == BT_CONNECT2 &&
|
||||
test_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags)) ||
|
||||
test_bit(BT_SK_DEFER_SETUP, &bt_sk(sk)->flags)) ||
|
||||
sk->sk_state == BT_CONNECTED) {
|
||||
if (!l2cap_chan_check_security(chan))
|
||||
set_bit(BT_SK_SUSPEND, &bt_sk(sk)->flags);
|
||||
|
@ -685,7 +693,7 @@ static int l2cap_sock_setsockopt(struct socket *sock, int level, int optname, ch
|
|||
|
||||
case BT_POWER:
|
||||
if (chan->chan_type != L2CAP_CHAN_CONN_ORIENTED &&
|
||||
chan->chan_type != L2CAP_CHAN_RAW) {
|
||||
chan->chan_type != L2CAP_CHAN_RAW) {
|
||||
err = -EINVAL;
|
||||
break;
|
||||
}
|
||||
|
@ -721,7 +729,7 @@ static int l2cap_sock_setsockopt(struct socket *sock, int level, int optname, ch
|
|||
}
|
||||
|
||||
if (chan->mode != L2CAP_MODE_ERTM &&
|
||||
chan->mode != L2CAP_MODE_STREAMING) {
|
||||
chan->mode != L2CAP_MODE_STREAMING) {
|
||||
err = -EOPNOTSUPP;
|
||||
break;
|
||||
}
|
||||
|
@ -738,7 +746,8 @@ static int l2cap_sock_setsockopt(struct socket *sock, int level, int optname, ch
|
|||
return err;
|
||||
}
|
||||
|
||||
static int l2cap_sock_sendmsg(struct kiocb *iocb, struct socket *sock, struct msghdr *msg, size_t len)
|
||||
static int l2cap_sock_sendmsg(struct kiocb *iocb, struct socket *sock,
|
||||
struct msghdr *msg, size_t len)
|
||||
{
|
||||
struct sock *sk = sock->sk;
|
||||
struct l2cap_chan *chan = l2cap_pi(sk)->chan;
|
||||
|
@ -763,7 +772,8 @@ static int l2cap_sock_sendmsg(struct kiocb *iocb, struct socket *sock, struct ms
|
|||
return err;
|
||||
}
|
||||
|
||||
static int l2cap_sock_recvmsg(struct kiocb *iocb, struct socket *sock, struct msghdr *msg, size_t len, int flags)
|
||||
static int l2cap_sock_recvmsg(struct kiocb *iocb, struct socket *sock,
|
||||
struct msghdr *msg, size_t len, int flags)
|
||||
{
|
||||
struct sock *sk = sock->sk;
|
||||
struct l2cap_pinfo *pi = l2cap_pi(sk);
|
||||
|
@ -867,7 +877,7 @@ static int l2cap_sock_shutdown(struct socket *sock, int how)
|
|||
|
||||
if (sock_flag(sk, SOCK_LINGER) && sk->sk_lingertime)
|
||||
err = bt_sock_wait_state(sk, BT_CLOSED,
|
||||
sk->sk_lingertime);
|
||||
sk->sk_lingertime);
|
||||
}
|
||||
|
||||
if (!err && sk->sk_err)
|
||||
|
@ -931,7 +941,7 @@ static struct l2cap_chan *l2cap_sock_new_connection_cb(struct l2cap_chan *chan)
|
|||
}
|
||||
|
||||
sk = l2cap_sock_alloc(sock_net(parent), NULL, BTPROTO_L2CAP,
|
||||
GFP_ATOMIC);
|
||||
GFP_ATOMIC);
|
||||
if (!sk)
|
||||
return NULL;
|
||||
|
||||
|
@ -1161,7 +1171,8 @@ static struct proto l2cap_proto = {
|
|||
.obj_size = sizeof(struct l2cap_pinfo)
|
||||
};
|
||||
|
||||
static struct sock *l2cap_sock_alloc(struct net *net, struct socket *sock, int proto, gfp_t prio)
|
||||
static struct sock *l2cap_sock_alloc(struct net *net, struct socket *sock,
|
||||
int proto, gfp_t prio)
|
||||
{
|
||||
struct sock *sk;
|
||||
struct l2cap_chan *chan;
|
||||
|
@ -1206,7 +1217,7 @@ static int l2cap_sock_create(struct net *net, struct socket *sock, int protocol,
|
|||
sock->state = SS_UNCONNECTED;
|
||||
|
||||
if (sock->type != SOCK_SEQPACKET && sock->type != SOCK_STREAM &&
|
||||
sock->type != SOCK_DGRAM && sock->type != SOCK_RAW)
|
||||
sock->type != SOCK_DGRAM && sock->type != SOCK_RAW)
|
||||
return -ESOCKTNOSUPPORT;
|
||||
|
||||
if (sock->type == SOCK_RAW && !kern && !capable(CAP_NET_RAW))
|
||||
|
@ -1263,7 +1274,8 @@ int __init l2cap_init_sockets(void)
|
|||
goto error;
|
||||
}
|
||||
|
||||
err = bt_procfs_init(THIS_MODULE, &init_net, "l2cap", &l2cap_sk_list, NULL);
|
||||
err = bt_procfs_init(THIS_MODULE, &init_net, "l2cap", &l2cap_sk_list,
|
||||
NULL);
|
||||
if (err < 0) {
|
||||
BT_ERR("Failed to create L2CAP proc file");
|
||||
bt_sock_unregister(BTPROTO_L2CAP);
|
||||
|
|
Загрузка…
Ссылка в новой задаче