diff options
Diffstat (limited to 'drivers/net/wireless/rt2x00/rt2x00debug.c')
-rw-r--r-- | drivers/net/wireless/rt2x00/rt2x00debug.c | 23 |
1 files changed, 14 insertions, 9 deletions
diff --git a/drivers/net/wireless/rt2x00/rt2x00debug.c b/drivers/net/wireless/rt2x00/rt2x00debug.c index 9569fb4e5bc5..e9fe93fd8042 100644 --- a/drivers/net/wireless/rt2x00/rt2x00debug.c +++ b/drivers/net/wireless/rt2x00/rt2x00debug.c | |||
@@ -156,10 +156,11 @@ void rt2x00debug_dump_frame(struct rt2x00_dev *rt2x00dev, | |||
156 | enum rt2x00_dump_type type, struct sk_buff *skb) | 156 | enum rt2x00_dump_type type, struct sk_buff *skb) |
157 | { | 157 | { |
158 | struct rt2x00debug_intf *intf = rt2x00dev->debugfs_intf; | 158 | struct rt2x00debug_intf *intf = rt2x00dev->debugfs_intf; |
159 | struct skb_frame_desc *desc = get_skb_frame_desc(skb); | 159 | struct skb_frame_desc *skbdesc = get_skb_frame_desc(skb); |
160 | struct sk_buff *skbcopy; | 160 | struct sk_buff *skbcopy; |
161 | struct rt2x00dump_hdr *dump_hdr; | 161 | struct rt2x00dump_hdr *dump_hdr; |
162 | struct timeval timestamp; | 162 | struct timeval timestamp; |
163 | u32 data_len; | ||
163 | 164 | ||
164 | do_gettimeofday(×tamp); | 165 | do_gettimeofday(×tamp); |
165 | 166 | ||
@@ -171,7 +172,11 @@ void rt2x00debug_dump_frame(struct rt2x00_dev *rt2x00dev, | |||
171 | return; | 172 | return; |
172 | } | 173 | } |
173 | 174 | ||
174 | skbcopy = alloc_skb(sizeof(*dump_hdr) + desc->desc_len + skb->len, | 175 | data_len = skb->len; |
176 | if (skbdesc->flags & SKBDESC_DESC_IN_SKB) | ||
177 | data_len -= skbdesc->desc_len; | ||
178 | |||
179 | skbcopy = alloc_skb(sizeof(*dump_hdr) + skbdesc->desc_len + data_len, | ||
175 | GFP_ATOMIC); | 180 | GFP_ATOMIC); |
176 | if (!skbcopy) { | 181 | if (!skbcopy) { |
177 | DEBUG(rt2x00dev, "Failed to copy skb for dump.\n"); | 182 | DEBUG(rt2x00dev, "Failed to copy skb for dump.\n"); |
@@ -181,18 +186,20 @@ void rt2x00debug_dump_frame(struct rt2x00_dev *rt2x00dev, | |||
181 | dump_hdr = (struct rt2x00dump_hdr *)skb_put(skbcopy, sizeof(*dump_hdr)); | 186 | dump_hdr = (struct rt2x00dump_hdr *)skb_put(skbcopy, sizeof(*dump_hdr)); |
182 | dump_hdr->version = cpu_to_le32(DUMP_HEADER_VERSION); | 187 | dump_hdr->version = cpu_to_le32(DUMP_HEADER_VERSION); |
183 | dump_hdr->header_length = cpu_to_le32(sizeof(*dump_hdr)); | 188 | dump_hdr->header_length = cpu_to_le32(sizeof(*dump_hdr)); |
184 | dump_hdr->desc_length = cpu_to_le32(desc->desc_len); | 189 | dump_hdr->desc_length = cpu_to_le32(skbdesc->desc_len); |
185 | dump_hdr->data_length = cpu_to_le32(skb->len); | 190 | dump_hdr->data_length = cpu_to_le32(data_len); |
186 | dump_hdr->chip_rt = cpu_to_le16(rt2x00dev->chip.rt); | 191 | dump_hdr->chip_rt = cpu_to_le16(rt2x00dev->chip.rt); |
187 | dump_hdr->chip_rf = cpu_to_le16(rt2x00dev->chip.rf); | 192 | dump_hdr->chip_rf = cpu_to_le16(rt2x00dev->chip.rf); |
188 | dump_hdr->chip_rev = cpu_to_le16(rt2x00dev->chip.rev); | 193 | dump_hdr->chip_rev = cpu_to_le16(rt2x00dev->chip.rev); |
189 | dump_hdr->type = cpu_to_le16(type); | 194 | dump_hdr->type = cpu_to_le16(type); |
190 | dump_hdr->queue_index = desc->entry->queue->qid; | 195 | dump_hdr->queue_index = skbdesc->entry->queue->qid; |
191 | dump_hdr->entry_index = desc->entry->entry_idx; | 196 | dump_hdr->entry_index = skbdesc->entry->entry_idx; |
192 | dump_hdr->timestamp_sec = cpu_to_le32(timestamp.tv_sec); | 197 | dump_hdr->timestamp_sec = cpu_to_le32(timestamp.tv_sec); |
193 | dump_hdr->timestamp_usec = cpu_to_le32(timestamp.tv_usec); | 198 | dump_hdr->timestamp_usec = cpu_to_le32(timestamp.tv_usec); |
194 | 199 | ||
195 | memcpy(skb_put(skbcopy, desc->desc_len), desc->desc, desc->desc_len); | 200 | if (!(skbdesc->flags & SKBDESC_DESC_IN_SKB)) |
201 | memcpy(skb_put(skbcopy, skbdesc->desc_len), skbdesc->desc, | ||
202 | skbdesc->desc_len); | ||
196 | memcpy(skb_put(skbcopy, skb->len), skb->data, skb->len); | 203 | memcpy(skb_put(skbcopy, skb->len), skb->data, skb->len); |
197 | 204 | ||
198 | skb_queue_tail(&intf->frame_dump_skbqueue, skbcopy); | 205 | skb_queue_tail(&intf->frame_dump_skbqueue, skbcopy); |
@@ -700,8 +707,6 @@ void rt2x00debug_register(struct rt2x00_dev *rt2x00dev) | |||
700 | exit: | 707 | exit: |
701 | rt2x00debug_deregister(rt2x00dev); | 708 | rt2x00debug_deregister(rt2x00dev); |
702 | ERROR(rt2x00dev, "Failed to register debug handler.\n"); | 709 | ERROR(rt2x00dev, "Failed to register debug handler.\n"); |
703 | |||
704 | return; | ||
705 | } | 710 | } |
706 | 711 | ||
707 | void rt2x00debug_deregister(struct rt2x00_dev *rt2x00dev) | 712 | void rt2x00debug_deregister(struct rt2x00_dev *rt2x00dev) |