Bluetooth: move l2cap_sock_connect() to l2cap_sock.c
Signed-off-by: Gustavo F. Padovan <padovan@profusion.mobi>
This commit is contained in:
@@ -437,8 +437,8 @@ void l2cap_sock_kill(struct sock *sk);
|
|||||||
void l2cap_sock_init(struct sock *sk, struct sock *parent);
|
void l2cap_sock_init(struct sock *sk, struct sock *parent);
|
||||||
struct sock *l2cap_sock_alloc(struct net *net, struct socket *sock,
|
struct sock *l2cap_sock_alloc(struct net *net, struct socket *sock,
|
||||||
int proto, gfp_t prio);
|
int proto, gfp_t prio);
|
||||||
|
int l2cap_do_connect(struct sock *sk);
|
||||||
|
|
||||||
int l2cap_sock_connect(struct socket *sock, struct sockaddr *addr, int alen, int flags);
|
|
||||||
int l2cap_sock_sendmsg(struct kiocb *iocb, struct socket *sock, struct msghdr *msg, size_t len);
|
int l2cap_sock_sendmsg(struct kiocb *iocb, struct socket *sock, struct msghdr *msg, size_t len);
|
||||||
int l2cap_sock_recvmsg(struct kiocb *iocb, struct socket *sock, struct msghdr *msg, size_t len, int flags);
|
int l2cap_sock_recvmsg(struct kiocb *iocb, struct socket *sock, struct msghdr *msg, size_t len, int flags);
|
||||||
int l2cap_sock_shutdown(struct socket *sock, int how);
|
int l2cap_sock_shutdown(struct socket *sock, int how);
|
||||||
|
@@ -848,7 +848,7 @@ static void l2cap_sock_close(struct sock *sk)
|
|||||||
l2cap_sock_kill(sk);
|
l2cap_sock_kill(sk);
|
||||||
}
|
}
|
||||||
|
|
||||||
static int l2cap_do_connect(struct sock *sk)
|
int l2cap_do_connect(struct sock *sk)
|
||||||
{
|
{
|
||||||
bdaddr_t *src = &bt_sk(sk)->src;
|
bdaddr_t *src = &bt_sk(sk)->src;
|
||||||
bdaddr_t *dst = &bt_sk(sk)->dst;
|
bdaddr_t *dst = &bt_sk(sk)->dst;
|
||||||
@@ -908,91 +908,6 @@ done:
|
|||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
|
||||||
int l2cap_sock_connect(struct socket *sock, struct sockaddr *addr, int alen, int flags)
|
|
||||||
{
|
|
||||||
struct sock *sk = sock->sk;
|
|
||||||
struct sockaddr_l2 la;
|
|
||||||
int len, err = 0;
|
|
||||||
|
|
||||||
BT_DBG("sk %p", sk);
|
|
||||||
|
|
||||||
if (!addr || alen < sizeof(addr->sa_family) ||
|
|
||||||
addr->sa_family != AF_BLUETOOTH)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
memset(&la, 0, sizeof(la));
|
|
||||||
len = min_t(unsigned int, sizeof(la), alen);
|
|
||||||
memcpy(&la, addr, len);
|
|
||||||
|
|
||||||
if (la.l2_cid)
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
lock_sock(sk);
|
|
||||||
|
|
||||||
if ((sk->sk_type == SOCK_SEQPACKET || sk->sk_type == SOCK_STREAM)
|
|
||||||
&& !la.l2_psm) {
|
|
||||||
err = -EINVAL;
|
|
||||||
goto done;
|
|
||||||
}
|
|
||||||
|
|
||||||
switch (l2cap_pi(sk)->mode) {
|
|
||||||
case L2CAP_MODE_BASIC:
|
|
||||||
break;
|
|
||||||
case L2CAP_MODE_ERTM:
|
|
||||||
case L2CAP_MODE_STREAMING:
|
|
||||||
if (!disable_ertm)
|
|
||||||
break;
|
|
||||||
/* fall through */
|
|
||||||
default:
|
|
||||||
err = -ENOTSUPP;
|
|
||||||
goto done;
|
|
||||||
}
|
|
||||||
|
|
||||||
switch (sk->sk_state) {
|
|
||||||
case BT_CONNECT:
|
|
||||||
case BT_CONNECT2:
|
|
||||||
case BT_CONFIG:
|
|
||||||
/* Already connecting */
|
|
||||||
goto wait;
|
|
||||||
|
|
||||||
case BT_CONNECTED:
|
|
||||||
/* Already connected */
|
|
||||||
err = -EISCONN;
|
|
||||||
goto done;
|
|
||||||
|
|
||||||
case BT_OPEN:
|
|
||||||
case BT_BOUND:
|
|
||||||
/* Can connect */
|
|
||||||
break;
|
|
||||||
|
|
||||||
default:
|
|
||||||
err = -EBADFD;
|
|
||||||
goto done;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* PSM must be odd and lsb of upper byte must be 0 */
|
|
||||||
if ((__le16_to_cpu(la.l2_psm) & 0x0101) != 0x0001 &&
|
|
||||||
sk->sk_type != SOCK_RAW) {
|
|
||||||
err = -EINVAL;
|
|
||||||
goto done;
|
|
||||||
}
|
|
||||||
|
|
||||||
/* Set destination address and psm */
|
|
||||||
bacpy(&bt_sk(sk)->dst, &la.l2_bdaddr);
|
|
||||||
l2cap_pi(sk)->psm = la.l2_psm;
|
|
||||||
|
|
||||||
err = l2cap_do_connect(sk);
|
|
||||||
if (err)
|
|
||||||
goto done;
|
|
||||||
|
|
||||||
wait:
|
|
||||||
err = bt_sock_wait_state(sk, BT_CONNECTED,
|
|
||||||
sock_sndtimeo(sk, flags & O_NONBLOCK));
|
|
||||||
done:
|
|
||||||
release_sock(sk);
|
|
||||||
return err;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int __l2cap_wait_ack(struct sock *sk)
|
static int __l2cap_wait_ack(struct sock *sk)
|
||||||
{
|
{
|
||||||
DECLARE_WAITQUEUE(wait, current);
|
DECLARE_WAITQUEUE(wait, current);
|
||||||
|
@@ -139,6 +139,91 @@ done:
|
|||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int l2cap_sock_connect(struct socket *sock, struct sockaddr *addr, int alen, int flags)
|
||||||
|
{
|
||||||
|
struct sock *sk = sock->sk;
|
||||||
|
struct sockaddr_l2 la;
|
||||||
|
int len, err = 0;
|
||||||
|
|
||||||
|
BT_DBG("sk %p", sk);
|
||||||
|
|
||||||
|
if (!addr || alen < sizeof(addr->sa_family) ||
|
||||||
|
addr->sa_family != AF_BLUETOOTH)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
memset(&la, 0, sizeof(la));
|
||||||
|
len = min_t(unsigned int, sizeof(la), alen);
|
||||||
|
memcpy(&la, addr, len);
|
||||||
|
|
||||||
|
if (la.l2_cid)
|
||||||
|
return -EINVAL;
|
||||||
|
|
||||||
|
lock_sock(sk);
|
||||||
|
|
||||||
|
if ((sk->sk_type == SOCK_SEQPACKET || sk->sk_type == SOCK_STREAM)
|
||||||
|
&& !la.l2_psm) {
|
||||||
|
err = -EINVAL;
|
||||||
|
goto done;
|
||||||
|
}
|
||||||
|
|
||||||
|
switch (l2cap_pi(sk)->mode) {
|
||||||
|
case L2CAP_MODE_BASIC:
|
||||||
|
break;
|
||||||
|
case L2CAP_MODE_ERTM:
|
||||||
|
case L2CAP_MODE_STREAMING:
|
||||||
|
if (!disable_ertm)
|
||||||
|
break;
|
||||||
|
/* fall through */
|
||||||
|
default:
|
||||||
|
err = -ENOTSUPP;
|
||||||
|
goto done;
|
||||||
|
}
|
||||||
|
|
||||||
|
switch (sk->sk_state) {
|
||||||
|
case BT_CONNECT:
|
||||||
|
case BT_CONNECT2:
|
||||||
|
case BT_CONFIG:
|
||||||
|
/* Already connecting */
|
||||||
|
goto wait;
|
||||||
|
|
||||||
|
case BT_CONNECTED:
|
||||||
|
/* Already connected */
|
||||||
|
err = -EISCONN;
|
||||||
|
goto done;
|
||||||
|
|
||||||
|
case BT_OPEN:
|
||||||
|
case BT_BOUND:
|
||||||
|
/* Can connect */
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
err = -EBADFD;
|
||||||
|
goto done;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* PSM must be odd and lsb of upper byte must be 0 */
|
||||||
|
if ((__le16_to_cpu(la.l2_psm) & 0x0101) != 0x0001 &&
|
||||||
|
sk->sk_type != SOCK_RAW) {
|
||||||
|
err = -EINVAL;
|
||||||
|
goto done;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Set destination address and psm */
|
||||||
|
bacpy(&bt_sk(sk)->dst, &la.l2_bdaddr);
|
||||||
|
l2cap_pi(sk)->psm = la.l2_psm;
|
||||||
|
|
||||||
|
err = l2cap_do_connect(sk);
|
||||||
|
if (err)
|
||||||
|
goto done;
|
||||||
|
|
||||||
|
wait:
|
||||||
|
err = bt_sock_wait_state(sk, BT_CONNECTED,
|
||||||
|
sock_sndtimeo(sk, flags & O_NONBLOCK));
|
||||||
|
done:
|
||||||
|
release_sock(sk);
|
||||||
|
return err;
|
||||||
|
}
|
||||||
|
|
||||||
static int l2cap_sock_listen(struct socket *sock, int backlog)
|
static int l2cap_sock_listen(struct socket *sock, int backlog)
|
||||||
{
|
{
|
||||||
struct sock *sk = sock->sk;
|
struct sock *sk = sock->sk;
|
||||||
|
Reference in New Issue
Block a user