Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 5c0560b7 authored by Samuel Ortiz's avatar Samuel Ortiz Committed by John W. Linville
Browse files

NFC: Handle LLCP Disconnected Mode frames 



When receiving such frame, the sockets waiting for a connection to finish
should be woken up. Connecting to an unbound LLCP service will trigger a
DM as a response.

Signed-off-by: default avatarSamuel Ortiz <sameo@linux.intel.com>
parent 8f50020e

net/nfc/llcp/llcp.c

+44 −0
Original line number Original line Diff line number Diff line
@@ -958,6 +958,45 @@ static void nfc_llcp_recv_cc(struct nfc_llcp_local *local, struct sk_buff *skb) 
	nfc_llcp_sock_put(llcp_sock);

	nfc_llcp_sock_put(llcp_sock);

}

}





static void nfc_llcp_recv_dm(struct nfc_llcp_local *local, struct sk_buff *skb)

{

	struct nfc_llcp_sock *llcp_sock;

	struct sock *sk;

	u8 dsap, ssap, reason;



	dsap = nfc_llcp_dsap(skb);

	ssap = nfc_llcp_ssap(skb);

	reason = skb->data[2];



	pr_debug("%d %d reason %d\n", ssap, dsap, reason);



	switch (reason) {

	case LLCP_DM_NOBOUND:

	case LLCP_DM_REJ:

		llcp_sock = nfc_llcp_connecting_sock_get(local, dsap);

		break;



	default:

		llcp_sock = nfc_llcp_sock_get(local, dsap, ssap);

		break;

	}



	if (llcp_sock == NULL) {

		pr_err("Invalid DM\n");

		return;

	}



	sk = &llcp_sock->sk;



	sk->sk_err = ENXIO;

	sk->sk_state = LLCP_CLOSED;

	sk->sk_state_change(sk);



	nfc_llcp_sock_put(llcp_sock);



	return;

}



static void nfc_llcp_rx_work(struct work_struct *work)

static void nfc_llcp_rx_work(struct work_struct *work)

{

{

	struct nfc_llcp_local *local = container_of(work, struct nfc_llcp_local,

	struct nfc_llcp_local *local = container_of(work, struct nfc_llcp_local,
@@ -1001,6 +1040,11 @@ static void nfc_llcp_rx_work(struct work_struct *work) 
		nfc_llcp_recv_cc(local, skb);

		nfc_llcp_recv_cc(local, skb);

		break;

		break;





	case LLCP_PDU_DM:

		pr_debug("DM\n");

		nfc_llcp_recv_dm(local, skb);

		break;



	case LLCP_PDU_I:

	case LLCP_PDU_I:

	case LLCP_PDU_RR:

	case LLCP_PDU_RR:

	case LLCP_PDU_RNR:

	case LLCP_PDU_RNR: