net/nfc/llcp_core.c

25 void nfc_llcp_sock_link(struct llcp_sock_list *l, struct sock *sk)
32 void nfc_llcp_sock_unlink(struct llcp_sock_list *l, struct sock *sk)
39 void nfc_llcp_socket_remote_param_init(struct nfc_llcp_sock *sock)
41 	sock->remote_rw = LLCP_DEFAULT_RW;
42 	sock->remote_miu = LLCP_MAX_MIU + 1;
45 static void nfc_llcp_socket_purge(struct nfc_llcp_sock *sock)
47 	struct nfc_llcp_local *local = sock->local;
50 	skb_queue_purge(&sock->tx_queue);
51 	skb_queue_purge(&sock->tx_pending_queue);
58 		if (s->sk != &sock->sk)
69 	struct sock *sk;
89 			struct sock *accept_sk;
204 	struct sock *sk;
231 static void nfc_llcp_sock_put(struct nfc_llcp_sock *sock)
233 	sock_put(&sock->sk);
363 	struct sock *sk;
378 		pr_debug("llcp sock %p\n", tmp_sock);
405 	pr_debug("Found llcp sock %p\n", llcp_sock);
411 			 struct nfc_llcp_sock *sock)
415 	if (sock->service_name != NULL && sock->service_name_len > 0) {
416 		int ssap = nfc_llcp_wks_sap(sock->service_name,
417 					    sock->service_name_len);
439 		if (nfc_llcp_sock_from_sn(local, sock->service_name,
440 					  sock->service_name_len,
451 	} else if (sock->ssap != 0 && sock->ssap < LLCP_WKS_NUM_SAP) {
452 		if (!test_bit(sock->ssap, &local->local_wks)) {
453 			set_bit(sock->ssap, &local->local_wks);
456 			return sock->ssap;
510 			/* Find the listening sock and set it back to UNBOUND */
710 static void nfc_llcp_set_nrns(struct nfc_llcp_sock *sock, struct sk_buff *pdu)
712 	pdu->data[2] = (sock->send_n << 4) | (sock->recv_n);
713 	sock->send_n = (sock->send_n + 1) % 16;
714 	sock->recv_ack_n = (sock->recv_n - 1) % 16;
721 	struct sock *sk;
762 	struct sock *sk;
817 	struct sock *sk;
908 	struct sock *new_sk, *parent;
909 	struct nfc_llcp_sock *sock, *new_sock;
918 		sock = nfc_llcp_sock_get(local, dsap, LLCP_SAP_SDP);
919 		if (sock == NULL || sock->sk.sk_state != LLCP_LISTEN) {
935 		sock = nfc_llcp_sock_get_sn(local, sn, sn_len);
936 		if (sock == NULL) {
942 	lock_sock(&sock->sk);
944 	parent = &sock->sk;
948 		release_sock(&sock->sk);
949 		sock_put(&sock->sk);
953 	if (sock->ssap == LLCP_SDP_UNBOUND) {
960 			release_sock(&sock->sk);
961 			sock_put(&sock->sk);
965 		sock->ssap = ssap;
971 		release_sock(&sock->sk);
972 		sock_put(&sock->sk);
982 		release_sock(&sock->sk);
983 		sock_put(&sock->sk);
988 	new_sock->rw = sock->rw;
989 	new_sock->miux = sock->miux;
990 	new_sock->nfc_protocol = sock->nfc_protocol;
994 	new_sock->ssap = sock->ssap;
995 	if (sock->ssap < LLCP_LOCAL_NUM_SAP && sock->ssap >= LLCP_WKS_NUM_SAP) {
998 		pr_debug("reserved_ssap %d for %p\n", sock->ssap, new_sock);
1001 			&local->local_sdp_cnt[sock->ssap - LLCP_WKS_NUM_SAP];
1004 		new_sock->reserved_ssap = sock->ssap;
1010 	pr_debug("new sock %p sk %p\n", new_sock, &new_sock->sk);
1014 	nfc_llcp_accept_enqueue(&sock->sk, new_sk);
1026 	release_sock(&sock->sk);
1027 	sock_put(&sock->sk);
1036 int nfc_llcp_queue_i_frames(struct nfc_llcp_sock *sock)
1039 	struct nfc_llcp_local *local = sock->local;
1042 		 sock->remote_ready, skb_queue_len(&sock->tx_pending_queue),
1043 		 sock->remote_rw);
1046 	while (sock->remote_ready &&
1047 	       skb_queue_len(&sock->tx_pending_queue) < sock->remote_rw) {
1050 		pdu = skb_dequeue(&sock->tx_queue);
1055 		nfc_llcp_set_nrns(sock, pdu);
1068 	struct sock *sk;
1155 	struct sock *sk;
1199 	struct sock *sk;
1233 	struct sock *sk;