Commit 276b8c77 authored by David S. Miller's avatar David S. Miller

Merge tag 'nfc-next-4.8-1' of git://git.kernel.org/pub/scm/linux/kernel/git/sameo/nfc-next

Samuel Ortiz says:

====================
NFC 4.8 pull request

This is the first NFC pull request for 4.8. We have:

- A fairly large NFC digital stack patchset:
  * RTOX fixes.
  * Proper DEP RWT support.
  * ACK and NACK PDUs handling fixes, in both initiator
    and target modes.
  * A few memory leak fixes.

- A conversion of the nfcsim driver to use the digital stack.
  The driver supports the DEP protocol in both NFC-A and NFC-F.

- Error injection through debugfs for the nfcsim driver.

- Improvements to the port100 driver for the Sony USB chipset, in
  particular to the command abort and cancellation code paths.

- A few minor fixes for the pn533, trf7970a and fdp drivers.
====================
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parents 0f06a678 2a0fe4fe
...@@ -40,6 +40,7 @@ config NFC_MEI_PHY ...@@ -40,6 +40,7 @@ config NFC_MEI_PHY
config NFC_SIM config NFC_SIM
tristate "NFC hardware simulator driver" tristate "NFC hardware simulator driver"
depends on NFC_DIGITAL
help help
This driver declares two virtual NFC devices supporting NFC-DEP This driver declares two virtual NFC devices supporting NFC-DEP
protocol. An LLCP connection can be established between them and protocol. An LLCP connection can be established between them and
......
...@@ -345,7 +345,7 @@ static void fdp_nci_release_firmware(struct nci_dev *ndev) ...@@ -345,7 +345,7 @@ static void fdp_nci_release_firmware(struct nci_dev *ndev)
if (info->ram_patch) { if (info->ram_patch) {
release_firmware(info->ram_patch); release_firmware(info->ram_patch);
info->otp_patch = NULL; info->ram_patch = NULL;
} }
} }
...@@ -353,7 +353,7 @@ static int fdp_nci_patch_otp(struct nci_dev *ndev) ...@@ -353,7 +353,7 @@ static int fdp_nci_patch_otp(struct nci_dev *ndev)
{ {
struct fdp_nci_info *info = nci_get_drvdata(ndev); struct fdp_nci_info *info = nci_get_drvdata(ndev);
struct device *dev = &info->phy->i2c_dev->dev; struct device *dev = &info->phy->i2c_dev->dev;
u8 conn_id; int conn_id;
int r = 0; int r = 0;
if (info->otp_version >= info->otp_patch_version) if (info->otp_version >= info->otp_patch_version)
...@@ -424,7 +424,7 @@ static int fdp_nci_patch_ram(struct nci_dev *ndev) ...@@ -424,7 +424,7 @@ static int fdp_nci_patch_ram(struct nci_dev *ndev)
{ {
struct fdp_nci_info *info = nci_get_drvdata(ndev); struct fdp_nci_info *info = nci_get_drvdata(ndev);
struct device *dev = &info->phy->i2c_dev->dev; struct device *dev = &info->phy->i2c_dev->dev;
u8 conn_id; int conn_id;
int r = 0; int r = 0;
if (info->ram_version >= info->ram_patch_version) if (info->ram_version >= info->ram_patch_version)
......
This diff is collapsed.
...@@ -464,10 +464,8 @@ static int pn533_usb_probe(struct usb_interface *interface, ...@@ -464,10 +464,8 @@ static int pn533_usb_probe(struct usb_interface *interface,
return -ENOMEM; return -ENOMEM;
in_buf = kzalloc(in_buf_len, GFP_KERNEL); in_buf = kzalloc(in_buf_len, GFP_KERNEL);
if (!in_buf) { if (!in_buf)
rc = -ENOMEM; return -ENOMEM;
goto out_free_phy;
}
phy->udev = usb_get_dev(interface_to_usbdev(interface)); phy->udev = usb_get_dev(interface_to_usbdev(interface));
phy->interface = interface; phy->interface = interface;
...@@ -554,8 +552,7 @@ static int pn533_usb_probe(struct usb_interface *interface, ...@@ -554,8 +552,7 @@ static int pn533_usb_probe(struct usb_interface *interface,
usb_free_urb(phy->out_urb); usb_free_urb(phy->out_urb);
usb_put_dev(phy->udev); usb_put_dev(phy->udev);
kfree(in_buf); kfree(in_buf);
out_free_phy:
kfree(phy);
return rc; return rc;
} }
......
...@@ -343,7 +343,26 @@ in_protocols[][PORT100_IN_MAX_NUM_PROTOCOLS + 1] = { ...@@ -343,7 +343,26 @@ in_protocols[][PORT100_IN_MAX_NUM_PROTOCOLS + 1] = {
}, },
[NFC_DIGITAL_FRAMING_NFCF_NFC_DEP] = { [NFC_DIGITAL_FRAMING_NFCF_NFC_DEP] = {
/* nfc_digital_framing_nfcf */ /* nfc_digital_framing_nfcf */
{ PORT100_IN_PROT_END, 0 }, { PORT100_IN_PROT_INITIAL_GUARD_TIME, 18 },
{ PORT100_IN_PROT_ADD_CRC, 1 },
{ PORT100_IN_PROT_CHECK_CRC, 1 },
{ PORT100_IN_PROT_MULTI_CARD, 0 },
{ PORT100_IN_PROT_ADD_PARITY, 0 },
{ PORT100_IN_PROT_CHECK_PARITY, 0 },
{ PORT100_IN_PROT_BITWISE_AC_RECV_MODE, 0 },
{ PORT100_IN_PROT_VALID_BIT_NUMBER, 8 },
{ PORT100_IN_PROT_CRYPTO1, 0 },
{ PORT100_IN_PROT_ADD_SOF, 0 },
{ PORT100_IN_PROT_CHECK_SOF, 0 },
{ PORT100_IN_PROT_ADD_EOF, 0 },
{ PORT100_IN_PROT_CHECK_EOF, 0 },
{ PORT100_IN_PROT_DEAF_TIME, 4 },
{ PORT100_IN_PROT_CRM, 0 },
{ PORT100_IN_PROT_CRM_MIN_LEN, 0 },
{ PORT100_IN_PROT_T1_TAG_FRAME, 0 },
{ PORT100_IN_PROT_RFCA, 0 },
{ PORT100_IN_PROT_GUARD_TIME_AT_INITIATOR, 6 },
{ PORT100_IN_PROT_END, 0 },
}, },
[NFC_DIGITAL_FRAMING_NFC_DEP_ACTIVATED] = { [NFC_DIGITAL_FRAMING_NFC_DEP_ACTIVATED] = {
{ PORT100_IN_PROT_END, 0 }, { PORT100_IN_PROT_END, 0 },
...@@ -437,6 +456,12 @@ struct port100 { ...@@ -437,6 +456,12 @@ struct port100 {
struct urb *out_urb; struct urb *out_urb;
struct urb *in_urb; struct urb *in_urb;
/* This mutex protects the out_urb and avoids to submit a new command
* through port100_send_frame_async() while the previous one is being
* canceled through port100_abort_cmd().
*/
struct mutex out_urb_lock;
struct work_struct cmd_complete_work; struct work_struct cmd_complete_work;
u8 cmd_type; u8 cmd_type;
...@@ -445,6 +470,9 @@ struct port100 { ...@@ -445,6 +470,9 @@ struct port100 {
* for any queuing/locking mechanism at driver level. * for any queuing/locking mechanism at driver level.
*/ */
struct port100_cmd *cmd; struct port100_cmd *cmd;
bool cmd_cancel;
struct completion cmd_cancel_done;
}; };
struct port100_cmd { struct port100_cmd {
...@@ -699,10 +727,27 @@ static int port100_send_ack(struct port100 *dev) ...@@ -699,10 +727,27 @@ static int port100_send_ack(struct port100 *dev)
{ {
int rc; int rc;
mutex_lock(&dev->out_urb_lock);
init_completion(&dev->cmd_cancel_done);
usb_kill_urb(dev->out_urb);
dev->out_urb->transfer_buffer = ack_frame; dev->out_urb->transfer_buffer = ack_frame;
dev->out_urb->transfer_buffer_length = sizeof(ack_frame); dev->out_urb->transfer_buffer_length = sizeof(ack_frame);
rc = usb_submit_urb(dev->out_urb, GFP_KERNEL); rc = usb_submit_urb(dev->out_urb, GFP_KERNEL);
/* Set the cmd_cancel flag only if the URB has been successfully
* submitted. It will be reset by the out URB completion callback
* port100_send_complete().
*/
dev->cmd_cancel = !rc;
mutex_unlock(&dev->out_urb_lock);
if (!rc)
wait_for_completion(&dev->cmd_cancel_done);
return rc; return rc;
} }
...@@ -711,6 +756,16 @@ static int port100_send_frame_async(struct port100 *dev, struct sk_buff *out, ...@@ -711,6 +756,16 @@ static int port100_send_frame_async(struct port100 *dev, struct sk_buff *out,
{ {
int rc; int rc;
mutex_lock(&dev->out_urb_lock);
/* A command cancel frame as been sent through dev->out_urb. Don't try
* to submit a new one.
*/
if (dev->cmd_cancel) {
rc = -EAGAIN;
goto exit;
}
dev->out_urb->transfer_buffer = out->data; dev->out_urb->transfer_buffer = out->data;
dev->out_urb->transfer_buffer_length = out->len; dev->out_urb->transfer_buffer_length = out->len;
...@@ -722,16 +777,15 @@ static int port100_send_frame_async(struct port100 *dev, struct sk_buff *out, ...@@ -722,16 +777,15 @@ static int port100_send_frame_async(struct port100 *dev, struct sk_buff *out,
rc = usb_submit_urb(dev->out_urb, GFP_KERNEL); rc = usb_submit_urb(dev->out_urb, GFP_KERNEL);
if (rc) if (rc)
return rc; goto exit;
rc = port100_submit_urb_for_ack(dev, GFP_KERNEL); rc = port100_submit_urb_for_ack(dev, GFP_KERNEL);
if (rc) if (rc)
goto error; usb_unlink_urb(dev->out_urb);
return 0; exit:
mutex_unlock(&dev->out_urb_lock);
error:
usb_unlink_urb(dev->out_urb);
return rc; return rc;
} }
...@@ -790,6 +844,12 @@ static int port100_send_cmd_async(struct port100 *dev, u8 cmd_code, ...@@ -790,6 +844,12 @@ static int port100_send_cmd_async(struct port100 *dev, u8 cmd_code,
PORT100_FRAME_MAX_PAYLOAD_LEN + PORT100_FRAME_MAX_PAYLOAD_LEN +
PORT100_FRAME_TAIL_LEN; PORT100_FRAME_TAIL_LEN;
if (dev->cmd) {
nfc_err(&dev->interface->dev,
"A command is still in process\n");
return -EBUSY;
}
resp = alloc_skb(resp_len, GFP_KERNEL); resp = alloc_skb(resp_len, GFP_KERNEL);
if (!resp) if (!resp)
return -ENOMEM; return -ENOMEM;
...@@ -867,6 +927,11 @@ static void port100_send_complete(struct urb *urb) ...@@ -867,6 +927,11 @@ static void port100_send_complete(struct urb *urb)
{ {
struct port100 *dev = urb->context; struct port100 *dev = urb->context;
if (dev->cmd_cancel) {
dev->cmd_cancel = false;
complete(&dev->cmd_cancel_done);
}
switch (urb->status) { switch (urb->status) {
case 0: case 0:
break; /* success */ break; /* success */
...@@ -985,6 +1050,10 @@ static int port100_switch_rf(struct nfc_digital_dev *ddev, bool on) ...@@ -985,6 +1050,10 @@ static int port100_switch_rf(struct nfc_digital_dev *ddev, bool on)
*skb_put(skb, 1) = on ? 1 : 0; *skb_put(skb, 1) = on ? 1 : 0;
/* Cancel the last command if the device is being switched off */
if (!on)
port100_abort_cmd(ddev);
resp = port100_send_cmd_sync(dev, PORT100_CMD_SWITCH_RF, skb); resp = port100_send_cmd_sync(dev, PORT100_CMD_SWITCH_RF, skb);
if (IS_ERR(resp)) if (IS_ERR(resp))
...@@ -1430,6 +1499,7 @@ static int port100_probe(struct usb_interface *interface, ...@@ -1430,6 +1499,7 @@ static int port100_probe(struct usb_interface *interface,
if (!dev) if (!dev)
return -ENOMEM; return -ENOMEM;
mutex_init(&dev->out_urb_lock);
dev->udev = usb_get_dev(interface_to_usbdev(interface)); dev->udev = usb_get_dev(interface_to_usbdev(interface));
dev->interface = interface; dev->interface = interface;
usb_set_intfdata(interface, dev); usb_set_intfdata(interface, dev);
......
...@@ -1048,6 +1048,10 @@ static int trf7970a_init(struct trf7970a *trf) ...@@ -1048,6 +1048,10 @@ static int trf7970a_init(struct trf7970a *trf)
if (ret) if (ret)
goto err_out; goto err_out;
ret = trf7970a_write(trf, TRF7970A_NFC_TARGET_LEVEL, 0);
if (ret)
goto err_out;
usleep_range(1000, 2000); usleep_range(1000, 2000);
trf->chip_status_ctrl &= ~TRF7970A_CHIP_STATUS_RF_ON; trf->chip_status_ctrl &= ~TRF7970A_CHIP_STATUS_RF_ON;
......
...@@ -220,12 +220,13 @@ struct nfc_digital_dev { ...@@ -220,12 +220,13 @@ struct nfc_digital_dev {
struct list_head cmd_queue; struct list_head cmd_queue;
struct mutex cmd_lock; struct mutex cmd_lock;
struct work_struct poll_work; struct delayed_work poll_work;
u8 curr_protocol; u8 curr_protocol;
u8 curr_rf_tech; u8 curr_rf_tech;
u8 curr_nfc_dep_pni; u8 curr_nfc_dep_pni;
u8 did; u8 did;
u16 dep_rwt;
u8 local_payload_max; u8 local_payload_max;
u8 remote_payload_max; u8 remote_payload_max;
...@@ -237,7 +238,6 @@ struct nfc_digital_dev { ...@@ -237,7 +238,6 @@ struct nfc_digital_dev {
int nack_count; int nack_count;
struct sk_buff *saved_skb; struct sk_buff *saved_skb;
unsigned int saved_skb_len;
u16 target_fsc; u16 target_fsc;
......
...@@ -37,10 +37,6 @@ struct nfc_llc *nfc_llc_allocate(const char *name, struct nfc_hci_dev *hdev, ...@@ -37,10 +37,6 @@ struct nfc_llc *nfc_llc_allocate(const char *name, struct nfc_hci_dev *hdev,
int tx_tailroom, llc_failure_t llc_failure); int tx_tailroom, llc_failure_t llc_failure);
void nfc_llc_free(struct nfc_llc *llc); void nfc_llc_free(struct nfc_llc *llc);
void nfc_llc_get_rx_head_tail_room(struct nfc_llc *llc, int *rx_headroom,
int *rx_tailroom);
int nfc_llc_start(struct nfc_llc *llc); int nfc_llc_start(struct nfc_llc *llc);
int nfc_llc_stop(struct nfc_llc *llc); int nfc_llc_stop(struct nfc_llc *llc);
void nfc_llc_rcv_from_drv(struct nfc_llc *llc, struct sk_buff *skb); void nfc_llc_rcv_from_drv(struct nfc_llc *llc, struct sk_buff *skb);
......
...@@ -30,6 +30,9 @@ ...@@ -30,6 +30,9 @@
#define DIGITAL_PROTO_ISO15693_RF_TECH NFC_PROTO_ISO15693_MASK #define DIGITAL_PROTO_ISO15693_RF_TECH NFC_PROTO_ISO15693_MASK
/* Delay between each poll frame (ms) */
#define DIGITAL_POLL_INTERVAL 10
struct digital_cmd { struct digital_cmd {
struct list_head queue; struct list_head queue;
...@@ -173,6 +176,8 @@ static void digital_wq_cmd(struct work_struct *work) ...@@ -173,6 +176,8 @@ static void digital_wq_cmd(struct work_struct *work)
return; return;
} }
cmd->pending = 1;
mutex_unlock(&ddev->cmd_lock); mutex_unlock(&ddev->cmd_lock);
if (cmd->req) if (cmd->req)
...@@ -419,7 +424,8 @@ void digital_poll_next_tech(struct nfc_digital_dev *ddev) ...@@ -419,7 +424,8 @@ void digital_poll_next_tech(struct nfc_digital_dev *ddev)
mutex_unlock(&ddev->poll_lock); mutex_unlock(&ddev->poll_lock);
schedule_work(&ddev->poll_work); schedule_delayed_work(&ddev->poll_work,
msecs_to_jiffies(DIGITAL_POLL_INTERVAL));
} }
static void digital_wq_poll(struct work_struct *work) static void digital_wq_poll(struct work_struct *work)
...@@ -428,7 +434,7 @@ static void digital_wq_poll(struct work_struct *work) ...@@ -428,7 +434,7 @@ static void digital_wq_poll(struct work_struct *work)
struct digital_poll_tech *poll_tech; struct digital_poll_tech *poll_tech;
struct nfc_digital_dev *ddev = container_of(work, struct nfc_digital_dev *ddev = container_of(work,
struct nfc_digital_dev, struct nfc_digital_dev,
poll_work); poll_work.work);
mutex_lock(&ddev->poll_lock); mutex_lock(&ddev->poll_lock);
if (!ddev->poll_tech_count) { if (!ddev->poll_tech_count) {
...@@ -543,7 +549,7 @@ static int digital_start_poll(struct nfc_dev *nfc_dev, __u32 im_protocols, ...@@ -543,7 +549,7 @@ static int digital_start_poll(struct nfc_dev *nfc_dev, __u32 im_protocols,
return -EINVAL; return -EINVAL;
} }
schedule_work(&ddev->poll_work); schedule_delayed_work(&ddev->poll_work, 0);
return 0; return 0;
} }
...@@ -564,7 +570,7 @@ static void digital_stop_poll(struct nfc_dev *nfc_dev) ...@@ -564,7 +570,7 @@ static void digital_stop_poll(struct nfc_dev *nfc_dev)
mutex_unlock(&ddev->poll_lock); mutex_unlock(&ddev->poll_lock);
cancel_work_sync(&ddev->poll_work); cancel_delayed_work_sync(&ddev->poll_work);
digital_abort_cmd(ddev); digital_abort_cmd(ddev);
} }
...@@ -606,6 +612,8 @@ static int digital_dep_link_down(struct nfc_dev *nfc_dev) ...@@ -606,6 +612,8 @@ static int digital_dep_link_down(struct nfc_dev *nfc_dev)
{ {
struct nfc_digital_dev *ddev = nfc_get_drvdata(nfc_dev); struct nfc_digital_dev *ddev = nfc_get_drvdata(nfc_dev);
digital_abort_cmd(ddev);
ddev->curr_protocol = 0; ddev->curr_protocol = 0;
return 0; return 0;
...@@ -770,7 +778,7 @@ struct nfc_digital_dev *nfc_digital_allocate_device(struct nfc_digital_ops *ops, ...@@ -770,7 +778,7 @@ struct nfc_digital_dev *nfc_digital_allocate_device(struct nfc_digital_ops *ops,
INIT_WORK(&ddev->cmd_complete_work, digital_wq_cmd_complete); INIT_WORK(&ddev->cmd_complete_work, digital_wq_cmd_complete);
mutex_init(&ddev->poll_lock); mutex_init(&ddev->poll_lock);
INIT_WORK(&ddev->poll_work, digital_wq_poll); INIT_DELAYED_WORK(&ddev->poll_work, digital_wq_poll);
if (supported_protocols & NFC_PROTO_JEWEL_MASK) if (supported_protocols & NFC_PROTO_JEWEL_MASK)
ddev->protocols |= NFC_PROTO_JEWEL_MASK; ddev->protocols |= NFC_PROTO_JEWEL_MASK;
...@@ -832,12 +840,20 @@ void nfc_digital_unregister_device(struct nfc_digital_dev *ddev) ...@@ -832,12 +840,20 @@ void nfc_digital_unregister_device(struct nfc_digital_dev *ddev)
ddev->poll_tech_count = 0; ddev->poll_tech_count = 0;
mutex_unlock(&ddev->poll_lock); mutex_unlock(&ddev->poll_lock);
cancel_work_sync(&ddev->poll_work); cancel_delayed_work_sync(&ddev->poll_work);
cancel_work_sync(&ddev->cmd_work); cancel_work_sync(&ddev->cmd_work);
cancel_work_sync(&ddev->cmd_complete_work); cancel_work_sync(&ddev->cmd_complete_work);
list_for_each_entry_safe(cmd, n, &ddev->cmd_queue, queue) { list_for_each_entry_safe(cmd, n, &ddev->cmd_queue, queue) {
list_del(&cmd->queue); list_del(&cmd->queue);
/* Call the command callback if any and pass it a ENODEV error.
* This gives a chance to the command issuer to free any
* allocated buffer.
*/
if (cmd->cmd_cb)
cmd->cmd_cb(ddev, cmd->cb_context, ERR_PTR(-ENODEV));
kfree(cmd->mdaa_params); kfree(cmd->mdaa_params);
kfree(cmd); kfree(cmd);
} }
......
This diff is collapsed.
...@@ -1257,21 +1257,12 @@ static int digital_tg_config_nfcf(struct nfc_digital_dev *ddev, u8 rf_tech) ...@@ -1257,21 +1257,12 @@ static int digital_tg_config_nfcf(struct nfc_digital_dev *ddev, u8 rf_tech)
int digital_tg_listen_nfcf(struct nfc_digital_dev *ddev, u8 rf_tech) int digital_tg_listen_nfcf(struct nfc_digital_dev *ddev, u8 rf_tech)
{ {
int rc; int rc;
u8 *nfcid2;
rc = digital_tg_config_nfcf(ddev, rf_tech); rc = digital_tg_config_nfcf(ddev, rf_tech);
if (rc) if (rc)
return rc; return rc;
nfcid2 = kzalloc(NFC_NFCID2_MAXSIZE, GFP_KERNEL); return digital_tg_listen(ddev, 300, digital_tg_recv_sensf_req, NULL);
if (!nfcid2)
return -ENOMEM;
nfcid2[0] = DIGITAL_SENSF_NFCID2_NFC_DEP_B1;
nfcid2[1] = DIGITAL_SENSF_NFCID2_NFC_DEP_B2;
get_random_bytes(nfcid2 + 2, NFC_NFCID2_MAXSIZE - 2);
return digital_tg_listen(ddev, 300, digital_tg_recv_sensf_req, nfcid2);
} }
void digital_tg_recv_md_req(struct nfc_digital_dev *ddev, void *arg, void digital_tg_recv_md_req(struct nfc_digital_dev *ddev, void *arg,
......
...@@ -133,36 +133,29 @@ void nfc_llc_free(struct nfc_llc *llc) ...@@ -133,36 +133,29 @@ void nfc_llc_free(struct nfc_llc *llc)
kfree(llc); kfree(llc);
} }
inline void nfc_llc_get_rx_head_tail_room(struct nfc_llc *llc, int *rx_headroom, int nfc_llc_start(struct nfc_llc *llc)
int *rx_tailroom)
{
*rx_headroom = llc->rx_headroom;
*rx_tailroom = llc->rx_tailroom;
}
inline int nfc_llc_start(struct nfc_llc *llc)
{ {
return llc->ops->start(llc); return llc->ops->start(llc);
} }
EXPORT_SYMBOL(nfc_llc_start); EXPORT_SYMBOL(nfc_llc_start);
inline int nfc_llc_stop(struct nfc_llc *llc) int nfc_llc_stop(struct nfc_llc *llc)
{ {
return llc->ops->stop(llc); return llc->ops->stop(llc);
} }
EXPORT_SYMBOL(nfc_llc_stop); EXPORT_SYMBOL(nfc_llc_stop);
inline void nfc_llc_rcv_from_drv(struct nfc_llc *llc, struct sk_buff *skb) void nfc_llc_rcv_from_drv(struct nfc_llc *llc, struct sk_buff *skb)
{ {
llc->ops->rcv_from_drv(llc, skb); llc->ops->rcv_from_drv(llc, skb);
} }
inline int nfc_llc_xmit_from_hci(struct nfc_llc *llc, struct sk_buff *skb) int nfc_llc_xmit_from_hci(struct nfc_llc *llc, struct sk_buff *skb)
{ {
return llc->ops->xmit_from_hci(llc, skb); return llc->ops->xmit_from_hci(llc, skb);
} }
inline void *nfc_llc_get_data(struct nfc_llc *llc) void *nfc_llc_get_data(struct nfc_llc *llc)
{ {
return llc->data; return llc->data;
} }
...@@ -438,19 +438,17 @@ int nfc_llcp_send_connect(struct nfc_llcp_sock *sock) ...@@ -438,19 +438,17 @@ int nfc_llcp_send_connect(struct nfc_llcp_sock *sock)
goto error_tlv; goto error_tlv;
} }
if (service_name_tlv != NULL) llcp_add_tlv(skb, service_name_tlv, service_name_tlv_length);
skb = llcp_add_tlv(skb, service_name_tlv, llcp_add_tlv(skb, miux_tlv, miux_tlv_length);
service_name_tlv_length); llcp_add_tlv(skb, rw_tlv, rw_tlv_length);
skb = llcp_add_tlv(skb, miux_tlv, miux_tlv_length);
skb = llcp_add_tlv(skb, rw_tlv, rw_tlv_length);
skb_queue_tail(&local->tx_queue, skb); skb_queue_tail(&local->tx_queue, skb);
return 0; err = 0;
error_tlv: error_tlv:
pr_err("error %d\n", err); if (err)
pr_err("error %d\n", err);
kfree(service_name_tlv); kfree(service_name_tlv);
kfree(miux_tlv); kfree(miux_tlv);
...@@ -493,15 +491,16 @@ int nfc_llcp_send_cc(struct nfc_llcp_sock *sock) ...@@ -493,15 +491,16 @@ int nfc_llcp_send_cc(struct nfc_llcp_sock *sock)
goto error_tlv; goto error_tlv;
} }
skb = llcp_add_tlv(skb, miux_tlv, miux_tlv_length); llcp_add_tlv(skb, miux_tlv, miux_tlv_length);
skb = llcp_add_tlv(skb, rw_tlv, rw_tlv_length); llcp_add_tlv(skb, rw_tlv, rw_tlv_length);
skb_queue_tail(&local->tx_queue, skb); skb_queue_tail(&local->tx_queue, skb);
return 0; err = 0;
error_tlv: error_tlv:
pr_err("error %d\n", err); if (err)
pr_err("error %d\n", err);
kfree(miux_tlv); kfree(miux_tlv);
kfree(rw_tlv); kfree(rw_tlv);
......
...@@ -732,9 +732,8 @@ static void nfc_llcp_tx_work(struct work_struct *work) ...@@ -732,9 +732,8 @@ static void nfc_llcp_tx_work(struct work_struct *work)
int ret; int ret;
pr_debug("Sending pending skb\n"); pr_debug("Sending pending skb\n");
print_hex_dump(KERN_DEBUG, "LLCP Tx: ", print_hex_dump_debug("LLCP Tx: ", DUMP_PREFIX_OFFSET,
DUMP_PREFIX_OFFSET, 16, 1, 16, 1, skb->data, skb->len, true);
skb->data, skb->len, true);
if (ptype == LLCP_PDU_DISC && sk != NULL && if (ptype == LLCP_PDU_DISC && sk != NULL &&
sk->sk_state == LLCP_DISCONNECTING) { sk->sk_state == LLCP_DISCONNECTING) {
...@@ -1412,8 +1411,8 @@ static void nfc_llcp_rx_skb(struct nfc_llcp_local *local, struct sk_buff *skb) ...@@ -1412,8 +1411,8 @@ static void nfc_llcp_rx_skb(struct nfc_llcp_local *local, struct sk_buff *skb)
pr_debug("ptype 0x%x dsap 0x%x ssap 0x%x\n", ptype, dsap, ssap); pr_debug("ptype 0x%x dsap 0x%x ssap 0x%x\n", ptype, dsap, ssap);
if (ptype != LLCP_PDU_SYMM) if (ptype != LLCP_PDU_SYMM)
print_hex_dump(KERN_DEBUG, "LLCP Rx: ", DUMP_PREFIX_OFFSET, print_hex_dump_debug("LLCP Rx: ", DUMP_PREFIX_OFFSET, 16, 1,
16, 1, skb->data, skb->len, true); skb->data, skb->len, true);
switch (ptype) { switch (ptype) {
case LLCP_PDU_SYMM: case LLCP_PDU_SYMM:
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment