util.c

  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
  9bool 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}
 22EXPORT_SYMBOL(check_hw_ready);
 23
 24bool 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
 38bool 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
 52void 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}
 80EXPORT_SYMBOL(rtw_restore_reg);
 81
 82void 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
110struct rtw_stas_entry {
111	struct list_head list;
112	struct ieee80211_sta *sta;
113};
114
115struct rtw_iter_stas_data {
116	struct rtw_dev *rtwdev;
117	struct list_head list;
118};
119
120static 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
133void 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
160struct rtw_vifs_entry {
161	struct list_head list;
162	struct ieee80211_vif *vif;
163};
164
165struct rtw_iter_vifs_data {
166	struct rtw_dev *rtwdev;
167	struct list_head list;
168};
169
170static 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
183void 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}