net/nfc/llcp_core.c

202 					       u8 ssap, u8 dsap)
207 	pr_debug("ssap dsap %d %d\n", ssap, dsap);
209 	if (ssap == 0 && dsap == 0)
219 		if (tmp_sock->ssap == ssap && tmp_sock->dsap == dsap) {
416 		int ssap = nfc_llcp_wks_sap(sock->service_name,
419 		if (ssap > 0) {
420 			pr_debug("WKS %d\n", ssap);
423 			if (test_bit(ssap, &local->local_wks)) {
429 			set_bit(ssap, &local->local_wks);
432 			return ssap;
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;
484 void nfc_llcp_put_ssap(struct nfc_llcp_local *local, u8 ssap)
489 	if (ssap < LLCP_WKS_NUM_SAP) {
490 		local_ssap = ssap;
492 	} else if (ssap < LLCP_LOCAL_NUM_SAP) {
495 		local_ssap = ssap - LLCP_WKS_NUM_SAP;
506 			pr_debug("No more clients for SAP %d\n", ssap);
511 			l_sock = nfc_llcp_sock_get(local, ssap, LLCP_SAP_SDP);
513 				l_sock->ssap = LLCP_SDP_UNBOUND;
521 	} else if (ssap < LLCP_MAX_SAP) {
522 		local_ssap = ssap - LLCP_LOCAL_NUM_SAP;
537 	u8 ssap;
541 	ssap = find_first_zero_bit(&local->local_sdp, LLCP_SDP_NUM_SAP);
542 	if (ssap == LLCP_SDP_NUM_SAP) {
548 	pr_debug("SDP ssap %d\n", LLCP_WKS_NUM_SAP + ssap);
550 	set_bit(ssap, &local->local_sdp);
554 	return LLCP_WKS_NUM_SAP + ssap;
815 							  u8 ssap)
825 		if (llcp_sock->ssap == ssap) {
874 	u8 dsap, ssap;
877 	ssap = nfc_llcp_ssap(skb);
881 	ui_cb->ssap = ssap;
883 	pr_debug("%d %d\n", dsap, ssap);
910 	u8 dsap, ssap, reason;
913 	ssap = nfc_llcp_ssap(skb);
915 	pr_debug("%d %d\n", dsap, ssap);
953 	if (sock->ssap == LLCP_SDP_UNBOUND) {
954 		u8 ssap = nfc_llcp_reserve_sdp_ssap(local);
956 		pr_debug("First client, reserving %d\n", ssap);
958 		if (ssap == LLCP_SAP_MAX) {
965 		sock->ssap = ssap;
991 	new_sock->dsap = ssap;
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;
1033 	nfc_llcp_send_dm(local, dsap, ssap, reason);
1069 	u8 dsap, ssap, ptype, ns, nr;
1073 	ssap = nfc_llcp_ssap(skb);
1077 	pr_debug("%d %d R %d S %d\n", dsap, ssap, nr, ns);
1079 	llcp_sock = nfc_llcp_sock_get(local, dsap, ssap);
1081 		nfc_llcp_send_dm(local, dsap, ssap, LLCP_DM_NOCONN);
1156 	u8 dsap, ssap;
1159 	ssap = nfc_llcp_ssap(skb);
1161 	if ((dsap == 0) && (ssap == 0)) {
1167 	llcp_sock = nfc_llcp_sock_get(local, dsap, ssap);
1169 		nfc_llcp_send_dm(local, dsap, ssap, LLCP_DM_NOCONN);
1189 	nfc_llcp_send_dm(local, dsap, ssap, LLCP_DM_DISC);
1200 	u8 dsap, ssap;
1203 	ssap = nfc_llcp_ssap(skb);
1208 		nfc_llcp_send_dm(local, dsap, ssap, LLCP_DM_NOCONN);
1218 	llcp_sock->dsap = ssap;
1234 	u8 dsap, ssap, reason;
1237 	ssap = nfc_llcp_ssap(skb);
1240 	pr_debug("%d %d reason %d\n", ssap, dsap, reason);
1249 		llcp_sock = nfc_llcp_sock_get(local, dsap, ssap);
1271 	u8 dsap, ssap, type, length, tid, sap;
1282 	ssap = nfc_llcp_ssap(skb);
1284 	pr_debug("%d %d\n", dsap, ssap);
1286 	if (dsap != LLCP_SAP_SDP || ssap != LLCP_SAP_SDP) {
1324 			 * We found a socket but its ssap has not been reserved
1326 			 * The ssap will be freed when the socket is closed.
1328 			if (llcp_sock->ssap == LLCP_SDP_UNBOUND) {
1347 				llcp_sock->ssap = sap;
1350 				sap = llcp_sock->ssap;
1452 	u8 dsap, ssap, ptype;
1456 	ssap = nfc_llcp_ssap(skb);
1458 	pr_debug("ptype 0x%x dsap 0x%x ssap 0x%x\n", ptype, dsap, ssap);