67 static int nfc_genl_send_target(struct sk_buff *msg, struct nfc_target *target,  in nfc_genl_send_target()  argument
72 	hdr = genlmsg_put(msg, NETLINK_CB(cb->skb).portid, cb->nlh->nlmsg_seq,  in nfc_genl_send_target()
79 	if (nla_put_u32(msg, NFC_ATTR_TARGET_INDEX, target->idx) ||  in nfc_genl_send_target()
80 	    nla_put_u32(msg, NFC_ATTR_PROTOCOLS, target->supported_protocols) ||  in nfc_genl_send_target()
81 	    nla_put_u16(msg, NFC_ATTR_TARGET_SENS_RES, target->sens_res) ||  in nfc_genl_send_target()
82 	    nla_put_u8(msg, NFC_ATTR_TARGET_SEL_RES, target->sel_res))  in nfc_genl_send_target()
85 	    nla_put(msg, NFC_ATTR_TARGET_NFCID1, target->nfcid1_len,  in nfc_genl_send_target()
89 	    nla_put(msg, NFC_ATTR_TARGET_SENSB_RES, target->sensb_res_len,  in nfc_genl_send_target()
93 	    nla_put(msg, NFC_ATTR_TARGET_SENSF_RES, target->sensf_res_len,  in nfc_genl_send_target()
98 		if (nla_put_u8(msg, NFC_ATTR_TARGET_ISO15693_DSFID,  in nfc_genl_send_target()
100 		    nla_put(msg, NFC_ATTR_TARGET_ISO15693_UID,  in nfc_genl_send_target()
105 	genlmsg_end(msg, hdr);  in nfc_genl_send_target()
109 	genlmsg_cancel(msg, hdr);  in nfc_genl_send_target()
185 	struct sk_buff *msg;  in nfc_genl_targets_found()  local
190 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);  in nfc_genl_targets_found()
191 	if (!msg)  in nfc_genl_targets_found()
194 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_targets_found()
199 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_targets_found()
202 	genlmsg_end(msg, hdr);  in nfc_genl_targets_found()
204 	return genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_ATOMIC);  in nfc_genl_targets_found()
207 	genlmsg_cancel(msg, hdr);  in nfc_genl_targets_found()
209 	nlmsg_free(msg);  in nfc_genl_targets_found()
215 	struct sk_buff *msg;  in nfc_genl_target_lost()  local
218 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_target_lost()
219 	if (!msg)  in nfc_genl_target_lost()
222 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_target_lost()
227 	if (nla_put_string(msg, NFC_ATTR_DEVICE_NAME, nfc_device_name(dev)) ||  in nfc_genl_target_lost()
228 	    nla_put_u32(msg, NFC_ATTR_TARGET_INDEX, target_idx))  in nfc_genl_target_lost()
231 	genlmsg_end(msg, hdr);  in nfc_genl_target_lost()
233 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_target_lost()
238 	genlmsg_cancel(msg, hdr);  in nfc_genl_target_lost()
240 	nlmsg_free(msg);  in nfc_genl_target_lost()
246 	struct sk_buff *msg;  in nfc_genl_tm_activated()  local
249 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_tm_activated()
250 	if (!msg)  in nfc_genl_tm_activated()
253 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_tm_activated()
258 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_tm_activated()
260 	if (nla_put_u32(msg, NFC_ATTR_TM_PROTOCOLS, protocol))  in nfc_genl_tm_activated()
263 	genlmsg_end(msg, hdr);  in nfc_genl_tm_activated()
265 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_tm_activated()
270 	genlmsg_cancel(msg, hdr);  in nfc_genl_tm_activated()
272 	nlmsg_free(msg);  in nfc_genl_tm_activated()
278 	struct sk_buff *msg;  in nfc_genl_tm_deactivated()  local
281 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_tm_deactivated()
282 	if (!msg)  in nfc_genl_tm_deactivated()
285 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_tm_deactivated()
290 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_tm_deactivated()
293 	genlmsg_end(msg, hdr);  in nfc_genl_tm_deactivated()
295 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_tm_deactivated()
300 	genlmsg_cancel(msg, hdr);  in nfc_genl_tm_deactivated()
302 	nlmsg_free(msg);  in nfc_genl_tm_deactivated()
308 	struct sk_buff *msg;  in nfc_genl_device_added()  local
311 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_device_added()
312 	if (!msg)  in nfc_genl_device_added()
315 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_device_added()
320 	if (nla_put_string(msg, NFC_ATTR_DEVICE_NAME, nfc_device_name(dev)) ||  in nfc_genl_device_added()
321 	    nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_device_added()
322 	    nla_put_u32(msg, NFC_ATTR_PROTOCOLS, dev->supported_protocols) ||  in nfc_genl_device_added()
323 	    nla_put_u8(msg, NFC_ATTR_DEVICE_POWERED, dev->dev_up))  in nfc_genl_device_added()
326 	genlmsg_end(msg, hdr);  in nfc_genl_device_added()
328 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_device_added()
333 	genlmsg_cancel(msg, hdr);  in nfc_genl_device_added()
335 	nlmsg_free(msg);  in nfc_genl_device_added()
341 	struct sk_buff *msg;  in nfc_genl_device_removed()  local
344 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_device_removed()
345 	if (!msg)  in nfc_genl_device_removed()
348 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_device_removed()
353 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_device_removed()
356 	genlmsg_end(msg, hdr);  in nfc_genl_device_removed()
358 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_device_removed()
363 	genlmsg_cancel(msg, hdr);  in nfc_genl_device_removed()
365 	nlmsg_free(msg);  in nfc_genl_device_removed()
371 	struct sk_buff *msg;  in nfc_genl_llc_send_sdres()  local
379 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_llc_send_sdres()
380 	if (!msg)  in nfc_genl_llc_send_sdres()
383 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_llc_send_sdres()
388 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_llc_send_sdres()
391 	sdp_attr = nla_nest_start(msg, NFC_ATTR_LLC_SDP);  in nfc_genl_llc_send_sdres()
401 		uri_attr = nla_nest_start(msg, i++);  in nfc_genl_llc_send_sdres()
407 		if (nla_put_u8(msg, NFC_SDP_ATTR_SAP, sdres->sap))  in nfc_genl_llc_send_sdres()
410 		if (nla_put_string(msg, NFC_SDP_ATTR_URI, sdres->uri))  in nfc_genl_llc_send_sdres()
413 		nla_nest_end(msg, uri_attr);  in nfc_genl_llc_send_sdres()
420 	nla_nest_end(msg, sdp_attr);  in nfc_genl_llc_send_sdres()
422 	genlmsg_end(msg, hdr);  in nfc_genl_llc_send_sdres()
424 	return genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_ATOMIC);  in nfc_genl_llc_send_sdres()
427 	genlmsg_cancel(msg, hdr);  in nfc_genl_llc_send_sdres()
430 	nlmsg_free(msg);  in nfc_genl_llc_send_sdres()
439 	struct sk_buff *msg;  in nfc_genl_se_added()  local
442 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_se_added()
443 	if (!msg)  in nfc_genl_se_added()
446 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_se_added()
451 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_se_added()
452 	    nla_put_u32(msg, NFC_ATTR_SE_INDEX, se_idx) ||  in nfc_genl_se_added()
453 	    nla_put_u8(msg, NFC_ATTR_SE_TYPE, type))  in nfc_genl_se_added()
456 	genlmsg_end(msg, hdr);  in nfc_genl_se_added()
458 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_se_added()
463 	genlmsg_cancel(msg, hdr);  in nfc_genl_se_added()
465 	nlmsg_free(msg);  in nfc_genl_se_added()
471 	struct sk_buff *msg;  in nfc_genl_se_removed()  local
474 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_se_removed()
475 	if (!msg)  in nfc_genl_se_removed()
478 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_se_removed()
483 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_se_removed()
484 	    nla_put_u32(msg, NFC_ATTR_SE_INDEX, se_idx))  in nfc_genl_se_removed()
487 	genlmsg_end(msg, hdr);  in nfc_genl_se_removed()
489 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_se_removed()
494 	genlmsg_cancel(msg, hdr);  in nfc_genl_se_removed()
496 	nlmsg_free(msg);  in nfc_genl_se_removed()
504 	struct sk_buff *msg;  in nfc_genl_se_transaction()  local
507 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_se_transaction()
508 	if (!msg)  in nfc_genl_se_transaction()
511 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_se_transaction()
520 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_se_transaction()
521 	    nla_put_u32(msg, NFC_ATTR_SE_INDEX, se_idx) ||  in nfc_genl_se_transaction()
522 	    nla_put_u8(msg, NFC_ATTR_SE_TYPE, se->type) ||  in nfc_genl_se_transaction()
523 	    nla_put(msg, NFC_ATTR_SE_AID, evt_transaction->aid_len,  in nfc_genl_se_transaction()
525 	    nla_put(msg, NFC_ATTR_SE_PARAMS, evt_transaction->params_len,  in nfc_genl_se_transaction()
532 	genlmsg_end(msg, hdr);  in nfc_genl_se_transaction()
534 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_se_transaction()
539 	genlmsg_cancel(msg, hdr);  in nfc_genl_se_transaction()
543 	nlmsg_free(msg);  in nfc_genl_se_transaction()
547 static int nfc_genl_send_device(struct sk_buff *msg, struct nfc_dev *dev,  in nfc_genl_send_device()  argument
554 	hdr = genlmsg_put(msg, portid, seq, &nfc_genl_family, flags,  in nfc_genl_send_device()
562 	if (nla_put_string(msg, NFC_ATTR_DEVICE_NAME, nfc_device_name(dev)) ||  in nfc_genl_send_device()
563 	    nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_send_device()
564 	    nla_put_u32(msg, NFC_ATTR_PROTOCOLS, dev->supported_protocols) ||  in nfc_genl_send_device()
565 	    nla_put_u8(msg, NFC_ATTR_DEVICE_POWERED, dev->dev_up) ||  in nfc_genl_send_device()
566 	    nla_put_u8(msg, NFC_ATTR_RF_MODE, dev->rf_mode))  in nfc_genl_send_device()
569 	genlmsg_end(msg, hdr);  in nfc_genl_send_device()
573 	genlmsg_cancel(msg, hdr);  in nfc_genl_send_device()
632 	struct sk_buff *msg;  in nfc_genl_dep_link_up_event()  local
637 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);  in nfc_genl_dep_link_up_event()
638 	if (!msg)  in nfc_genl_dep_link_up_event()
641 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0, NFC_CMD_DEP_LINK_UP);  in nfc_genl_dep_link_up_event()
645 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_dep_link_up_event()
648 	    nla_put_u32(msg, NFC_ATTR_TARGET_INDEX, target_idx))  in nfc_genl_dep_link_up_event()
650 	if (nla_put_u8(msg, NFC_ATTR_COMM_MODE, comm_mode) ||  in nfc_genl_dep_link_up_event()
651 	    nla_put_u8(msg, NFC_ATTR_RF_MODE, rf_mode))  in nfc_genl_dep_link_up_event()
654 	genlmsg_end(msg, hdr);  in nfc_genl_dep_link_up_event()
658 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_ATOMIC);  in nfc_genl_dep_link_up_event()
663 	genlmsg_cancel(msg, hdr);  in nfc_genl_dep_link_up_event()
665 	nlmsg_free(msg);  in nfc_genl_dep_link_up_event()
671 	struct sk_buff *msg;  in nfc_genl_dep_link_down_event()  local
676 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);  in nfc_genl_dep_link_down_event()
677 	if (!msg)  in nfc_genl_dep_link_down_event()
680 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_dep_link_down_event()
685 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_dep_link_down_event()
688 	genlmsg_end(msg, hdr);  in nfc_genl_dep_link_down_event()
690 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_ATOMIC);  in nfc_genl_dep_link_down_event()
695 	genlmsg_cancel(msg, hdr);  in nfc_genl_dep_link_down_event()
697 	nlmsg_free(msg);  in nfc_genl_dep_link_down_event()
703 	struct sk_buff *msg;  in nfc_genl_get_device()  local
717 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_get_device()
718 	if (!msg) {  in nfc_genl_get_device()
723 	rc = nfc_genl_send_device(msg, dev, info->snd_portid, info->snd_seq,  in nfc_genl_get_device()
730 	return genlmsg_reply(msg, info);  in nfc_genl_get_device()
733 	nlmsg_free(msg);  in nfc_genl_get_device()
943 static int nfc_genl_send_params(struct sk_buff *msg,  in nfc_genl_send_params()  argument
949 	hdr = genlmsg_put(msg, portid, seq, &nfc_genl_family, 0,  in nfc_genl_send_params()
954 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, local->dev->idx) ||  in nfc_genl_send_params()
955 	    nla_put_u8(msg, NFC_ATTR_LLC_PARAM_LTO, local->lto) ||  in nfc_genl_send_params()
956 	    nla_put_u8(msg, NFC_ATTR_LLC_PARAM_RW, local->rw) ||  in nfc_genl_send_params()
957 	    nla_put_u16(msg, NFC_ATTR_LLC_PARAM_MIUX, be16_to_cpu(local->miux)))  in nfc_genl_send_params()
960 	genlmsg_end(msg, hdr);  in nfc_genl_send_params()
965 	genlmsg_cancel(msg, hdr);  in nfc_genl_send_params()
974 	struct sk_buff *msg = NULL;  in nfc_genl_llc_get_params()  local
994 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_llc_get_params()
995 	if (!msg) {  in nfc_genl_llc_get_params()
1000 	rc = nfc_genl_send_params(msg, local, info->snd_portid, info->snd_seq);  in nfc_genl_llc_get_params()
1008 		if (msg)  in nfc_genl_llc_get_params()
1009 			nlmsg_free(msg);  in nfc_genl_llc_get_params()
1014 	return genlmsg_reply(msg, info);  in nfc_genl_llc_get_params()
1202 	struct sk_buff *msg;  in nfc_genl_fw_download_done()  local
1205 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in nfc_genl_fw_download_done()
1206 	if (!msg)  in nfc_genl_fw_download_done()
1209 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in nfc_genl_fw_download_done()
1214 	if (nla_put_string(msg, NFC_ATTR_FIRMWARE_NAME, firmware_name) ||  in nfc_genl_fw_download_done()
1215 	    nla_put_u32(msg, NFC_ATTR_FIRMWARE_DOWNLOAD_STATUS, result) ||  in nfc_genl_fw_download_done()
1216 	    nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx))  in nfc_genl_fw_download_done()
1219 	genlmsg_end(msg, hdr);  in nfc_genl_fw_download_done()
1221 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in nfc_genl_fw_download_done()
1226 	genlmsg_cancel(msg, hdr);  in nfc_genl_fw_download_done()
1228 	nlmsg_free(msg);  in nfc_genl_fw_download_done()
1278 static int nfc_genl_send_se(struct sk_buff *msg, struct nfc_dev *dev,  in nfc_genl_send_se()  argument
1287 		hdr = genlmsg_put(msg, portid, seq, &nfc_genl_family, flags,  in nfc_genl_send_se()
1295 		if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||  in nfc_genl_send_se()
1296 		    nla_put_u32(msg, NFC_ATTR_SE_INDEX, se->idx) ||  in nfc_genl_send_se()
1297 		    nla_put_u8(msg, NFC_ATTR_SE_TYPE, se->type))  in nfc_genl_send_se()
1300 		genlmsg_end(msg, hdr);  in nfc_genl_send_se()
1306 	genlmsg_cancel(msg, hdr);  in nfc_genl_send_se()
1415 	struct sk_buff *msg;  in se_io_cb()  local
1418 	msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);  in se_io_cb()
1419 	if (!msg) {  in se_io_cb()
1424 	hdr = genlmsg_put(msg, 0, 0, &nfc_genl_family, 0,  in se_io_cb()
1429 	if (nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, ctx->dev_idx) ||  in se_io_cb()
1430 	    nla_put_u32(msg, NFC_ATTR_SE_INDEX, ctx->se_idx) ||  in se_io_cb()
1431 	    nla_put(msg, NFC_ATTR_SE_APDU, apdu_len, apdu))  in se_io_cb()
1434 	genlmsg_end(msg, hdr);  in se_io_cb()
1436 	genlmsg_multicast(&nfc_genl_family, msg, 0, 0, GFP_KERNEL);  in se_io_cb()
1443 	genlmsg_cancel(msg, hdr);  in se_io_cb()
1445 	nlmsg_free(msg);  in se_io_cb()