1 // SPDX-License-Identifier: GPL-2.0 OR BSD-3-Clause
2 /* Copyright(c) 2018-2019 Realtek Corporation
3 */
4
5 #include "main.h"
6 #include "util.h"
7 #include "reg.h"
8
check_hw_ready(struct rtw_dev * rtwdev,u32 addr,u32 mask,u32 target)9 bool check_hw_ready(struct rtw_dev *rtwdev, u32 addr, u32 mask, u32 target)
10 {
11 u32 cnt;
12
13 for (cnt = 0; cnt < 1000; cnt++) {
14 if (rtw_read32_mask(rtwdev, addr, mask) == target)
15 return true;
16
17 udelay(10);
18 }
19
20 return false;
21 }
22 EXPORT_SYMBOL(check_hw_ready);
23
ltecoex_read_reg(struct rtw_dev * rtwdev,u16 offset,u32 * val)24 bool ltecoex_read_reg(struct rtw_dev *rtwdev, u16 offset, u32 *val)
25 {
26 const struct rtw_chip_info *chip = rtwdev->chip;
27 const struct rtw_ltecoex_addr *ltecoex = chip->ltecoex_addr;
28
29 if (!check_hw_ready(rtwdev, ltecoex->ctrl, LTECOEX_READY, 1))
30 return false;
31
32 rtw_write32(rtwdev, ltecoex->ctrl, 0x800F0000 | offset);
33 *val = rtw_read32(rtwdev, ltecoex->rdata);
34
35 return true;
36 }
37
ltecoex_reg_write(struct rtw_dev * rtwdev,u16 offset,u32 value)38 bool ltecoex_reg_write(struct rtw_dev *rtwdev, u16 offset, u32 value)
39 {
40 const struct rtw_chip_info *chip = rtwdev->chip;
41 const struct rtw_ltecoex_addr *ltecoex = chip->ltecoex_addr;
42
43 if (!check_hw_ready(rtwdev, ltecoex->ctrl, LTECOEX_READY, 1))
44 return false;
45
46 rtw_write32(rtwdev, ltecoex->wdata, value);
47 rtw_write32(rtwdev, ltecoex->ctrl, 0xC00F0000 | offset);
48
49 return true;
50 }
51
rtw_restore_reg(struct rtw_dev * rtwdev,struct rtw_backup_info * bckp,u32 num)52 void rtw_restore_reg(struct rtw_dev *rtwdev,
53 struct rtw_backup_info *bckp, u32 num)
54 {
55 u8 len;
56 u32 reg;
57 u32 val;
58 int i;
59
60 for (i = 0; i < num; i++, bckp++) {
61 len = bckp->len;
62 reg = bckp->reg;
63 val = bckp->val;
64
65 switch (len) {
66 case 1:
67 rtw_write8(rtwdev, reg, (u8)val);
68 break;
69 case 2:
70 rtw_write16(rtwdev, reg, (u16)val);
71 break;
72 case 4:
73 rtw_write32(rtwdev, reg, (u32)val);
74 break;
75 default:
76 break;
77 }
78 }
79 }
80 EXPORT_SYMBOL(rtw_restore_reg);
81
rtw_desc_to_mcsrate(u16 rate,u8 * mcs,u8 * nss)82 void rtw_desc_to_mcsrate(u16 rate, u8 *mcs, u8 *nss)
83 {
84 if (rate <= DESC_RATE54M)
85 return;
86
87 if (rate >= DESC_RATEVHT1SS_MCS0 &&
88 rate <= DESC_RATEVHT1SS_MCS9) {
89 *nss = 1;
90 *mcs = rate - DESC_RATEVHT1SS_MCS0;
91 } else if (rate >= DESC_RATEVHT2SS_MCS0 &&
92 rate <= DESC_RATEVHT2SS_MCS9) {
93 *nss = 2;
94 *mcs = rate - DESC_RATEVHT2SS_MCS0;
95 } else if (rate >= DESC_RATEVHT3SS_MCS0 &&
96 rate <= DESC_RATEVHT3SS_MCS9) {
97 *nss = 3;
98 *mcs = rate - DESC_RATEVHT3SS_MCS0;
99 } else if (rate >= DESC_RATEVHT4SS_MCS0 &&
100 rate <= DESC_RATEVHT4SS_MCS9) {
101 *nss = 4;
102 *mcs = rate - DESC_RATEVHT4SS_MCS0;
103 } else if (rate >= DESC_RATEMCS0 &&
104 rate <= DESC_RATEMCS31) {
105 *nss = 0;
106 *mcs = rate - DESC_RATEMCS0;
107 }
108 }
109
110 struct rtw_stas_entry {
111 struct list_head list;
112 struct ieee80211_sta *sta;
113 };
114
115 struct rtw_iter_stas_data {
116 struct rtw_dev *rtwdev;
117 struct list_head list;
118 };
119
rtw_collect_sta_iter(void * data,struct ieee80211_sta * sta)120 static void rtw_collect_sta_iter(void *data, struct ieee80211_sta *sta)
121 {
122 struct rtw_iter_stas_data *iter_stas = data;
123 struct rtw_stas_entry *stas_entry;
124
125 stas_entry = kmalloc(sizeof(*stas_entry), GFP_ATOMIC);
126 if (!stas_entry)
127 return;
128
129 stas_entry->sta = sta;
130 list_add_tail(&stas_entry->list, &iter_stas->list);
131 }
132
rtw_iterate_stas(struct rtw_dev * rtwdev,void (* iterator)(void * data,struct ieee80211_sta * sta),void * data)133 void rtw_iterate_stas(struct rtw_dev *rtwdev,
134 void (*iterator)(void *data,
135 struct ieee80211_sta *sta),
136 void *data)
137 {
138 struct rtw_iter_stas_data iter_data;
139 struct rtw_stas_entry *sta_entry, *tmp;
140
141 /* &rtwdev->mutex makes sure no stations can be removed between
142 * collecting the stations and iterating over them.
143 */
144 lockdep_assert_held(&rtwdev->mutex);
145
146 iter_data.rtwdev = rtwdev;
147 INIT_LIST_HEAD(&iter_data.list);
148
149 ieee80211_iterate_stations_atomic(rtwdev->hw, rtw_collect_sta_iter,
150 &iter_data);
151
152 list_for_each_entry_safe(sta_entry, tmp, &iter_data.list,
153 list) {
154 list_del_init(&sta_entry->list);
155 iterator(data, sta_entry->sta);
156 kfree(sta_entry);
157 }
158 }
159
160 struct rtw_vifs_entry {
161 struct list_head list;
162 struct ieee80211_vif *vif;
163 };
164
165 struct rtw_iter_vifs_data {
166 struct rtw_dev *rtwdev;
167 struct list_head list;
168 };
169
rtw_collect_vif_iter(void * data,u8 * mac,struct ieee80211_vif * vif)170 static void rtw_collect_vif_iter(void *data, u8 *mac, struct ieee80211_vif *vif)
171 {
172 struct rtw_iter_vifs_data *iter_stas = data;
173 struct rtw_vifs_entry *vifs_entry;
174
175 vifs_entry = kmalloc(sizeof(*vifs_entry), GFP_ATOMIC);
176 if (!vifs_entry)
177 return;
178
179 vifs_entry->vif = vif;
180 list_add_tail(&vifs_entry->list, &iter_stas->list);
181 }
182
rtw_iterate_vifs(struct rtw_dev * rtwdev,void (* iterator)(void * data,struct ieee80211_vif * vif),void * data)183 void rtw_iterate_vifs(struct rtw_dev *rtwdev,
184 void (*iterator)(void *data, struct ieee80211_vif *vif),
185 void *data)
186 {
187 struct rtw_iter_vifs_data iter_data;
188 struct rtw_vifs_entry *vif_entry, *tmp;
189
190 /* &rtwdev->mutex makes sure no interfaces can be removed between
191 * collecting the interfaces and iterating over them.
192 */
193 lockdep_assert_held(&rtwdev->mutex);
194
195 iter_data.rtwdev = rtwdev;
196 INIT_LIST_HEAD(&iter_data.list);
197
198 ieee80211_iterate_active_interfaces_atomic(rtwdev->hw,
199 IEEE80211_IFACE_ITER_NORMAL,
200 rtw_collect_vif_iter, &iter_data);
201
202 list_for_each_entry_safe(vif_entry, tmp, &iter_data.list,
203 list) {
204 list_del_init(&vif_entry->list);
205 iterator(data, vif_entry->vif);
206 kfree(vif_entry);
207 }
208 }
209