sys/net80211/ieee80211_action.c

   1 /*-
   2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
   3  *
   4  * Copyright (c) 2009 Sam Leffler, Errno Consulting
   5  * All rights reserved.
   6  *
   7  * Redistribution and use in source and binary forms, with or without
   8  * modification, are permitted provided that the following conditions
   9  * are met:
  10  * 1. Redistributions of source code must retain the above copyright
  11  *    notice, this list of conditions and the following disclaimer.
  12  * 2. Redistributions in binary form must reproduce the above copyright
  13  *    notice, this list of conditions and the following disclaimer in the
  14  *    documentation and/or other materials provided with the distribution.
  15  *
  16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  17  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  18  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  19  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  20  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  21  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  22  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  23  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  24  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  25  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  26  */
  27
  28 #include <sys/cdefs.h>
  29 #ifdef __FreeBSD__
  30 __FBSDID("$FreeBSD$");
  31 #endif
  32
  33 /*
  34  * IEEE 802.11 send/recv action frame support.
  35  */
  36
  37 #include "opt_inet.h"
  38 #include "opt_wlan.h"
  39
  40 #include <sys/param.h>
  41 #include <sys/kernel.h>
  42 #include <sys/malloc.h>
  43 #include <sys/systm.h>
  44
  45 #include <sys/socket.h>
  46
  47 #include <net/if.h>
  48 #include <net/if_var.h>
  49 #include <net/if_media.h>
  50 #include <net/ethernet.h>
  51
  52 #include <net80211/ieee80211_var.h>
  53 #include <net80211/ieee80211_action.h>
  54 #include <net80211/ieee80211_mesh.h>
  55
  56 static int
  57 send_inval(struct ieee80211_node *ni, int cat, int act, void *sa)
  58 {
  59         return EINVAL;
  60 }
  61
  62 static ieee80211_send_action_func *ba_send_action[8] = {
  63         send_inval, send_inval, send_inval, send_inval,
  64         send_inval, send_inval, send_inval, send_inval,
  65 };
  66 static ieee80211_send_action_func *ht_send_action[8] = {
  67         send_inval, send_inval, send_inval, send_inval,
  68         send_inval, send_inval, send_inval, send_inval,
  69 };
  70 static ieee80211_send_action_func *meshpl_send_action[8] = {
  71         send_inval, send_inval, send_inval, send_inval,
  72         send_inval, send_inval, send_inval, send_inval,
  73 };
  74 static ieee80211_send_action_func *meshaction_send_action[12] = {
  75         send_inval, send_inval, send_inval, send_inval,
  76         send_inval, send_inval, send_inval, send_inval,
  77         send_inval, send_inval, send_inval, send_inval,
  78 };
  79 static ieee80211_send_action_func *vendor_send_action[8] = {
  80         send_inval, send_inval, send_inval, send_inval,
  81         send_inval, send_inval, send_inval, send_inval,
  82 };
  83
  84 static ieee80211_send_action_func *vht_send_action[3] = {
  85         send_inval, send_inval, send_inval,
  86 };
  87
  88 int
  89 ieee80211_send_action_register(int cat, int act, ieee80211_send_action_func *f)
  90 {
  91         switch (cat) {
  92         case IEEE80211_ACTION_CAT_BA:
  93                 if (act >= nitems(ba_send_action))
  94                         break;
  95                 ba_send_action[act] = f;
  96                 return 0;
  97         case IEEE80211_ACTION_CAT_HT:
  98                 if (act >= nitems(ht_send_action))
  99                         break;
 100                 ht_send_action[act] = f;
 101                 return 0;
 102         case IEEE80211_ACTION_CAT_SELF_PROT:
 103                 if (act >= nitems(meshpl_send_action))
 104                         break;
 105                 meshpl_send_action[act] = f;
 106                 return 0;
 107         case IEEE80211_ACTION_CAT_MESH:
 108                 if (act >= nitems(meshaction_send_action))
 109                         break;
 110                 meshaction_send_action[act] = f;
 111                 return 0;
 112         case IEEE80211_ACTION_CAT_VENDOR:
 113                 if (act >= nitems(vendor_send_action))
 114                         break;
 115                 vendor_send_action[act] = f;
 116                 return 0;
 117         case IEEE80211_ACTION_CAT_VHT:
 118                 if (act >= nitems(vht_send_action))
 119                         break;
 120                 vht_send_action[act] = f;
 121                 return 0;
 122         }
 123         return EINVAL;
 124 }
 125
 126 void
 127 ieee80211_send_action_unregister(int cat, int act)
 128 {
 129         ieee80211_send_action_register(cat, act, send_inval);
 130 }
 131
 132 int
 133 ieee80211_send_action(struct ieee80211_node *ni, int cat, int act, void *sa)
 134 {
 135         ieee80211_send_action_func *f = send_inval;
 136
 137         switch (cat) {
 138         case IEEE80211_ACTION_CAT_BA:
 139                 if (act < nitems(ba_send_action))
 140                         f = ba_send_action[act];
 141                 break;
 142         case IEEE80211_ACTION_CAT_HT:
 143                 if (act < nitems(ht_send_action))
 144                         f = ht_send_action[act];
 145                 break;
 146         case IEEE80211_ACTION_CAT_SELF_PROT:
 147                 if (act < nitems(meshpl_send_action))
 148                         f = meshpl_send_action[act];
 149                 break;
 150         case IEEE80211_ACTION_CAT_MESH:
 151                 if (act < nitems(meshaction_send_action))
 152                         f = meshaction_send_action[act];
 153                 break;
 154         case IEEE80211_ACTION_CAT_VENDOR:
 155                 if (act < nitems(vendor_send_action))
 156                         f = vendor_send_action[act];
 157                 break;
 158         case IEEE80211_ACTION_CAT_VHT:
 159                 if (act < nitems(vht_send_action))
 160                         f = vht_send_action[act];
 161                 break;
 162         }
 163         return f(ni, cat, act, sa);
 164 }
 165
 166 static int
 167 recv_inval(struct ieee80211_node *ni, const struct ieee80211_frame *wh,
 168         const uint8_t *frm, const uint8_t *efrm)
 169 {
 170         return EINVAL;
 171 }
 172
 173 static ieee80211_recv_action_func *ba_recv_action[8] = {
 174         recv_inval, recv_inval, recv_inval, recv_inval,
 175         recv_inval, recv_inval, recv_inval, recv_inval,
 176 };
 177 static ieee80211_recv_action_func *ht_recv_action[8] = {
 178         recv_inval, recv_inval, recv_inval, recv_inval,
 179         recv_inval, recv_inval, recv_inval, recv_inval,
 180 };
 181 static ieee80211_recv_action_func *meshpl_recv_action[8] = {
 182         recv_inval, recv_inval, recv_inval, recv_inval,
 183         recv_inval, recv_inval, recv_inval, recv_inval,
 184 };
 185 static ieee80211_recv_action_func *meshaction_recv_action[12] = {
 186         recv_inval, recv_inval, recv_inval, recv_inval,
 187         recv_inval, recv_inval, recv_inval, recv_inval,
 188         recv_inval, recv_inval, recv_inval, recv_inval,
 189 };
 190 static ieee80211_recv_action_func *vendor_recv_action[8] = {
 191         recv_inval, recv_inval, recv_inval, recv_inval,
 192         recv_inval, recv_inval, recv_inval, recv_inval,
 193 };
 194
 195 static ieee80211_recv_action_func *vht_recv_action[3] = {
 196         recv_inval, recv_inval, recv_inval
 197 };
 198
 199 int
 200 ieee80211_recv_action_register(int cat, int act, ieee80211_recv_action_func *f)
 201 {
 202         switch (cat) {
 203         case IEEE80211_ACTION_CAT_BA:
 204                 if (act >= nitems(ba_recv_action))
 205                         break;
 206                 ba_recv_action[act] = f;
 207                 return 0;
 208         case IEEE80211_ACTION_CAT_HT:
 209                 if (act >= nitems(ht_recv_action))
 210                         break;
 211                 ht_recv_action[act] = f;
 212                 return 0;
 213         case IEEE80211_ACTION_CAT_SELF_PROT:
 214                 if (act >= nitems(meshpl_recv_action))
 215                         break;
 216                 meshpl_recv_action[act] = f;
 217                 return 0;
 218         case IEEE80211_ACTION_CAT_MESH:
 219                 if (act >= nitems(meshaction_recv_action))
 220                         break;
 221                 meshaction_recv_action[act] = f;
 222                 return 0;
 223         case IEEE80211_ACTION_CAT_VENDOR:
 224                 if (act >= nitems(vendor_recv_action))
 225                         break;
 226                 vendor_recv_action[act] = f;
 227                 return 0;
 228         case IEEE80211_ACTION_CAT_VHT:
 229                 if (act >= nitems(vht_recv_action))
 230                         break;
 231                 vht_recv_action[act] = f;
 232                 return 0;
 233         }
 234         return EINVAL;
 235 }
 236
 237 void
 238 ieee80211_recv_action_unregister(int cat, int act)
 239 {
 240         ieee80211_recv_action_register(cat, act, recv_inval);
 241 }
 242
 243 int
 244 ieee80211_recv_action(struct ieee80211_node *ni,
 245         const struct ieee80211_frame *wh,
 246         const uint8_t *frm, const uint8_t *efrm)
 247 {
 248         ieee80211_recv_action_func *f = recv_inval;
 249         struct ieee80211vap *vap = ni->ni_vap;
 250         const struct ieee80211_action *ia =
 251             (const struct ieee80211_action *) frm;
 252
 253         switch (ia->ia_category) {
 254         case IEEE80211_ACTION_CAT_BA:
 255                 if (ia->ia_action < nitems(ba_recv_action))
 256                         f = ba_recv_action[ia->ia_action];
 257                 break;
 258         case IEEE80211_ACTION_CAT_HT:
 259                 if (ia->ia_action < nitems(ht_recv_action))
 260                         f = ht_recv_action[ia->ia_action];
 261                 break;
 262         case IEEE80211_ACTION_CAT_SELF_PROT:
 263                 if (ia->ia_action < nitems(meshpl_recv_action))
 264                         f = meshpl_recv_action[ia->ia_action];
 265                 break;
 266         case IEEE80211_ACTION_CAT_MESH:
 267                 if (ni == vap->iv_bss ||
 268                     ni->ni_mlstate != IEEE80211_NODE_MESH_ESTABLISHED) {
 269                         IEEE80211_DISCARD_MAC(vap, IEEE80211_MSG_MESH,
 270                             ni->ni_macaddr, NULL,
 271                             "peer link not yet established (%d), cat %s act %u",
 272                             ni->ni_mlstate, "mesh action", ia->ia_action);
 273                         vap->iv_stats.is_mesh_nolink++;
 274                         break;
 275                 }
 276                 if (ia->ia_action < nitems(meshaction_recv_action))
 277                         f = meshaction_recv_action[ia->ia_action];
 278                 break;
 279         case IEEE80211_ACTION_CAT_VENDOR:
 280                 if (ia->ia_action < nitems(vendor_recv_action))
 281                         f = vendor_recv_action[ia->ia_action];
 282                 break;
 283         case IEEE80211_ACTION_CAT_VHT:
 284                 if (ia->ia_action < nitems(vht_recv_action))
 285                         f = vht_recv_action[ia->ia_action];
 286                 break;
 287         }
 288         return f(ni, wh, frm, efrm);
 289 }