Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 | /* SPDX-License-Identifier: GPL-2.0-only */ /* * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name> * Copyright (C) 2004 - 2009 Ivo van Doorn <IvDoorn@gmail.com> */ #ifndef __MT76_UTIL_H #define __MT76_UTIL_H #include <linux/skbuff.h> #include <linux/bitops.h> #include <linux/bitfield.h> #include <net/mac80211.h> struct mt76_worker { struct task_struct *task; void (*fn)(struct mt76_worker *); unsigned long state; }; enum { MT76_WORKER_SCHEDULED, MT76_WORKER_RUNNING, }; #define MT76_INCR(_var, _size) \ (_var = (((_var) + 1) % (_size))) int mt76_wcid_alloc(u32 *mask, int size); static inline void mt76_wcid_mask_set(u32 *mask, int idx) { mask[idx / 32] |= BIT(idx % 32); } static inline void mt76_wcid_mask_clear(u32 *mask, int idx) { mask[idx / 32] &= ~BIT(idx % 32); } static inline void mt76_skb_set_moredata(struct sk_buff *skb, bool enable) { struct ieee80211_hdr *hdr = (struct ieee80211_hdr *)skb->data; if (enable) hdr->frame_control |= cpu_to_le16(IEEE80211_FCTL_MOREDATA); else hdr->frame_control &= ~cpu_to_le16(IEEE80211_FCTL_MOREDATA); } int __mt76_worker_fn(void *ptr); static inline int mt76_worker_setup(struct ieee80211_hw *hw, struct mt76_worker *w, void (*fn)(struct mt76_worker *), const char *name) { const char *dev_name = wiphy_name(hw->wiphy); int ret; if (fn) w->fn = fn; w->task = kthread_run(__mt76_worker_fn, w, "mt76-%s %s", name, dev_name); if (IS_ERR(w->task)) { ret = PTR_ERR(w->task); w->task = NULL; return ret; } return 0; } static inline void mt76_worker_schedule(struct mt76_worker *w) { if (!w->task) return; if (!test_and_set_bit(MT76_WORKER_SCHEDULED, &w->state) && !test_bit(MT76_WORKER_RUNNING, &w->state)) wake_up_process(w->task); } static inline void mt76_worker_disable(struct mt76_worker *w) { if (!w->task) return; kthread_park(w->task); WRITE_ONCE(w->state, 0); } static inline void mt76_worker_enable(struct mt76_worker *w) { if (!w->task) return; kthread_unpark(w->task); mt76_worker_schedule(w); } static inline void mt76_worker_teardown(struct mt76_worker *w) { if (!w->task) return; kthread_stop(w->task); w->task = NULL; } #endif |