sys/net80211/ieee80211_action.c

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