|
@@ -159,6 +159,7 @@ void rt2x00debug_dump_frame(struct rt2x00_dev *rt2x00dev,
|
|
|
struct sk_buff *skbcopy;
|
|
|
struct rt2x00dump_hdr *dump_hdr;
|
|
|
struct timeval timestamp;
|
|
|
+ u32 data_len;
|
|
|
|
|
|
do_gettimeofday(×tamp);
|
|
|
|
|
@@ -170,7 +171,11 @@ void rt2x00debug_dump_frame(struct rt2x00_dev *rt2x00dev,
|
|
|
return;
|
|
|
}
|
|
|
|
|
|
- skbcopy = alloc_skb(sizeof(*dump_hdr) + skbdesc->desc_len + skb->len,
|
|
|
+ data_len = skb->len;
|
|
|
+ if (skbdesc->flags & SKBDESC_DESC_IN_SKB)
|
|
|
+ data_len -= skbdesc->desc_len;
|
|
|
+
|
|
|
+ skbcopy = alloc_skb(sizeof(*dump_hdr) + skbdesc->desc_len + data_len,
|
|
|
GFP_ATOMIC);
|
|
|
if (!skbcopy) {
|
|
|
DEBUG(rt2x00dev, "Failed to copy skb for dump.\n");
|
|
@@ -181,7 +186,7 @@ void rt2x00debug_dump_frame(struct rt2x00_dev *rt2x00dev,
|
|
|
dump_hdr->version = cpu_to_le32(DUMP_HEADER_VERSION);
|
|
|
dump_hdr->header_length = cpu_to_le32(sizeof(*dump_hdr));
|
|
|
dump_hdr->desc_length = cpu_to_le32(skbdesc->desc_len);
|
|
|
- dump_hdr->data_length = cpu_to_le32(skb->len);
|
|
|
+ dump_hdr->data_length = cpu_to_le32(data_len);
|
|
|
dump_hdr->chip_rt = cpu_to_le16(rt2x00dev->chip.rt);
|
|
|
dump_hdr->chip_rf = cpu_to_le16(rt2x00dev->chip.rf);
|
|
|
dump_hdr->chip_rev = cpu_to_le16(rt2x00dev->chip.rev);
|
|
@@ -191,8 +196,9 @@ void rt2x00debug_dump_frame(struct rt2x00_dev *rt2x00dev,
|
|
|
dump_hdr->timestamp_sec = cpu_to_le32(timestamp.tv_sec);
|
|
|
dump_hdr->timestamp_usec = cpu_to_le32(timestamp.tv_usec);
|
|
|
|
|
|
- memcpy(skb_put(skbcopy, skbdesc->desc_len), skbdesc->desc,
|
|
|
- skbdesc->desc_len);
|
|
|
+ if (!(skbdesc->flags & SKBDESC_DESC_IN_SKB))
|
|
|
+ memcpy(skb_put(skbcopy, skbdesc->desc_len), skbdesc->desc,
|
|
|
+ skbdesc->desc_len);
|
|
|
memcpy(skb_put(skbcopy, skb->len), skb->data, skb->len);
|
|
|
|
|
|
skb_queue_tail(&intf->frame_dump_skbqueue, skbcopy);
|