1 // SPDX-License-Identifier: ISC 2 /* 3 * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name> 4 */ 5 6 #include <linux/module.h> 7 #if defined(__FreeBSD__) 8 #include <linux/delay.h> 9 #include <linux/kthread.h> 10 #endif 11 #include "mt76.h" 12 13 bool __mt76_poll(struct mt76_dev *dev, u32 offset, u32 mask, u32 val, 14 int timeout) 15 { 16 u32 cur; 17 18 timeout /= 10; 19 do { 20 cur = __mt76_rr(dev, offset) & mask; 21 if (cur == val) 22 return true; 23 24 udelay(10); 25 } while (timeout-- > 0); 26 27 return false; 28 } 29 EXPORT_SYMBOL_GPL(__mt76_poll); 30 31 bool ____mt76_poll_msec(struct mt76_dev *dev, u32 offset, u32 mask, u32 val, 32 int timeout, int tick) 33 { 34 u32 cur; 35 36 timeout /= tick; 37 do { 38 cur = __mt76_rr(dev, offset) & mask; 39 if (cur == val) 40 return true; 41 42 usleep_range(1000 * tick, 2000 * tick); 43 } while (timeout-- > 0); 44 45 return false; 46 } 47 EXPORT_SYMBOL_GPL(____mt76_poll_msec); 48 49 int mt76_wcid_alloc(u32 *mask, int size) 50 { 51 int i, idx = 0, cur; 52 53 for (i = 0; i < DIV_ROUND_UP(size, 32); i++) { 54 idx = ffs(~mask[i]); 55 if (!idx) 56 continue; 57 58 idx--; 59 cur = i * 32 + idx; 60 if (cur >= size) 61 break; 62 63 mask[i] |= BIT(idx); 64 return cur; 65 } 66 67 return -1; 68 } 69 EXPORT_SYMBOL_GPL(mt76_wcid_alloc); 70 71 int mt76_get_min_avg_rssi(struct mt76_dev *dev, u8 phy_idx) 72 { 73 struct mt76_wcid *wcid; 74 int i, j, min_rssi = 0; 75 s8 cur_rssi; 76 77 local_bh_disable(); 78 rcu_read_lock(); 79 80 for (i = 0; i < ARRAY_SIZE(dev->wcid_mask); i++) { 81 u32 mask = dev->wcid_mask[i]; 82 83 if (!mask) 84 continue; 85 86 for (j = i * 32; mask; j++, mask >>= 1) { 87 if (!(mask & 1)) 88 continue; 89 90 wcid = rcu_dereference(dev->wcid[j]); 91 if (!wcid || wcid->phy_idx != phy_idx) 92 continue; 93 94 spin_lock(&dev->rx_lock); 95 if (wcid->inactive_count++ < 5) 96 cur_rssi = -ewma_signal_read(&wcid->rssi); 97 else 98 cur_rssi = 0; 99 spin_unlock(&dev->rx_lock); 100 101 if (cur_rssi < min_rssi) 102 min_rssi = cur_rssi; 103 } 104 } 105 106 rcu_read_unlock(); 107 local_bh_enable(); 108 109 return min_rssi; 110 } 111 EXPORT_SYMBOL_GPL(mt76_get_min_avg_rssi); 112 113 int __mt76_worker_fn(void *ptr) 114 { 115 struct mt76_worker *w = ptr; 116 117 while (!kthread_should_stop()) { 118 set_current_state(TASK_INTERRUPTIBLE); 119 120 if (kthread_should_park()) { 121 kthread_parkme(); 122 continue; 123 } 124 125 if (!test_and_clear_bit(MT76_WORKER_SCHEDULED, &w->state)) { 126 schedule(); 127 continue; 128 } 129 130 set_bit(MT76_WORKER_RUNNING, &w->state); 131 set_current_state(TASK_RUNNING); 132 w->fn(w); 133 cond_resched(); 134 clear_bit(MT76_WORKER_RUNNING, &w->state); 135 } 136 137 return 0; 138 } 139 EXPORT_SYMBOL_GPL(__mt76_worker_fn); 140 141 MODULE_DESCRIPTION("MediaTek MT76x helpers"); 142 MODULE_LICENSE("Dual BSD/GPL"); 143 #if defined(__FreeBSD__) 144 MODULE_VERSION(mt76_core, 1); 145 MODULE_DEPEND(mt76_core, linuxkpi, 1, 1, 1); 146 MODULE_DEPEND(mt76_core, linuxkpi_wlan, 1, 1, 1); 147 #endif 148