NFC: llcp: Terminate connection when receiving a DISC on (0,0)

According to the LLCP specs, we must terminate the LLCP link when receiving
a DISC with both ssap and dsap set to 0.

Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>

1 files changed, 6 insertions, 0 deletions

diff --git a/net/nfc/llcp/llcp.c b/net/nfc/llcp/llcp.c
index 3a161c87ef78..9e483c8e52f8 100644
--- a/net/nfc/llcp/llcp.c
+++ b/net/nfc/llcp/llcp.c
@@ -1106,6 +1106,12 @@ static void nfc_llcp_recv_disc(struct nfc_llcp_local *local,
         dsap = nfc_llcp_dsap(skb);
         ssap = nfc_llcp_ssap(skb);
 
+        if ((dsap == 0) && (ssap == 0)) {
+                pr_debug("Connection termination");
+                nfc_dep_link_down(local->dev);
+                return;
+        }
+
         llcp_sock = nfc_llcp_sock_get(local, dsap, ssap);
         if (llcp_sock == NULL) {
                 nfc_llcp_send_dm(local, dsap, ssap, LLCP_DM_NOCONN);