net/mac80211/driver-ops.c

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