5e616ad216
mt76 core uses ffs() to find the next free bit. This works well for 32 bit architectures where BITS_PER_LONG is 32. ffs only checks 32 bit values, so allocation fails on 64 bit architectures. Additionally, the wcid mask array was too small in cases where the array was not a multiple of BITS_PER_LONG. Fix this by making the wcid mask array u32 instead and use DIV_ROUND_UP for the size, just in case we ever bump it to a value that's not a multiple of 32. Reported-by: Ryder Lee <ryder.lee@mediatek.com> Signed-off-by: Felix Fietkau <nbd@nbd.name>
114 lines
1.9 KiB
C
114 lines
1.9 KiB
C
// SPDX-License-Identifier: ISC
|
|
/*
|
|
* Copyright (C) 2016 Felix Fietkau <nbd@nbd.name>
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include "mt76.h"
|
|
|
|
bool __mt76_poll(struct mt76_dev *dev, u32 offset, u32 mask, u32 val,
|
|
int timeout)
|
|
{
|
|
u32 cur;
|
|
|
|
timeout /= 10;
|
|
do {
|
|
cur = dev->bus->rr(dev, offset) & mask;
|
|
if (cur == val)
|
|
return true;
|
|
|
|
udelay(10);
|
|
} while (timeout-- > 0);
|
|
|
|
return false;
|
|
}
|
|
EXPORT_SYMBOL_GPL(__mt76_poll);
|
|
|
|
bool __mt76_poll_msec(struct mt76_dev *dev, u32 offset, u32 mask, u32 val,
|
|
int timeout)
|
|
{
|
|
u32 cur;
|
|
|
|
timeout /= 10;
|
|
do {
|
|
cur = dev->bus->rr(dev, offset) & mask;
|
|
if (cur == val)
|
|
return true;
|
|
|
|
usleep_range(10000, 20000);
|
|
} while (timeout-- > 0);
|
|
|
|
return false;
|
|
}
|
|
EXPORT_SYMBOL_GPL(__mt76_poll_msec);
|
|
|
|
int mt76_wcid_alloc(u32 *mask, int size)
|
|
{
|
|
int i, idx = 0, cur;
|
|
|
|
for (i = 0; i < DIV_ROUND_UP(size, 32); i++) {
|
|
idx = ffs(~mask[i]);
|
|
if (!idx)
|
|
continue;
|
|
|
|
idx--;
|
|
cur = i * 32 + idx;
|
|
if (cur >= size)
|
|
break;
|
|
|
|
mask[i] |= BIT(idx);
|
|
return cur;
|
|
}
|
|
|
|
return -1;
|
|
}
|
|
EXPORT_SYMBOL_GPL(mt76_wcid_alloc);
|
|
|
|
int mt76_get_min_avg_rssi(struct mt76_dev *dev, bool ext_phy)
|
|
{
|
|
struct mt76_wcid *wcid;
|
|
int i, j, min_rssi = 0;
|
|
s8 cur_rssi;
|
|
|
|
local_bh_disable();
|
|
rcu_read_lock();
|
|
|
|
for (i = 0; i < ARRAY_SIZE(dev->wcid_mask); i++) {
|
|
u32 mask = dev->wcid_mask[i];
|
|
u32 phy_mask = dev->wcid_phy_mask[i];
|
|
|
|
if (!mask)
|
|
continue;
|
|
|
|
for (j = i * 32; mask; j++, mask >>= 1, phy_mask >>= 1) {
|
|
if (!(mask & 1))
|
|
continue;
|
|
|
|
if (!!(phy_mask & 1) != ext_phy)
|
|
continue;
|
|
|
|
wcid = rcu_dereference(dev->wcid[j]);
|
|
if (!wcid)
|
|
continue;
|
|
|
|
spin_lock(&dev->rx_lock);
|
|
if (wcid->inactive_count++ < 5)
|
|
cur_rssi = -ewma_signal_read(&wcid->rssi);
|
|
else
|
|
cur_rssi = 0;
|
|
spin_unlock(&dev->rx_lock);
|
|
|
|
if (cur_rssi < min_rssi)
|
|
min_rssi = cur_rssi;
|
|
}
|
|
}
|
|
|
|
rcu_read_unlock();
|
|
local_bh_enable();
|
|
|
|
return min_rssi;
|
|
}
|
|
EXPORT_SYMBOL_GPL(mt76_get_min_avg_rssi);
|
|
|
|
MODULE_LICENSE("Dual BSD/GPL");
|