1 /* SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause 2 * Copyright(c) 2019-2020 Realtek Corporation 3 */ 4 #ifndef __RTW89_UTIL_H__ 5 #define __RTW89_UTIL_H__ 6 7 #include "core.h" 8 9 #define RTW89_LINEAR_FRAC_BITS 3 10 11 #define rtw89_iterate_vifs_bh(rtwdev, iterator, data) \ 12 ieee80211_iterate_active_interfaces_atomic((rtwdev)->hw, \ 13 IEEE80211_IFACE_ITER_NORMAL, iterator, data) 14 15 /* call this function with rtwdev->mutex is held */ 16 #define rtw89_for_each_rtwvif(rtwdev, rtwvif) \ 17 list_for_each_entry(rtwvif, &(rtwdev)->rtwvifs_list, list) 18 19 /* Before adding rtwvif to list, we need to check if it already exist, beacase 20 * in some case such as SER L2 happen during WoWLAN flow, calling reconfig 21 * twice cause the list to be added twice. 22 */ 23 static inline bool rtw89_rtwvif_in_list(struct rtw89_dev *rtwdev, 24 struct rtw89_vif *new) 25 { 26 struct rtw89_vif *rtwvif; 27 28 lockdep_assert_held(&rtwdev->mutex); 29 30 rtw89_for_each_rtwvif(rtwdev, rtwvif) 31 if (rtwvif == new) 32 return true; 33 34 return false; 35 } 36 37 /* The result of negative dividend and positive divisor is undefined, but it 38 * should be one case of round-down or round-up. So, make it round-down if the 39 * result is round-up. 40 * Note: the maximum value of divisor is 0x7FFF_FFFF, because we cast it to 41 * signed value to make compiler to use signed divide instruction. 42 */ 43 static inline s32 s32_div_u32_round_down(s32 dividend, u32 divisor, s32 *remainder) 44 { 45 s32 i_divisor = (s32)divisor; 46 s32 i_remainder; 47 s32 quotient; 48 49 quotient = dividend / i_divisor; 50 i_remainder = dividend % i_divisor; 51 52 if (i_remainder < 0) { 53 quotient--; 54 i_remainder += i_divisor; 55 } 56 57 if (remainder) 58 *remainder = i_remainder; 59 return quotient; 60 } 61 62 static inline s32 s32_div_u32_round_closest(s32 dividend, u32 divisor) 63 { 64 return s32_div_u32_round_down(dividend + divisor / 2, divisor, NULL); 65 } 66 67 static inline void ether_addr_copy_mask(u8 *dst, const u8 *src, u8 mask) 68 { 69 int i; 70 71 eth_zero_addr(dst); 72 for (i = 0; i < ETH_ALEN; i++) { 73 if (mask & BIT(i)) 74 dst[i] = src[i]; 75 } 76 } 77 78 u32 rtw89_linear_2_db(u64 linear); 79 u64 rtw89_db_2_linear(u32 db); 80 81 #endif 82