|
@@ -303,6 +303,17 @@ free_msg:
|
|
|
return -EMSGSIZE;
|
|
|
}
|
|
|
|
|
|
+static int nfc_genl_setup_device_added(struct nfc_dev *dev, struct sk_buff *msg)
|
|
|
+{
|
|
|
+ if (nla_put_string(msg, NFC_ATTR_DEVICE_NAME, nfc_device_name(dev)) ||
|
|
|
+ nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||
|
|
|
+ nla_put_u32(msg, NFC_ATTR_PROTOCOLS, dev->supported_protocols) ||
|
|
|
+ nla_put_u8(msg, NFC_ATTR_DEVICE_POWERED, dev->dev_up) ||
|
|
|
+ nla_put_u8(msg, NFC_ATTR_RF_MODE, dev->rf_mode))
|
|
|
+ return -1;
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
int nfc_genl_device_added(struct nfc_dev *dev)
|
|
|
{
|
|
|
struct sk_buff *msg;
|
|
@@ -317,10 +328,7 @@ int nfc_genl_device_added(struct nfc_dev *dev)
|
|
|
if (!hdr)
|
|
|
goto free_msg;
|
|
|
|
|
|
- if (nla_put_string(msg, NFC_ATTR_DEVICE_NAME, nfc_device_name(dev)) ||
|
|
|
- nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||
|
|
|
- nla_put_u32(msg, NFC_ATTR_PROTOCOLS, dev->supported_protocols) ||
|
|
|
- nla_put_u8(msg, NFC_ATTR_DEVICE_POWERED, dev->dev_up))
|
|
|
+ if (nfc_genl_setup_device_added(dev, msg))
|
|
|
goto nla_put_failure;
|
|
|
|
|
|
genlmsg_end(msg, hdr);
|
|
@@ -596,11 +604,7 @@ static int nfc_genl_send_device(struct sk_buff *msg, struct nfc_dev *dev,
|
|
|
if (cb)
|
|
|
genl_dump_check_consistent(cb, hdr, &nfc_genl_family);
|
|
|
|
|
|
- if (nla_put_string(msg, NFC_ATTR_DEVICE_NAME, nfc_device_name(dev)) ||
|
|
|
- nla_put_u32(msg, NFC_ATTR_DEVICE_INDEX, dev->idx) ||
|
|
|
- nla_put_u32(msg, NFC_ATTR_PROTOCOLS, dev->supported_protocols) ||
|
|
|
- nla_put_u8(msg, NFC_ATTR_DEVICE_POWERED, dev->dev_up) ||
|
|
|
- nla_put_u8(msg, NFC_ATTR_RF_MODE, dev->rf_mode))
|
|
|
+ if (nfc_genl_setup_device_added(dev, msg))
|
|
|
goto nla_put_failure;
|
|
|
|
|
|
genlmsg_end(msg, hdr);
|