xref: /linux/net/mac80211/driver-ops.c (revision a1ff5a7d78a036d6c2178ee5acd6ba4946243800)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright 2015 Intel Deutschland GmbH
4  * Copyright (C) 2022-2024 Intel Corporation
5  */
6 #include <net/mac80211.h>
7 #include "ieee80211_i.h"
8 #include "trace.h"
9 #include "driver-ops.h"
10 #include "debugfs_sta.h"
11 #include "debugfs_netdev.h"
12 
drv_start(struct ieee80211_local * local)13 int drv_start(struct ieee80211_local *local)
14 {
15 	int ret;
16 
17 	might_sleep();
18 	lockdep_assert_wiphy(local->hw.wiphy);
19 
20 	if (WARN_ON(local->started))
21 		return -EALREADY;
22 
23 	trace_drv_start(local);
24 	local->started = true;
25 	/* allow rx frames */
26 	smp_mb();
27 	ret = local->ops->start(&local->hw);
28 	trace_drv_return_int(local, ret);
29 
30 	if (ret)
31 		local->started = false;
32 
33 	return ret;
34 }
35 
drv_stop(struct ieee80211_local * local,bool suspend)36 void drv_stop(struct ieee80211_local *local, bool suspend)
37 {
38 	might_sleep();
39 	lockdep_assert_wiphy(local->hw.wiphy);
40 
41 	if (WARN_ON(!local->started))
42 		return;
43 
44 	trace_drv_stop(local, suspend);
45 	local->ops->stop(&local->hw, suspend);
46 	trace_drv_return_void(local);
47 
48 	/* sync away all work on the tasklet before clearing started */
49 	tasklet_disable(&local->tasklet);
50 	tasklet_enable(&local->tasklet);
51 
52 	barrier();
53 
54 	local->started = false;
55 }
56 
drv_add_interface(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata)57 int drv_add_interface(struct ieee80211_local *local,
58 		      struct ieee80211_sub_if_data *sdata)
59 {
60 	int ret;
61 
62 	might_sleep();
63 	lockdep_assert_wiphy(local->hw.wiphy);
64 
65 	if (WARN_ON(sdata->vif.type == NL80211_IFTYPE_AP_VLAN ||
66 		    (sdata->vif.type == NL80211_IFTYPE_MONITOR &&
67 		     !ieee80211_hw_check(&local->hw, WANT_MONITOR_VIF) &&
68 		     !(sdata->u.mntr.flags & MONITOR_FLAG_ACTIVE))))
69 		return -EINVAL;
70 
71 	trace_drv_add_interface(local, sdata);
72 	ret = local->ops->add_interface(&local->hw, &sdata->vif);
73 	trace_drv_return_int(local, ret);
74 
75 	if (ret)
76 		return ret;
77 
78 	if (!(sdata->flags & IEEE80211_SDATA_IN_DRIVER)) {
79 		sdata->flags |= IEEE80211_SDATA_IN_DRIVER;
80 
81 		drv_vif_add_debugfs(local, sdata);
82 		/* initially vif is not MLD */
83 		ieee80211_link_debugfs_drv_add(&sdata->deflink);
84 	}
85 
86 	return 0;
87 }
88 
drv_change_interface(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,enum nl80211_iftype type,bool p2p)89 int drv_change_interface(struct ieee80211_local *local,
90 			 struct ieee80211_sub_if_data *sdata,
91 			 enum nl80211_iftype type, bool p2p)
92 {
93 	int ret;
94 
95 	might_sleep();
96 	lockdep_assert_wiphy(local->hw.wiphy);
97 
98 	if (!check_sdata_in_driver(sdata))
99 		return -EIO;
100 
101 	trace_drv_change_interface(local, sdata, type, p2p);
102 	ret = local->ops->change_interface(&local->hw, &sdata->vif, type, p2p);
103 	trace_drv_return_int(local, ret);
104 	return ret;
105 }
106 
drv_remove_interface(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata)107 void drv_remove_interface(struct ieee80211_local *local,
108 			  struct ieee80211_sub_if_data *sdata)
109 {
110 	might_sleep();
111 	lockdep_assert_wiphy(local->hw.wiphy);
112 
113 	if (!check_sdata_in_driver(sdata))
114 		return;
115 
116 	sdata->flags &= ~IEEE80211_SDATA_IN_DRIVER;
117 
118 	/* Remove driver debugfs entries */
119 	ieee80211_debugfs_recreate_netdev(sdata, sdata->vif.valid_links);
120 
121 	trace_drv_remove_interface(local, sdata);
122 	local->ops->remove_interface(&local->hw, &sdata->vif);
123 	trace_drv_return_void(local);
124 }
125 
126 __must_check
drv_sta_state(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,struct sta_info * sta,enum ieee80211_sta_state old_state,enum ieee80211_sta_state new_state)127 int drv_sta_state(struct ieee80211_local *local,
128 		  struct ieee80211_sub_if_data *sdata,
129 		  struct sta_info *sta,
130 		  enum ieee80211_sta_state old_state,
131 		  enum ieee80211_sta_state new_state)
132 {
133 	int ret = 0;
134 
135 	might_sleep();
136 	lockdep_assert_wiphy(local->hw.wiphy);
137 
138 	sdata = get_bss_sdata(sdata);
139 	if (!check_sdata_in_driver(sdata))
140 		return -EIO;
141 
142 	trace_drv_sta_state(local, sdata, &sta->sta, old_state, new_state);
143 	if (local->ops->sta_state) {
144 		ret = local->ops->sta_state(&local->hw, &sdata->vif, &sta->sta,
145 					    old_state, new_state);
146 	} else if (old_state == IEEE80211_STA_AUTH &&
147 		   new_state == IEEE80211_STA_ASSOC) {
148 		ret = drv_sta_add(local, sdata, &sta->sta);
149 		if (ret == 0) {
150 			sta->uploaded = true;
151 			if (rcu_access_pointer(sta->sta.rates))
152 				drv_sta_rate_tbl_update(local, sdata, &sta->sta);
153 		}
154 	} else if (old_state == IEEE80211_STA_ASSOC &&
155 		   new_state == IEEE80211_STA_AUTH) {
156 		drv_sta_remove(local, sdata, &sta->sta);
157 	}
158 	trace_drv_return_int(local, ret);
159 	return ret;
160 }
161 
162 __must_check
drv_sta_set_txpwr(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,struct sta_info * sta)163 int drv_sta_set_txpwr(struct ieee80211_local *local,
164 		      struct ieee80211_sub_if_data *sdata,
165 		      struct sta_info *sta)
166 {
167 	int ret = -EOPNOTSUPP;
168 
169 	might_sleep();
170 	lockdep_assert_wiphy(local->hw.wiphy);
171 
172 	sdata = get_bss_sdata(sdata);
173 	if (!check_sdata_in_driver(sdata))
174 		return -EIO;
175 
176 	trace_drv_sta_set_txpwr(local, sdata, &sta->sta);
177 	if (local->ops->sta_set_txpwr)
178 		ret = local->ops->sta_set_txpwr(&local->hw, &sdata->vif,
179 						&sta->sta);
180 	trace_drv_return_int(local, ret);
181 	return ret;
182 }
183 
drv_sta_rc_update(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,struct ieee80211_sta * sta,u32 changed)184 void drv_sta_rc_update(struct ieee80211_local *local,
185 		       struct ieee80211_sub_if_data *sdata,
186 		       struct ieee80211_sta *sta, u32 changed)
187 {
188 	sdata = get_bss_sdata(sdata);
189 	if (!check_sdata_in_driver(sdata))
190 		return;
191 
192 	WARN_ON(changed & IEEE80211_RC_SUPP_RATES_CHANGED &&
193 		(sdata->vif.type != NL80211_IFTYPE_ADHOC &&
194 		 sdata->vif.type != NL80211_IFTYPE_MESH_POINT));
195 
196 	trace_drv_sta_rc_update(local, sdata, sta, changed);
197 	if (local->ops->sta_rc_update)
198 		local->ops->sta_rc_update(&local->hw, &sdata->vif,
199 					  sta, changed);
200 
201 	trace_drv_return_void(local);
202 }
203 
drv_conf_tx(struct ieee80211_local * local,struct ieee80211_link_data * link,u16 ac,const struct ieee80211_tx_queue_params * params)204 int drv_conf_tx(struct ieee80211_local *local,
205 		struct ieee80211_link_data *link, u16 ac,
206 		const struct ieee80211_tx_queue_params *params)
207 {
208 	struct ieee80211_sub_if_data *sdata = link->sdata;
209 	int ret = -EOPNOTSUPP;
210 
211 	might_sleep();
212 	lockdep_assert_wiphy(local->hw.wiphy);
213 
214 	if (!check_sdata_in_driver(sdata))
215 		return -EIO;
216 
217 	if (!ieee80211_vif_link_active(&sdata->vif, link->link_id))
218 		return 0;
219 
220 	if (params->cw_min == 0 || params->cw_min > params->cw_max) {
221 		/*
222 		 * If we can't configure hardware anyway, don't warn. We may
223 		 * never have initialized the CW parameters.
224 		 */
225 		WARN_ONCE(local->ops->conf_tx,
226 			  "%s: invalid CW_min/CW_max: %d/%d\n",
227 			  sdata->name, params->cw_min, params->cw_max);
228 		return -EINVAL;
229 	}
230 
231 	trace_drv_conf_tx(local, sdata, link->link_id, ac, params);
232 	if (local->ops->conf_tx)
233 		ret = local->ops->conf_tx(&local->hw, &sdata->vif,
234 					  link->link_id, ac, params);
235 	trace_drv_return_int(local, ret);
236 	return ret;
237 }
238 
drv_get_tsf(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata)239 u64 drv_get_tsf(struct ieee80211_local *local,
240 		struct ieee80211_sub_if_data *sdata)
241 {
242 	u64 ret = -1ULL;
243 
244 	might_sleep();
245 	lockdep_assert_wiphy(local->hw.wiphy);
246 
247 	if (!check_sdata_in_driver(sdata))
248 		return ret;
249 
250 	trace_drv_get_tsf(local, sdata);
251 	if (local->ops->get_tsf)
252 		ret = local->ops->get_tsf(&local->hw, &sdata->vif);
253 	trace_drv_return_u64(local, ret);
254 	return ret;
255 }
256 
drv_set_tsf(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,u64 tsf)257 void drv_set_tsf(struct ieee80211_local *local,
258 		 struct ieee80211_sub_if_data *sdata,
259 		 u64 tsf)
260 {
261 	might_sleep();
262 	lockdep_assert_wiphy(local->hw.wiphy);
263 
264 	if (!check_sdata_in_driver(sdata))
265 		return;
266 
267 	trace_drv_set_tsf(local, sdata, tsf);
268 	if (local->ops->set_tsf)
269 		local->ops->set_tsf(&local->hw, &sdata->vif, tsf);
270 	trace_drv_return_void(local);
271 }
272 
drv_offset_tsf(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,s64 offset)273 void drv_offset_tsf(struct ieee80211_local *local,
274 		    struct ieee80211_sub_if_data *sdata,
275 		    s64 offset)
276 {
277 	might_sleep();
278 	lockdep_assert_wiphy(local->hw.wiphy);
279 
280 	if (!check_sdata_in_driver(sdata))
281 		return;
282 
283 	trace_drv_offset_tsf(local, sdata, offset);
284 	if (local->ops->offset_tsf)
285 		local->ops->offset_tsf(&local->hw, &sdata->vif, offset);
286 	trace_drv_return_void(local);
287 }
288 
drv_reset_tsf(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata)289 void drv_reset_tsf(struct ieee80211_local *local,
290 		   struct ieee80211_sub_if_data *sdata)
291 {
292 	might_sleep();
293 	lockdep_assert_wiphy(local->hw.wiphy);
294 
295 	if (!check_sdata_in_driver(sdata))
296 		return;
297 
298 	trace_drv_reset_tsf(local, sdata);
299 	if (local->ops->reset_tsf)
300 		local->ops->reset_tsf(&local->hw, &sdata->vif);
301 	trace_drv_return_void(local);
302 }
303 
drv_assign_vif_chanctx(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,struct ieee80211_bss_conf * link_conf,struct ieee80211_chanctx * ctx)304 int drv_assign_vif_chanctx(struct ieee80211_local *local,
305 			   struct ieee80211_sub_if_data *sdata,
306 			   struct ieee80211_bss_conf *link_conf,
307 			   struct ieee80211_chanctx *ctx)
308 {
309 	int ret = 0;
310 
311 	might_sleep();
312 	lockdep_assert_wiphy(local->hw.wiphy);
313 
314 	/*
315 	 * We should perhaps push emulate chanctx down and only
316 	 * make it call ->config() when the chanctx is actually
317 	 * assigned here (and unassigned below), but that's yet
318 	 * another change to all drivers to add assign/unassign
319 	 * emulation callbacks. Maybe later.
320 	 */
321 	if (sdata->vif.type == NL80211_IFTYPE_MONITOR &&
322 	    local->emulate_chanctx &&
323 	    !ieee80211_hw_check(&local->hw, WANT_MONITOR_VIF))
324 		return 0;
325 
326 	if (!check_sdata_in_driver(sdata))
327 		return -EIO;
328 
329 	if (!ieee80211_vif_link_active(&sdata->vif, link_conf->link_id))
330 		return 0;
331 
332 	trace_drv_assign_vif_chanctx(local, sdata, link_conf, ctx);
333 	if (local->ops->assign_vif_chanctx) {
334 		WARN_ON_ONCE(!ctx->driver_present);
335 		ret = local->ops->assign_vif_chanctx(&local->hw,
336 						     &sdata->vif,
337 						     link_conf,
338 						     &ctx->conf);
339 	}
340 	trace_drv_return_int(local, ret);
341 
342 	return ret;
343 }
344 
drv_unassign_vif_chanctx(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,struct ieee80211_bss_conf * link_conf,struct ieee80211_chanctx * ctx)345 void drv_unassign_vif_chanctx(struct ieee80211_local *local,
346 			      struct ieee80211_sub_if_data *sdata,
347 			      struct ieee80211_bss_conf *link_conf,
348 			      struct ieee80211_chanctx *ctx)
349 {
350 	might_sleep();
351 	lockdep_assert_wiphy(local->hw.wiphy);
352 
353 	if (sdata->vif.type == NL80211_IFTYPE_MONITOR &&
354 	    local->emulate_chanctx &&
355 	    !ieee80211_hw_check(&local->hw, WANT_MONITOR_VIF))
356 		return;
357 
358 	if (!check_sdata_in_driver(sdata))
359 		return;
360 
361 	if (!ieee80211_vif_link_active(&sdata->vif, link_conf->link_id))
362 		return;
363 
364 	trace_drv_unassign_vif_chanctx(local, sdata, link_conf, ctx);
365 	if (local->ops->unassign_vif_chanctx) {
366 		WARN_ON_ONCE(!ctx->driver_present);
367 		local->ops->unassign_vif_chanctx(&local->hw,
368 						 &sdata->vif,
369 						 link_conf,
370 						 &ctx->conf);
371 	}
372 	trace_drv_return_void(local);
373 }
374 
drv_switch_vif_chanctx(struct ieee80211_local * local,struct ieee80211_vif_chanctx_switch * vifs,int n_vifs,enum ieee80211_chanctx_switch_mode mode)375 int drv_switch_vif_chanctx(struct ieee80211_local *local,
376 			   struct ieee80211_vif_chanctx_switch *vifs,
377 			   int n_vifs, enum ieee80211_chanctx_switch_mode mode)
378 {
379 	int ret = 0;
380 	int i;
381 
382 	might_sleep();
383 	lockdep_assert_wiphy(local->hw.wiphy);
384 
385 	if (!local->ops->switch_vif_chanctx)
386 		return -EOPNOTSUPP;
387 
388 	for (i = 0; i < n_vifs; i++) {
389 		struct ieee80211_chanctx *new_ctx =
390 			container_of(vifs[i].new_ctx,
391 				     struct ieee80211_chanctx,
392 				     conf);
393 		struct ieee80211_chanctx *old_ctx =
394 			container_of(vifs[i].old_ctx,
395 				     struct ieee80211_chanctx,
396 				     conf);
397 
398 		WARN_ON_ONCE(!old_ctx->driver_present);
399 		WARN_ON_ONCE((mode == CHANCTX_SWMODE_SWAP_CONTEXTS &&
400 			      new_ctx->driver_present) ||
401 			     (mode == CHANCTX_SWMODE_REASSIGN_VIF &&
402 			      !new_ctx->driver_present));
403 	}
404 
405 	trace_drv_switch_vif_chanctx(local, vifs, n_vifs, mode);
406 	ret = local->ops->switch_vif_chanctx(&local->hw,
407 					     vifs, n_vifs, mode);
408 	trace_drv_return_int(local, ret);
409 
410 	if (!ret && mode == CHANCTX_SWMODE_SWAP_CONTEXTS) {
411 		for (i = 0; i < n_vifs; i++) {
412 			struct ieee80211_chanctx *new_ctx =
413 				container_of(vifs[i].new_ctx,
414 					     struct ieee80211_chanctx,
415 					     conf);
416 			struct ieee80211_chanctx *old_ctx =
417 				container_of(vifs[i].old_ctx,
418 					     struct ieee80211_chanctx,
419 					     conf);
420 
421 			new_ctx->driver_present = true;
422 			old_ctx->driver_present = false;
423 		}
424 	}
425 
426 	return ret;
427 }
428 
drv_ampdu_action(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,struct ieee80211_ampdu_params * params)429 int drv_ampdu_action(struct ieee80211_local *local,
430 		     struct ieee80211_sub_if_data *sdata,
431 		     struct ieee80211_ampdu_params *params)
432 {
433 	int ret = -EOPNOTSUPP;
434 
435 	might_sleep();
436 	lockdep_assert_wiphy(local->hw.wiphy);
437 
438 	sdata = get_bss_sdata(sdata);
439 	if (!check_sdata_in_driver(sdata))
440 		return -EIO;
441 
442 	trace_drv_ampdu_action(local, sdata, params);
443 
444 	if (local->ops->ampdu_action)
445 		ret = local->ops->ampdu_action(&local->hw, &sdata->vif, params);
446 
447 	trace_drv_return_int(local, ret);
448 
449 	return ret;
450 }
451 
drv_link_info_changed(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,struct ieee80211_bss_conf * info,int link_id,u64 changed)452 void drv_link_info_changed(struct ieee80211_local *local,
453 			   struct ieee80211_sub_if_data *sdata,
454 			   struct ieee80211_bss_conf *info,
455 			   int link_id, u64 changed)
456 {
457 	might_sleep();
458 	lockdep_assert_wiphy(local->hw.wiphy);
459 
460 	if (WARN_ON_ONCE(changed & (BSS_CHANGED_BEACON |
461 				    BSS_CHANGED_BEACON_ENABLED) &&
462 			 sdata->vif.type != NL80211_IFTYPE_AP &&
463 			 sdata->vif.type != NL80211_IFTYPE_ADHOC &&
464 			 sdata->vif.type != NL80211_IFTYPE_MESH_POINT &&
465 			 sdata->vif.type != NL80211_IFTYPE_OCB))
466 		return;
467 
468 	if (WARN_ON_ONCE(sdata->vif.type == NL80211_IFTYPE_P2P_DEVICE ||
469 			 sdata->vif.type == NL80211_IFTYPE_NAN ||
470 			 (sdata->vif.type == NL80211_IFTYPE_MONITOR &&
471 			  !sdata->vif.bss_conf.mu_mimo_owner &&
472 			  !(changed & BSS_CHANGED_TXPOWER))))
473 		return;
474 
475 	if (!check_sdata_in_driver(sdata))
476 		return;
477 
478 	if (!ieee80211_vif_link_active(&sdata->vif, link_id))
479 		return;
480 
481 	trace_drv_link_info_changed(local, sdata, info, changed);
482 	if (local->ops->link_info_changed)
483 		local->ops->link_info_changed(&local->hw, &sdata->vif,
484 					      info, changed);
485 	else if (local->ops->bss_info_changed)
486 		local->ops->bss_info_changed(&local->hw, &sdata->vif,
487 					     info, changed);
488 	trace_drv_return_void(local);
489 }
490 
drv_set_key(struct ieee80211_local * local,enum set_key_cmd cmd,struct ieee80211_sub_if_data * sdata,struct ieee80211_sta * sta,struct ieee80211_key_conf * key)491 int drv_set_key(struct ieee80211_local *local,
492 		enum set_key_cmd cmd,
493 		struct ieee80211_sub_if_data *sdata,
494 		struct ieee80211_sta *sta,
495 		struct ieee80211_key_conf *key)
496 {
497 	int ret;
498 
499 	might_sleep();
500 	lockdep_assert_wiphy(local->hw.wiphy);
501 
502 	sdata = get_bss_sdata(sdata);
503 	if (!check_sdata_in_driver(sdata))
504 		return -EIO;
505 
506 	if (WARN_ON(key->link_id >= 0 && sdata->vif.active_links &&
507 		    !(sdata->vif.active_links & BIT(key->link_id))))
508 		return -ENOLINK;
509 
510 	trace_drv_set_key(local, cmd, sdata, sta, key);
511 	ret = local->ops->set_key(&local->hw, cmd, &sdata->vif, sta, key);
512 	trace_drv_return_int(local, ret);
513 	return ret;
514 }
515 
drv_change_vif_links(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,u16 old_links,u16 new_links,struct ieee80211_bss_conf * old[IEEE80211_MLD_MAX_NUM_LINKS])516 int drv_change_vif_links(struct ieee80211_local *local,
517 			 struct ieee80211_sub_if_data *sdata,
518 			 u16 old_links, u16 new_links,
519 			 struct ieee80211_bss_conf *old[IEEE80211_MLD_MAX_NUM_LINKS])
520 {
521 	struct ieee80211_link_data *link;
522 	unsigned long links_to_add;
523 	unsigned long links_to_rem;
524 	unsigned int link_id;
525 	int ret = -EOPNOTSUPP;
526 
527 	might_sleep();
528 	lockdep_assert_wiphy(local->hw.wiphy);
529 
530 	if (!check_sdata_in_driver(sdata))
531 		return -EIO;
532 
533 	if (old_links == new_links)
534 		return 0;
535 
536 	links_to_add = ~old_links & new_links;
537 	links_to_rem = old_links & ~new_links;
538 
539 	for_each_set_bit(link_id, &links_to_rem, IEEE80211_MLD_MAX_NUM_LINKS) {
540 		link = rcu_access_pointer(sdata->link[link_id]);
541 
542 		ieee80211_link_debugfs_drv_remove(link);
543 	}
544 
545 	trace_drv_change_vif_links(local, sdata, old_links, new_links);
546 	if (local->ops->change_vif_links)
547 		ret = local->ops->change_vif_links(&local->hw, &sdata->vif,
548 						   old_links, new_links, old);
549 	trace_drv_return_int(local, ret);
550 
551 	if (ret)
552 		return ret;
553 
554 	if (!local->in_reconfig && !local->resuming) {
555 		for_each_set_bit(link_id, &links_to_add,
556 				 IEEE80211_MLD_MAX_NUM_LINKS) {
557 			link = rcu_access_pointer(sdata->link[link_id]);
558 
559 			ieee80211_link_debugfs_drv_add(link);
560 		}
561 	}
562 
563 	return 0;
564 }
565 
drv_change_sta_links(struct ieee80211_local * local,struct ieee80211_sub_if_data * sdata,struct ieee80211_sta * sta,u16 old_links,u16 new_links)566 int drv_change_sta_links(struct ieee80211_local *local,
567 			 struct ieee80211_sub_if_data *sdata,
568 			 struct ieee80211_sta *sta,
569 			 u16 old_links, u16 new_links)
570 {
571 	struct sta_info *info = container_of(sta, struct sta_info, sta);
572 	struct link_sta_info *link_sta;
573 	unsigned long links_to_add;
574 	unsigned long links_to_rem;
575 	unsigned int link_id;
576 	int ret = -EOPNOTSUPP;
577 
578 	might_sleep();
579 	lockdep_assert_wiphy(local->hw.wiphy);
580 
581 	if (!check_sdata_in_driver(sdata))
582 		return -EIO;
583 
584 	old_links &= sdata->vif.active_links;
585 	new_links &= sdata->vif.active_links;
586 
587 	if (old_links == new_links)
588 		return 0;
589 
590 	links_to_add = ~old_links & new_links;
591 	links_to_rem = old_links & ~new_links;
592 
593 	for_each_set_bit(link_id, &links_to_rem, IEEE80211_MLD_MAX_NUM_LINKS) {
594 		link_sta = rcu_dereference_protected(info->link[link_id],
595 						     lockdep_is_held(&local->hw.wiphy->mtx));
596 
597 		ieee80211_link_sta_debugfs_drv_remove(link_sta);
598 	}
599 
600 	trace_drv_change_sta_links(local, sdata, sta, old_links, new_links);
601 	if (local->ops->change_sta_links)
602 		ret = local->ops->change_sta_links(&local->hw, &sdata->vif, sta,
603 						   old_links, new_links);
604 	trace_drv_return_int(local, ret);
605 
606 	if (ret)
607 		return ret;
608 
609 	/* during reconfig don't add it to debugfs again */
610 	if (local->in_reconfig || local->resuming)
611 		return 0;
612 
613 	for_each_set_bit(link_id, &links_to_add, IEEE80211_MLD_MAX_NUM_LINKS) {
614 		link_sta = rcu_dereference_protected(info->link[link_id],
615 						     lockdep_is_held(&local->hw.wiphy->mtx));
616 		ieee80211_link_sta_debugfs_drv_add(link_sta);
617 	}
618 
619 	return 0;
620 }
621