|
@@ -525,8 +525,24 @@ void b43_rx(struct b43_wldev *dev, struct sk_buff *skb, const void *_rxhdr)
|
|
|
else
|
|
|
status.rate = b43_plcp_get_bitrate_cck(plcp);
|
|
|
status.antenna = !!(phystat0 & B43_RX_PHYST0_ANT);
|
|
|
- status.mactime = mactime;
|
|
|
- status.flag |= RX_FLAG_TSFT;
|
|
|
+
|
|
|
+ /*
|
|
|
+ * If monitors are present get full 64-bit timestamp. This
|
|
|
+ * code assumes we get to process the packet within 16 bits
|
|
|
+ * of timestamp, i.e. about 65 milliseconds after the PHY
|
|
|
+ * received the first symbol.
|
|
|
+ */
|
|
|
+ if (dev->wl->radiotap_enabled) {
|
|
|
+ u16 low_mactime_now;
|
|
|
+
|
|
|
+ b43_tsf_read(dev, &status.mactime);
|
|
|
+ low_mactime_now = status.mactime;
|
|
|
+ status.mactime = status.mactime & ~0xFFFFULL;
|
|
|
+ status.mactime += mactime;
|
|
|
+ if (low_mactime_now <= mactime)
|
|
|
+ status.mactime -= 0x10000;
|
|
|
+ status.flag |= RX_FLAG_TSFT;
|
|
|
+ }
|
|
|
|
|
|
chanid = (chanstat & B43_RX_CHAN_ID) >> B43_RX_CHAN_ID_SHIFT;
|
|
|
switch (chanstat & B43_RX_CHAN_PHYTYPE) {
|