Commit 73ffa904 authored by Gustavo F. Padovan's avatar Gustavo F. Padovan

Bluetooth: Move conf_{req,rsp} stuff to struct l2cap_chan

They are also l2cap_chan specific.
Signed-off-by: default avatarGustavo F. Padovan <padovan@profusion.mobi>
parent fc7f8a7e
...@@ -281,6 +281,11 @@ struct l2cap_chan { ...@@ -281,6 +281,11 @@ struct l2cap_chan {
struct sock *sk; struct sock *sk;
__u8 ident; __u8 ident;
__u8 conf_req[64];
__u8 conf_len;
__u8 num_conf_req;
__u8 num_conf_rsp;
struct list_head list; struct list_head list;
}; };
...@@ -337,8 +342,6 @@ struct l2cap_pinfo { ...@@ -337,8 +342,6 @@ struct l2cap_pinfo {
__u16 omtu; __u16 omtu;
__u16 flush_to; __u16 flush_to;
__u8 mode; __u8 mode;
__u8 num_conf_req;
__u8 num_conf_rsp;
__u8 fcs; __u8 fcs;
__u8 sec_level; __u8 sec_level;
...@@ -346,8 +349,6 @@ struct l2cap_pinfo { ...@@ -346,8 +349,6 @@ struct l2cap_pinfo {
__u8 force_reliable; __u8 force_reliable;
__u8 flushable; __u8 flushable;
__u8 conf_req[64];
__u8 conf_len;
__u8 conf_state; __u8 conf_state;
__u16 conn_state; __u16 conn_state;
...@@ -447,7 +448,7 @@ void l2cap_cleanup_sockets(void); ...@@ -447,7 +448,7 @@ void l2cap_cleanup_sockets(void);
u8 l2cap_get_ident(struct l2cap_conn *conn); u8 l2cap_get_ident(struct l2cap_conn *conn);
void l2cap_send_cmd(struct l2cap_conn *conn, u8 ident, u8 code, u16 len, void *data); void l2cap_send_cmd(struct l2cap_conn *conn, u8 ident, u8 code, u16 len, void *data);
int l2cap_build_conf_req(struct sock *sk, void *data); int l2cap_build_conf_req(struct l2cap_chan *chan, void *data);
int __l2cap_wait_ack(struct sock *sk); int __l2cap_wait_ack(struct sock *sk);
struct sk_buff *l2cap_create_connless_pdu(struct sock *sk, struct msghdr *msg, size_t len); struct sk_buff *l2cap_create_connless_pdu(struct sock *sk, struct msghdr *msg, size_t len);
......
...@@ -569,8 +569,8 @@ static void l2cap_conn_start(struct l2cap_conn *conn) ...@@ -569,8 +569,8 @@ static void l2cap_conn_start(struct l2cap_conn *conn)
l2cap_pi(sk)->conf_state |= L2CAP_CONF_REQ_SENT; l2cap_pi(sk)->conf_state |= L2CAP_CONF_REQ_SENT;
l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ, l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ,
l2cap_build_conf_req(sk, buf), buf); l2cap_build_conf_req(chan, buf), buf);
l2cap_pi(sk)->num_conf_req++; chan->num_conf_req++;
} }
bh_unlock_sock(sk); bh_unlock_sock(sk);
...@@ -1598,8 +1598,9 @@ static inline __u8 l2cap_select_mode(__u8 mode, __u16 remote_feat_mask) ...@@ -1598,8 +1598,9 @@ static inline __u8 l2cap_select_mode(__u8 mode, __u16 remote_feat_mask)
} }
} }
int l2cap_build_conf_req(struct sock *sk, void *data) int l2cap_build_conf_req(struct l2cap_chan *chan, void *data)
{ {
struct sock *sk = chan->sk;
struct l2cap_pinfo *pi = l2cap_pi(sk); struct l2cap_pinfo *pi = l2cap_pi(sk);
struct l2cap_conf_req *req = data; struct l2cap_conf_req *req = data;
struct l2cap_conf_rfc rfc = { .mode = pi->mode }; struct l2cap_conf_rfc rfc = { .mode = pi->mode };
...@@ -1607,7 +1608,7 @@ int l2cap_build_conf_req(struct sock *sk, void *data) ...@@ -1607,7 +1608,7 @@ int l2cap_build_conf_req(struct sock *sk, void *data)
BT_DBG("sk %p", sk); BT_DBG("sk %p", sk);
if (pi->num_conf_req || pi->num_conf_rsp) if (chan->num_conf_req || chan->num_conf_rsp)
goto done; goto done;
switch (pi->mode) { switch (pi->mode) {
...@@ -1696,20 +1697,20 @@ int l2cap_build_conf_req(struct sock *sk, void *data) ...@@ -1696,20 +1697,20 @@ int l2cap_build_conf_req(struct sock *sk, void *data)
return ptr - data; return ptr - data;
} }
static int l2cap_parse_conf_req(struct sock *sk, void *data) static int l2cap_parse_conf_req(struct l2cap_chan *chan, void *data)
{ {
struct l2cap_pinfo *pi = l2cap_pi(sk); struct l2cap_pinfo *pi = l2cap_pi(chan->sk);
struct l2cap_conf_rsp *rsp = data; struct l2cap_conf_rsp *rsp = data;
void *ptr = rsp->data; void *ptr = rsp->data;
void *req = pi->conf_req; void *req = chan->conf_req;
int len = pi->conf_len; int len = chan->conf_len;
int type, hint, olen; int type, hint, olen;
unsigned long val; unsigned long val;
struct l2cap_conf_rfc rfc = { .mode = L2CAP_MODE_BASIC }; struct l2cap_conf_rfc rfc = { .mode = L2CAP_MODE_BASIC };
u16 mtu = L2CAP_DEFAULT_MTU; u16 mtu = L2CAP_DEFAULT_MTU;
u16 result = L2CAP_CONF_SUCCESS; u16 result = L2CAP_CONF_SUCCESS;
BT_DBG("sk %p", sk); BT_DBG("chan %p", chan);
while (len >= L2CAP_CONF_OPT_SIZE) { while (len >= L2CAP_CONF_OPT_SIZE) {
len -= l2cap_get_conf_opt(&req, &type, &olen, &val); len -= l2cap_get_conf_opt(&req, &type, &olen, &val);
...@@ -1750,7 +1751,7 @@ static int l2cap_parse_conf_req(struct sock *sk, void *data) ...@@ -1750,7 +1751,7 @@ static int l2cap_parse_conf_req(struct sock *sk, void *data)
} }
} }
if (pi->num_conf_rsp || pi->num_conf_req > 1) if (chan->num_conf_rsp || chan->num_conf_req > 1)
goto done; goto done;
switch (pi->mode) { switch (pi->mode) {
...@@ -1773,7 +1774,7 @@ static int l2cap_parse_conf_req(struct sock *sk, void *data) ...@@ -1773,7 +1774,7 @@ static int l2cap_parse_conf_req(struct sock *sk, void *data)
result = L2CAP_CONF_UNACCEPT; result = L2CAP_CONF_UNACCEPT;
rfc.mode = pi->mode; rfc.mode = pi->mode;
if (pi->num_conf_rsp == 1) if (chan->num_conf_rsp == 1)
return -ECONNREFUSED; return -ECONNREFUSED;
l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC, l2cap_add_conf_opt(&ptr, L2CAP_CONF_RFC,
...@@ -1992,7 +1993,7 @@ static inline int l2cap_connect_req(struct l2cap_conn *conn, struct l2cap_cmd_hd ...@@ -1992,7 +1993,7 @@ static inline int l2cap_connect_req(struct l2cap_conn *conn, struct l2cap_cmd_hd
{ {
struct l2cap_conn_req *req = (struct l2cap_conn_req *) data; struct l2cap_conn_req *req = (struct l2cap_conn_req *) data;
struct l2cap_conn_rsp rsp; struct l2cap_conn_rsp rsp;
struct l2cap_chan *chan; struct l2cap_chan *chan = NULL;
struct sock *parent, *sk = NULL; struct sock *parent, *sk = NULL;
int result, status = L2CAP_CS_NO_INFO; int result, status = L2CAP_CS_NO_INFO;
...@@ -2115,13 +2116,13 @@ static inline int l2cap_connect_req(struct l2cap_conn *conn, struct l2cap_cmd_hd ...@@ -2115,13 +2116,13 @@ static inline int l2cap_connect_req(struct l2cap_conn *conn, struct l2cap_cmd_hd
L2CAP_INFO_REQ, sizeof(info), &info); L2CAP_INFO_REQ, sizeof(info), &info);
} }
if (sk && !(l2cap_pi(sk)->conf_state & L2CAP_CONF_REQ_SENT) && if (chan && !(l2cap_pi(sk)->conf_state & L2CAP_CONF_REQ_SENT) &&
result == L2CAP_CR_SUCCESS) { result == L2CAP_CR_SUCCESS) {
u8 buf[128]; u8 buf[128];
l2cap_pi(sk)->conf_state |= L2CAP_CONF_REQ_SENT; l2cap_pi(sk)->conf_state |= L2CAP_CONF_REQ_SENT;
l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ, l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ,
l2cap_build_conf_req(sk, buf), buf); l2cap_build_conf_req(chan, buf), buf);
l2cap_pi(sk)->num_conf_req++; chan->num_conf_req++;
} }
return 0; return 0;
...@@ -2167,8 +2168,8 @@ static inline int l2cap_connect_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hd ...@@ -2167,8 +2168,8 @@ static inline int l2cap_connect_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hd
l2cap_pi(sk)->conf_state |= L2CAP_CONF_REQ_SENT; l2cap_pi(sk)->conf_state |= L2CAP_CONF_REQ_SENT;
l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ, l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ,
l2cap_build_conf_req(sk, req), req); l2cap_build_conf_req(chan, req), req);
l2cap_pi(sk)->num_conf_req++; chan->num_conf_req++;
break; break;
case L2CAP_CR_PEND: case L2CAP_CR_PEND:
...@@ -2234,7 +2235,7 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr ...@@ -2234,7 +2235,7 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr
/* Reject if config buffer is too small. */ /* Reject if config buffer is too small. */
len = cmd_len - sizeof(*req); len = cmd_len - sizeof(*req);
if (l2cap_pi(sk)->conf_len + len > sizeof(l2cap_pi(sk)->conf_req)) { if (chan->conf_len + len > sizeof(chan->conf_req)) {
l2cap_send_cmd(conn, cmd->ident, L2CAP_CONF_RSP, l2cap_send_cmd(conn, cmd->ident, L2CAP_CONF_RSP,
l2cap_build_conf_rsp(sk, rsp, l2cap_build_conf_rsp(sk, rsp,
L2CAP_CONF_REJECT, flags), rsp); L2CAP_CONF_REJECT, flags), rsp);
...@@ -2242,8 +2243,8 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr ...@@ -2242,8 +2243,8 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr
} }
/* Store config. */ /* Store config. */
memcpy(l2cap_pi(sk)->conf_req + l2cap_pi(sk)->conf_len, req->data, len); memcpy(chan->conf_req + chan->conf_len, req->data, len);
l2cap_pi(sk)->conf_len += len; chan->conf_len += len;
if (flags & 0x0001) { if (flags & 0x0001) {
/* Incomplete config. Send empty response. */ /* Incomplete config. Send empty response. */
...@@ -2254,17 +2255,17 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr ...@@ -2254,17 +2255,17 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr
} }
/* Complete config. */ /* Complete config. */
len = l2cap_parse_conf_req(sk, rsp); len = l2cap_parse_conf_req(chan, rsp);
if (len < 0) { if (len < 0) {
l2cap_send_disconn_req(conn, sk, ECONNRESET); l2cap_send_disconn_req(conn, sk, ECONNRESET);
goto unlock; goto unlock;
} }
l2cap_send_cmd(conn, cmd->ident, L2CAP_CONF_RSP, len, rsp); l2cap_send_cmd(conn, cmd->ident, L2CAP_CONF_RSP, len, rsp);
l2cap_pi(sk)->num_conf_rsp++; chan->num_conf_rsp++;
/* Reset config buffer. */ /* Reset config buffer. */
l2cap_pi(sk)->conf_len = 0; chan->conf_len = 0;
if (!(l2cap_pi(sk)->conf_state & L2CAP_CONF_OUTPUT_DONE)) if (!(l2cap_pi(sk)->conf_state & L2CAP_CONF_OUTPUT_DONE))
goto unlock; goto unlock;
...@@ -2288,8 +2289,8 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr ...@@ -2288,8 +2289,8 @@ static inline int l2cap_config_req(struct l2cap_conn *conn, struct l2cap_cmd_hdr
u8 buf[64]; u8 buf[64];
l2cap_pi(sk)->conf_state |= L2CAP_CONF_REQ_SENT; l2cap_pi(sk)->conf_state |= L2CAP_CONF_REQ_SENT;
l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ, l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ,
l2cap_build_conf_req(sk, buf), buf); l2cap_build_conf_req(chan, buf), buf);
l2cap_pi(sk)->num_conf_req++; chan->num_conf_req++;
} }
unlock: unlock:
...@@ -2324,7 +2325,7 @@ static inline int l2cap_config_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hdr ...@@ -2324,7 +2325,7 @@ static inline int l2cap_config_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hdr
break; break;
case L2CAP_CONF_UNACCEPT: case L2CAP_CONF_UNACCEPT:
if (l2cap_pi(sk)->num_conf_rsp <= L2CAP_CONF_MAX_CONF_RSP) { if (chan->num_conf_rsp <= L2CAP_CONF_MAX_CONF_RSP) {
char req[64]; char req[64];
if (len > sizeof(req) - sizeof(struct l2cap_conf_req)) { if (len > sizeof(req) - sizeof(struct l2cap_conf_req)) {
...@@ -2343,7 +2344,7 @@ static inline int l2cap_config_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hdr ...@@ -2343,7 +2344,7 @@ static inline int l2cap_config_rsp(struct l2cap_conn *conn, struct l2cap_cmd_hdr
l2cap_send_cmd(conn, l2cap_get_ident(conn), l2cap_send_cmd(conn, l2cap_get_ident(conn),
L2CAP_CONF_REQ, len, req); L2CAP_CONF_REQ, len, req);
l2cap_pi(sk)->num_conf_req++; chan->num_conf_req++;
if (result != L2CAP_CONF_SUCCESS) if (result != L2CAP_CONF_SUCCESS)
goto done; goto done;
break; break;
......
...@@ -810,6 +810,7 @@ static int l2cap_sock_recvmsg(struct kiocb *iocb, struct socket *sock, struct ms ...@@ -810,6 +810,7 @@ static int l2cap_sock_recvmsg(struct kiocb *iocb, struct socket *sock, struct ms
if (sk->sk_state == BT_CONNECT2 && bt_sk(sk)->defer_setup) { if (sk->sk_state == BT_CONNECT2 && bt_sk(sk)->defer_setup) {
struct l2cap_conn_rsp rsp; struct l2cap_conn_rsp rsp;
struct l2cap_conn *conn = l2cap_pi(sk)->conn; struct l2cap_conn *conn = l2cap_pi(sk)->conn;
struct l2cap_chan *chan = l2cap_pi(sk)->chan;
u8 buf[128]; u8 buf[128];
sk->sk_state = BT_CONFIG; sk->sk_state = BT_CONFIG;
...@@ -818,7 +819,7 @@ static int l2cap_sock_recvmsg(struct kiocb *iocb, struct socket *sock, struct ms ...@@ -818,7 +819,7 @@ static int l2cap_sock_recvmsg(struct kiocb *iocb, struct socket *sock, struct ms
rsp.dcid = cpu_to_le16(l2cap_pi(sk)->scid); rsp.dcid = cpu_to_le16(l2cap_pi(sk)->scid);
rsp.result = cpu_to_le16(L2CAP_CR_SUCCESS); rsp.result = cpu_to_le16(L2CAP_CR_SUCCESS);
rsp.status = cpu_to_le16(L2CAP_CS_NO_INFO); rsp.status = cpu_to_le16(L2CAP_CS_NO_INFO);
l2cap_send_cmd(l2cap_pi(sk)->conn, l2cap_pi(sk)->chan->ident, l2cap_send_cmd(l2cap_pi(sk)->conn, chan->ident,
L2CAP_CONN_RSP, sizeof(rsp), &rsp); L2CAP_CONN_RSP, sizeof(rsp), &rsp);
if (l2cap_pi(sk)->conf_state & L2CAP_CONF_REQ_SENT) { if (l2cap_pi(sk)->conf_state & L2CAP_CONF_REQ_SENT) {
...@@ -828,8 +829,8 @@ static int l2cap_sock_recvmsg(struct kiocb *iocb, struct socket *sock, struct ms ...@@ -828,8 +829,8 @@ static int l2cap_sock_recvmsg(struct kiocb *iocb, struct socket *sock, struct ms
l2cap_pi(sk)->conf_state |= L2CAP_CONF_REQ_SENT; l2cap_pi(sk)->conf_state |= L2CAP_CONF_REQ_SENT;
l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ, l2cap_send_cmd(conn, l2cap_get_ident(conn), L2CAP_CONF_REQ,
l2cap_build_conf_req(sk, buf), buf); l2cap_build_conf_req(chan, buf), buf);
l2cap_pi(sk)->num_conf_req++; chan->num_conf_req++;
release_sock(sk); release_sock(sk);
return 0; return 0;
...@@ -1035,7 +1036,6 @@ void l2cap_sock_init(struct sock *sk, struct sock *parent) ...@@ -1035,7 +1036,6 @@ void l2cap_sock_init(struct sock *sk, struct sock *parent)
} }
/* Default config options */ /* Default config options */
pi->conf_len = 0;
pi->flush_to = L2CAP_DEFAULT_FLUSH_TO; pi->flush_to = L2CAP_DEFAULT_FLUSH_TO;
skb_queue_head_init(TX_QUEUE(sk)); skb_queue_head_init(TX_QUEUE(sk));
skb_queue_head_init(SREJ_QUEUE(sk)); skb_queue_head_init(SREJ_QUEUE(sk));
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment