75 static int nfc_genl_send_target(struct sk_buff *msg, struct nfc_target *target,  in nfc_genl_send_target()  argument
80 	hdr = genlmsg_put(msg, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,  in nfc_genl_send_target()
87 	if (nla_put_u32(msg, NFC_ATTR_TARGET_INDEX, target->idx) ||  in nfc_genl_send_target()
88 	    nla_put_u32(msg, NFC_ATTR_PROTOCOLS, target->supported_protocols) ||  in nfc_genl_send_target()
89 	    nla_put_u16(msg, NFC_ATTR_TARGET_SENS_RES, target->sens_res) ||  in nfc_genl_send_target()
90 	    nla_put_u8(msg, NFC_ATTR_TARGET_SEL_RES, target->sel_res))  in nfc_genl_send_target()
93 	    nla_put(msg, NFC_ATTR_TARGET_NFCID1, target->nfcid1_len,  in nfc_genl_send_target()
97 	    nla_put(msg, NFC_ATTR_TARGET_SENSB_RES, target->sensb_res_len,  in nfc_genl_send_target()
101 	    nla_put(msg, NFC_ATTR_TARGET_SENSF_RES, target->sensf_res_len,  in nfc_genl_send_target()
106 		if (nla_put_u8(msg, NFC_ATTR_TARGET_ISO15693_DSFID,  in nfc_genl_send_target()
108 		    nla_put(msg, NFC_ATTR_TARGET_ISO15693_UID,  in nfc_genl_send_target()
113 	genlmsg_end(msg, hdr);  in nfc_genl_send_target()
117 	genlmsg_cancel(msg, hdr);  in nfc_genl_send_target()
193 	struct sk_buff *msg;  in nfc_genl_targets_found()  local
198 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);  in nfc_genl_targets_found()
199 	if (!msg)  in nfc_genl_targets_found()
202 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_targets_found()
207 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_targets_found()
210 	genlmsg_end(msg, hdr);  in nfc_genl_targets_found()
212 	return genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_ATOMIC);  in nfc_genl_targets_found()
215 	genlmsg_cancel(msg, hdr);  in nfc_genl_targets_found()
217 	nlmsg_free(msg);  in nfc_genl_targets_found()
223 	struct sk_buff *msg;  in nfc_genl_target_lost()  local
226 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_target_lost()
227 	if (!msg)  in nfc_genl_target_lost()
230 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_target_lost()
235 	if (nla_put_string(msg, NFC_ATTR_DEVICE_NAME, nfc_device_name(dev)) ||  in nfc_genl_target_lost()
236 	    nla_put_u32(msg, NFC_ATTR_TARGET_INDEX, target_idx))  in nfc_genl_target_lost()
239 	genlmsg_end(msg, hdr);  in nfc_genl_target_lost()
241 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_target_lost()
246 	genlmsg_cancel(msg, hdr);  in nfc_genl_target_lost()
248 	nlmsg_free(msg);  in nfc_genl_target_lost()
254 	struct sk_buff *msg;  in nfc_genl_tm_activated()  local
257 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_tm_activated()
258 	if (!msg)  in nfc_genl_tm_activated()
261 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_tm_activated()
266 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_tm_activated()
268 	if (nla_put_u32(msg, NFC_ATTR_TM_PROTOCOLS, protocol))  in nfc_genl_tm_activated()
271 	genlmsg_end(msg, hdr);  in nfc_genl_tm_activated()
273 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_tm_activated()
278 	genlmsg_cancel(msg, hdr);  in nfc_genl_tm_activated()
280 	nlmsg_free(msg);  in nfc_genl_tm_activated()
286 	struct sk_buff *msg;  in nfc_genl_tm_deactivated()  local
289 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_tm_deactivated()
290 	if (!msg)  in nfc_genl_tm_deactivated()
293 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_tm_deactivated()
298 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_tm_deactivated()
301 	genlmsg_end(msg, hdr);  in nfc_genl_tm_deactivated()
303 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_tm_deactivated()
308 	genlmsg_cancel(msg, hdr);  in nfc_genl_tm_deactivated()
310 	nlmsg_free(msg);  in nfc_genl_tm_deactivated()
316 	struct sk_buff *msg;  in nfc_genl_device_added()  local
319 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_device_added()
320 	if (!msg)  in nfc_genl_device_added()
323 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_device_added()
328 	if (nla_put_string(msg, NFC_ATTR_DEVICE_NAME, nfc_device_name(dev)) ||  in nfc_genl_device_added()
329 	    nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_device_added()
330 	    nla_put_u32(msg, NFC_ATTR_PROTOCOLS, dev->supported_protocols) ||  in nfc_genl_device_added()
331 	    nla_put_u8(msg, NFC_ATTR_DEVICE_POWERED, dev->dev_up))  in nfc_genl_device_added()
334 	genlmsg_end(msg, hdr);  in nfc_genl_device_added()
336 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_device_added()
341 	genlmsg_cancel(msg, hdr);  in nfc_genl_device_added()
343 	nlmsg_free(msg);  in nfc_genl_device_added()
349 	struct sk_buff *msg;  in nfc_genl_device_removed()  local
352 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_device_removed()
353 	if (!msg)  in nfc_genl_device_removed()
356 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_device_removed()
361 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_device_removed()
364 	genlmsg_end(msg, hdr);  in nfc_genl_device_removed()
366 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_device_removed()
371 	genlmsg_cancel(msg, hdr);  in nfc_genl_device_removed()
373 	nlmsg_free(msg);  in nfc_genl_device_removed()
379 	struct sk_buff *msg;  in nfc_genl_llc_send_sdres()  local
387 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_llc_send_sdres()
388 	if (!msg)  in nfc_genl_llc_send_sdres()
391 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_llc_send_sdres()
396 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_llc_send_sdres()
399 	sdp_attr = nla_nest_start(msg, NFC_ATTR_LLC_SDP);  in nfc_genl_llc_send_sdres()
409 		uri_attr = nla_nest_start(msg, i++);  in nfc_genl_llc_send_sdres()
415 		if (nla_put_u8(msg, NFC_SDP_ATTR_SAP, sdres->sap))  in nfc_genl_llc_send_sdres()
418 		if (nla_put_string(msg, NFC_SDP_ATTR_URI, sdres->uri))  in nfc_genl_llc_send_sdres()
421 		nla_nest_end(msg, uri_attr);  in nfc_genl_llc_send_sdres()
428 	nla_nest_end(msg, sdp_attr);  in nfc_genl_llc_send_sdres()
430 	genlmsg_end(msg, hdr);  in nfc_genl_llc_send_sdres()
432 	return genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_ATOMIC);  in nfc_genl_llc_send_sdres()
435 	genlmsg_cancel(msg, hdr);  in nfc_genl_llc_send_sdres()
438 	nlmsg_free(msg);  in nfc_genl_llc_send_sdres()
447 	struct sk_buff *msg;  in nfc_genl_se_added()  local
450 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_se_added()
451 	if (!msg)  in nfc_genl_se_added()
454 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_se_added()
459 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_se_added()
460 	    nla_put_u32(msg, NFC_ATTR_SE_INDEX, se_idx) ||  in nfc_genl_se_added()
461 	    nla_put_u8(msg, NFC_ATTR_SE_TYPE, type))  in nfc_genl_se_added()
464 	genlmsg_end(msg, hdr);  in nfc_genl_se_added()
466 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_se_added()
471 	genlmsg_cancel(msg, hdr);  in nfc_genl_se_added()
473 	nlmsg_free(msg);  in nfc_genl_se_added()
479 	struct sk_buff *msg;  in nfc_genl_se_removed()  local
482 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_se_removed()
483 	if (!msg)  in nfc_genl_se_removed()
486 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_se_removed()
491 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_se_removed()
492 	    nla_put_u32(msg, NFC_ATTR_SE_INDEX, se_idx))  in nfc_genl_se_removed()
495 	genlmsg_end(msg, hdr);  in nfc_genl_se_removed()
497 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_se_removed()
502 	genlmsg_cancel(msg, hdr);  in nfc_genl_se_removed()
504 	nlmsg_free(msg);  in nfc_genl_se_removed()
512 	struct sk_buff *msg;  in nfc_genl_se_transaction()  local
515 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_se_transaction()
516 	if (!msg)  in nfc_genl_se_transaction()
519 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_se_transaction()
528 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_se_transaction()
529 	    nla_put_u32(msg, NFC_ATTR_SE_INDEX, se_idx) ||  in nfc_genl_se_transaction()
530 	    nla_put_u8(msg, NFC_ATTR_SE_TYPE, se->type) ||  in nfc_genl_se_transaction()
531 	    nla_put(msg, NFC_ATTR_SE_AID, evt_transaction->aid_len,  in nfc_genl_se_transaction()
533 	    nla_put(msg, NFC_ATTR_SE_PARAMS, evt_transaction->params_len,  in nfc_genl_se_transaction()
540 	genlmsg_end(msg, hdr);  in nfc_genl_se_transaction()
542 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_se_transaction()
547 	genlmsg_cancel(msg, hdr);  in nfc_genl_se_transaction()
551 	nlmsg_free(msg);  in nfc_genl_se_transaction()
555 static int nfc_genl_send_device(struct sk_buff *msg, struct nfc_dev *dev,  in nfc_genl_send_device()  argument
562 	hdr = genlmsg_put(msg, portid, seq, &nfc_genl_family, flags,  in nfc_genl_send_device()
570 	if (nla_put_string(msg, NFC_ATTR_DEVICE_NAME, nfc_device_name(dev)) ||  in nfc_genl_send_device()
571 	    nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_send_device()
572 	    nla_put_u32(msg, NFC_ATTR_PROTOCOLS, dev->supported_protocols) ||  in nfc_genl_send_device()
573 	    nla_put_u8(msg, NFC_ATTR_DEVICE_POWERED, dev->dev_up) ||  in nfc_genl_send_device()
574 	    nla_put_u8(msg, NFC_ATTR_RF_MODE, dev->rf_mode))  in nfc_genl_send_device()
577 	genlmsg_end(msg, hdr);  in nfc_genl_send_device()
581 	genlmsg_cancel(msg, hdr);  in nfc_genl_send_device()
640 	struct sk_buff *msg;  in nfc_genl_dep_link_up_event()  local
645 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);  in nfc_genl_dep_link_up_event()
646 	if (!msg)  in nfc_genl_dep_link_up_event()
649 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0, NFC_CMD_DEP_LINK_UP);  in nfc_genl_dep_link_up_event()
653 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_dep_link_up_event()
656 	    nla_put_u32(msg, NFC_ATTR_TARGET_INDEX, target_idx))  in nfc_genl_dep_link_up_event()
658 	if (nla_put_u8(msg, NFC_ATTR_COMM_MODE, comm_mode) ||  in nfc_genl_dep_link_up_event()
659 	    nla_put_u8(msg, NFC_ATTR_RF_MODE, rf_mode))  in nfc_genl_dep_link_up_event()
662 	genlmsg_end(msg, hdr);  in nfc_genl_dep_link_up_event()
666 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_ATOMIC);  in nfc_genl_dep_link_up_event()
671 	genlmsg_cancel(msg, hdr);  in nfc_genl_dep_link_up_event()
673 	nlmsg_free(msg);  in nfc_genl_dep_link_up_event()
679 	struct sk_buff *msg;  in nfc_genl_dep_link_down_event()  local
684 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);  in nfc_genl_dep_link_down_event()
685 	if (!msg)  in nfc_genl_dep_link_down_event()
688 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_dep_link_down_event()
693 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_dep_link_down_event()
696 	genlmsg_end(msg, hdr);  in nfc_genl_dep_link_down_event()
698 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_ATOMIC);  in nfc_genl_dep_link_down_event()
703 	genlmsg_cancel(msg, hdr);  in nfc_genl_dep_link_down_event()
705 	nlmsg_free(msg);  in nfc_genl_dep_link_down_event()
711 	struct sk_buff *msg;  in nfc_genl_get_device()  local
725 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_get_device()
726 	if (!msg) {  in nfc_genl_get_device()
731 	rc = nfc_genl_send_device(msg, dev, info->snd_portid, info->snd_seq,  in nfc_genl_get_device()
738 	return genlmsg_reply(msg, info);  in nfc_genl_get_device()
741 	nlmsg_free(msg);  in nfc_genl_get_device()
951 static int nfc_genl_send_params(struct sk_buff *msg,  in nfc_genl_send_params()  argument
957 	hdr = genlmsg_put(msg, portid, seq, &nfc_genl_family, 0,  in nfc_genl_send_params()
962 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, local->dev->idx) ||  in nfc_genl_send_params()
963 	    nla_put_u8(msg, NFC_ATTR_LLC_PARAM_LTO, local->lto) ||  in nfc_genl_send_params()
964 	    nla_put_u8(msg, NFC_ATTR_LLC_PARAM_RW, local->rw) ||  in nfc_genl_send_params()
965 	    nla_put_u16(msg, NFC_ATTR_LLC_PARAM_MIUX, be16_to_cpu(local->miux)))  in nfc_genl_send_params()
968 	genlmsg_end(msg, hdr);  in nfc_genl_send_params()
973 	genlmsg_cancel(msg, hdr);  in nfc_genl_send_params()
982 	struct sk_buff *msg = NULL;  in nfc_genl_llc_get_params()  local
1002 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_llc_get_params()
1003 	if (!msg) {  in nfc_genl_llc_get_params()
1008 	rc = nfc_genl_send_params(msg, local, info->snd_portid, info->snd_seq);  in nfc_genl_llc_get_params()
1016 		if (msg)  in nfc_genl_llc_get_params()
1017 			nlmsg_free(msg);  in nfc_genl_llc_get_params()
1022 	return genlmsg_reply(msg, info);  in nfc_genl_llc_get_params()
1208 	struct sk_buff *msg;  in nfc_genl_fw_download_done()  local
1211 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_fw_download_done()
1212 	if (!msg)  in nfc_genl_fw_download_done()
1215 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_fw_download_done()
1220 	if (nla_put_string(msg, NFC_ATTR_FIRMWARE_NAME, firmware_name) ||  in nfc_genl_fw_download_done()
1221 	    nla_put_u32(msg, NFC_ATTR_FIRMWARE_DOWNLOAD_STATUS, result) ||  in nfc_genl_fw_download_done()
1222 	    nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_fw_download_done()
1225 	genlmsg_end(msg, hdr);  in nfc_genl_fw_download_done()
1227 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_fw_download_done()
1232 	genlmsg_cancel(msg, hdr);  in nfc_genl_fw_download_done()
1234 	nlmsg_free(msg);  in nfc_genl_fw_download_done()
1284 static int nfc_genl_send_se(struct sk_buff *msg, struct nfc_dev *dev,  in nfc_genl_send_se()  argument
1293 		hdr = genlmsg_put(msg, portid, seq, &nfc_genl_family, flags,  in nfc_genl_send_se()
1301 		if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_send_se()
1302 		    nla_put_u32(msg, NFC_ATTR_SE_INDEX, se->idx) ||  in nfc_genl_send_se()
1303 		    nla_put_u8(msg, NFC_ATTR_SE_TYPE, se->type))  in nfc_genl_send_se()
1306 		genlmsg_end(msg, hdr);  in nfc_genl_send_se()
1312 	genlmsg_cancel(msg, hdr);  in nfc_genl_send_se()
1421 	struct sk_buff *msg;  in se_io_cb()  local
1424 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in se_io_cb()
1425 	if (!msg) {  in se_io_cb()
1430 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in se_io_cb()
1435 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, ctx->dev_idx) ||  in se_io_cb()
1436 	    nla_put_u32(msg, NFC_ATTR_SE_INDEX, ctx->se_idx) ||  in se_io_cb()
1437 	    nla_put(msg, NFC_ATTR_SE_APDU, apdu_len, apdu))  in se_io_cb()
1440 	genlmsg_end(msg, hdr);  in se_io_cb()
1442 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in se_io_cb()
1449 	genlmsg_cancel(msg, hdr);  in se_io_cb()
1451 	nlmsg_free(msg);  in se_io_cb()