linux-imx

/*

 * Copyright (C) 2011  Intel Corporation. All rights reserved.

 * Copyright (C) 2014 Marvell International Ltd.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License as published by

 * the Free Software Foundation; either version 2 of the License, or

 * (at your option) any later version.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the

 * GNU General Public License for more details.

 *

 * You should have received a copy of the GNU General Public License

 * along with this program; if not, see <http://www.gnu.org/licenses/>.

 */

​

#define pr_fmt(fmt) "llcp: %s: " fmt, __func__

​

#include <linux/init.h>

#include <linux/kernel.h>

#include <linux/list.h>

#include <linux/nfc.h>

​

#include "nfc.h"

#include "llcp.h"

​

static u8 llcp_magic[3] = {0x46, 0x66, 0x6d};

​

static LIST_HEAD(llcp_devices);

​

static void nfc_llcp_rx_skb(struct nfc_llcp_local *local, struct sk_buff *skb);

​

void nfc_llcp_sock_link(struct llcp_sock_list *l, struct sock *sk)

{

    write_lock(&l->lock);

    sk_add_node(sk, &l->head);

    write_unlock(&l->lock);

}

​

void nfc_llcp_sock_unlink(struct llcp_sock_list *l, struct sock *sk)

{

    write_lock(&l->lock);

    sk_del_node_init(sk);

    write_unlock(&l->lock);

}

​

void nfc_llcp_socket_remote_param_init(struct nfc_llcp_sock *sock)

{

    sock->remote_rw = LLCP_DEFAULT_RW;

    sock->remote_miu = LLCP_MAX_MIU + 1;

}

​

static void nfc_llcp_socket_purge(struct nfc_llcp_sock *sock)

{

    struct nfc_llcp_local *local = sock->local;

    struct sk_buff *s, *tmp;

​

    pr_debug("%p\n", &sock->sk);

​

    skb_queue_purge(&sock->tx_queue);

    skb_queue_purge(&sock->tx_pending_queue);

​

    if (local == NULL)

        return;

​

    /* Search for local pending SKBs that are related to this socket */

    skb_queue_walk_safe(&local->tx_queue, s, tmp) {

        if (s->sk != &sock->sk)

            continue;

​

        skb_unlink(s, &local->tx_queue);

        kfree_skb(s);

    }

}

​

static void nfc_llcp_socket_release(struct nfc_llcp_local *local, bool device,

                    int err)

{

    struct sock *sk;

    struct hlist_node *tmp;

    struct nfc_llcp_sock *llcp_sock;

​

    skb_queue_purge(&local->tx_queue);

​

    write_lock(&local->sockets.lock);

​

    sk_for_each_safe(sk, tmp, &local->sockets.head) {

        llcp_sock = nfc_llcp_sock(sk);

​

        bh_lock_sock(sk);