package/kernel/mac80211/files/lib/netifd/wireless/mac80211.sh

   1 #!/bin/sh
   2 . /lib/netifd/netifd-wireless.sh
   3 . /lib/netifd/hostapd.sh
   4
   5 init_wireless_driver "$@"
   6
   7 MP_CONFIG_INT="mesh_retry_timeout mesh_confirm_timeout mesh_holding_timeout mesh_max_peer_links
   8                mesh_max_retries mesh_ttl mesh_element_ttl mesh_hwmp_max_preq_retries
   9                mesh_path_refresh_time mesh_min_discovery_timeout mesh_hwmp_active_path_timeout
  10                mesh_hwmp_preq_min_interval mesh_hwmp_net_diameter_traversal_time mesh_hwmp_rootmode
  11                mesh_hwmp_rann_interval mesh_gate_announcements mesh_sync_offset_max_neighor
  12                mesh_rssi_threshold mesh_hwmp_active_path_to_root_timeout mesh_hwmp_root_interval
  13                mesh_hwmp_confirmation_interval mesh_awake_window mesh_plink_timeout"
  14 MP_CONFIG_BOOL="mesh_auto_open_plinks mesh_fwding"
  15 MP_CONFIG_STRING="mesh_power_mode"
  16
  17 iw() {
  18         command iw $@ || logger -t mac80211 "Failed command: iw $@"
  19 }
  20
  21 drv_mac80211_init_device_config() {
  22         hostapd_common_add_device_config
  23
  24         config_add_string path phy 'macaddr:macaddr'
  25         config_add_string hwmode
  26         config_add_string tx_burst
  27         config_add_int beacon_int chanbw frag rts
  28         config_add_int rxantenna txantenna antenna_gain txpower distance
  29         config_add_boolean noscan ht_coex
  30         config_add_array ht_capab
  31         config_add_array channels
  32         config_add_boolean \
  33                 rxldpc \
  34                 short_gi_80 \
  35                 short_gi_160 \
  36                 tx_stbc_2by1 \
  37                 su_beamformer \
  38                 su_beamformee \
  39                 mu_beamformer \
  40                 mu_beamformee \
  41                 vht_txop_ps \
  42                 htc_vht \
  43                 rx_antenna_pattern \
  44                 tx_antenna_pattern
  45         config_add_int vht_max_a_mpdu_len_exp vht_max_mpdu vht_link_adapt vht160 rx_stbc tx_stbc
  46         config_add_boolean \
  47                 ldpc \
  48                 greenfield \
  49                 short_gi_20 \
  50                 short_gi_40 \
  51                 max_amsdu \
  52                 dsss_cck_40
  53 }
  54
  55 drv_mac80211_init_iface_config() {
  56         hostapd_common_add_bss_config
  57
  58         config_add_string 'macaddr:macaddr' ifname
  59
  60         config_add_boolean wds powersave
  61         config_add_int maxassoc
  62         config_add_int max_listen_int
  63         config_add_int dtim_period
  64         config_add_int start_disabled
  65
  66         # mesh
  67         config_add_string mesh_id
  68         config_add_int $MP_CONFIG_INT
  69         config_add_boolean $MP_CONFIG_BOOL
  70         config_add_string $MP_CONFIG_STRING
  71 }
  72
  73 mac80211_add_capabilities() {
  74         local __var="$1"; shift
  75         local __mask="$1"; shift
  76         local __out= oifs
  77
  78         oifs="$IFS"
  79         IFS=:
  80         for capab in "$@"; do
  81                 set -- $capab
  82
  83                 [ "$(($4))" -gt 0 ] || continue
  84                 [ "$(($__mask & $2))" -eq "$((${3:-$2}))" ] || continue
  85                 __out="$__out[$1]"
  86         done
  87         IFS="$oifs"
  88
  89         export -n -- "$__var=$__out"
  90 }
  91
  92 mac80211_hostapd_setup_base() {
  93         local phy="$1"
  94
  95         json_select config
  96
  97         [ "$auto_channel" -gt 0 ] && channel=acs_survey
  98         [ "$auto_channel" -gt 0 ] && json_get_values channel_list channels
  99
 100         json_get_vars noscan ht_coex
 101         json_get_values ht_capab_list ht_capab tx_burst
 102
 103         [ -n "$noscan" -a "$noscan" -gt 0 ] && hostapd_noscan=1
 104         [ "$tx_burst" = 0 ] && tx_burst=
 105
 106         ieee80211n=1
 107         ht_capab=
 108         case "$htmode" in
 109                 VHT20|HT20) ;;
 110                 HT40*|VHT40|VHT80|VHT160)
 111                         case "$hwmode" in
 112                                 a)
 113                                         case "$(( ($channel / 4) % 2 ))" in
 114                                                 1) ht_capab="[HT40+]";;
 115                                                 0) ht_capab="[HT40-]";;
 116                                         esac
 117                                 ;;
 118                                 *)
 119                                         case "$htmode" in
 120                                                 HT40+) ht_capab="[HT40+]";;
 121                                                 HT40-) ht_capab="[HT40-]";;
 122                                                 *)
 123                                                         if [ "$channel" -lt 7 ]; then
 124                                                                 ht_capab="[HT40+]"
 125                                                         else
 126                                                                 ht_capab="[HT40-]"
 127                                                         fi
 128                                                 ;;
 129                                         esac
 130                                 ;;
 131                         esac
 132                         [ "$auto_channel" -gt 0 ] && ht_capab="[HT40+]"
 133                 ;;
 134                 *) ieee80211n= ;;
 135         esac
 136
 137         [ -n "$ieee80211n" ] && {
 138                 append base_cfg "ieee80211n=1" "$N"
 139
 140                 set_default ht_coex 0
 141                 append base_cfg "ht_coex=$ht_coex" "$N"
 142
 143                 json_get_vars \
 144                         ldpc:1 \
 145                         greenfield:0 \
 146                         short_gi_20:1 \
 147                         short_gi_40:1 \
 148                         tx_stbc:1 \
 149                         rx_stbc:3 \
 150                         max_amsdu:1 \
 151                         dsss_cck_40:1
 152
 153                 ht_cap_mask=0
 154                 for cap in $(iw phy "$phy" info | grep 'Capabilities:' | cut -d: -f2); do
 155                         ht_cap_mask="$(($ht_cap_mask | $cap))"
 156                 done
 157
 158                 cap_rx_stbc=$((($ht_cap_mask >> 8) & 3))
 159                 [ "$rx_stbc" -lt "$cap_rx_stbc" ] && cap_rx_stbc="$rx_stbc"
 160                 ht_cap_mask="$(( ($ht_cap_mask & ~(0x300)) | ($cap_rx_stbc << 8) ))"
 161
 162                 mac80211_add_capabilities ht_capab_flags $ht_cap_mask \
 163                         LDPC:0x1::$ldpc \
 164                         GF:0x10::$greenfield \
 165                         SHORT-GI-20:0x20::$short_gi_20 \
 166                         SHORT-GI-40:0x40::$short_gi_40 \
 167                         TX-STBC:0x80::$tx_stbc \
 168                         RX-STBC1:0x300:0x100:1 \
 169                         RX-STBC12:0x300:0x200:1 \
 170                         RX-STBC123:0x300:0x300:1 \
 171                         MAX-AMSDU-7935:0x800::$max_amsdu \
 172                         DSSS_CCK-40:0x1000::$dsss_cck_40
 173
 174                 ht_capab="$ht_capab$ht_capab_flags"
 175                 [ -n "$ht_capab" ] && append base_cfg "ht_capab=$ht_capab" "$N"
 176         }
 177
 178         # 802.11ac
 179         enable_ac=0
 180         idx="$channel"
 181         case "$htmode" in
 182                 VHT20) enable_ac=1;;
 183                 VHT40)
 184                         case "$(( ($channel / 4) % 2 ))" in
 185                                 1) idx=$(($channel + 2));;
 186                                 0) idx=$(($channel - 2));;
 187                         esac
 188                         enable_ac=1
 189                         append base_cfg "vht_oper_chwidth=0" "$N"
 190                         append base_cfg "vht_oper_centr_freq_seg0_idx=$idx" "$N"
 191                 ;;
 192                 VHT80)
 193                         case "$(( ($channel / 4) % 4 ))" in
 194                                 1) idx=$(($channel + 6));;
 195                                 2) idx=$(($channel + 2));;
 196                                 3) idx=$(($channel - 2));;
 197                                 0) idx=$(($channel - 6));;
 198                         esac
 199                         enable_ac=1
 200                         append base_cfg "vht_oper_chwidth=1" "$N"
 201                         append base_cfg "vht_oper_centr_freq_seg0_idx=$idx" "$N"
 202                 ;;
 203                 VHT160)
 204                         case "$channel" in
 205                                 36|40|44|48|52|56|60|64) idx=50;;
 206                                 100|104|108|112|116|120|124|128) idx=114;;
 207                         esac
 208                         enable_ac=1
 209                         append base_cfg "vht_oper_chwidth=2" "$N"
 210                         append base_cfg "vht_oper_centr_freq_seg0_idx=$idx" "$N"
 211                 ;;
 212         esac
 213
 214         if [ "$enable_ac" != "0" ]; then
 215                 json_get_vars \
 216                         rxldpc:1 \
 217                         short_gi_80:1 \
 218                         short_gi_160:1 \
 219                         tx_stbc_2by1:1 \
 220                         su_beamformer:1 \
 221                         su_beamformee:1 \
 222                         mu_beamformer:1 \
 223                         mu_beamformee:1 \
 224                         vht_txop_ps:1 \
 225                         htc_vht:1 \
 226                         rx_antenna_pattern:1 \
 227                         tx_antenna_pattern:1 \
 228                         vht_max_a_mpdu_len_exp:7 \
 229                         vht_max_mpdu:11454 \
 230                         rx_stbc:4 \
 231                         vht_link_adapt:3 \
 232                         vht160:2
 233
 234                 set_default tx_burst 2.0
 235                 append base_cfg "ieee80211ac=1" "$N"
 236                 vht_cap=0
 237                 for cap in $(iw phy "$phy" info | awk -F "[()]" '/VHT Capabilities/ { print $2 }'); do
 238                         vht_cap="$(($vht_cap | $cap))"
 239                 done
 240
 241                 cap_rx_stbc=$((($vht_cap >> 8) & 7))
 242                 [ "$rx_stbc" -lt "$cap_rx_stbc" ] && cap_rx_stbc="$rx_stbc"
 243                 vht_cap="$(( ($vht_cap & ~(0x700)) | ($cap_rx_stbc << 8) ))"
 244
 245                 mac80211_add_capabilities vht_capab $vht_cap \
 246                         RXLDPC:0x10::$rxldpc \
 247                         SHORT-GI-80:0x20::$short_gi_80 \
 248                         SHORT-GI-160:0x40::$short_gi_160 \
 249                         TX-STBC-2BY1:0x80::$tx_stbc_2by1 \
 250                         SU-BEAMFORMER:0x800::$su_beamformer \
 251                         SU-BEAMFORMEE:0x1000::$su_beamformee \
 252                         MU-BEAMFORMER:0x80000::$mu_beamformer \
 253                         MU-BEAMFORMEE:0x100000::$mu_beamformee \
 254                         VHT-TXOP-PS:0x200000::$vht_txop_ps \
 255                         HTC-VHT:0x400000::$htc_vht \
 256                         RX-ANTENNA-PATTERN:0x10000000::$rx_antenna_pattern \
 257                         TX-ANTENNA-PATTERN:0x20000000::$tx_antenna_pattern \
 258                         RX-STBC-1:0x700:0x100:1 \
 259                         RX-STBC-12:0x700:0x200:1 \
 260                         RX-STBC-123:0x700:0x300:1 \
 261                         RX-STBC-1234:0x700:0x400:1 \
 262
 263                 # supported Channel widths
 264                 vht160_hw=0
 265                 [ "$(($vht_cap & 12))" -eq 4 -a 1 -le "$vht160" ] && \
 266                         vht160_hw=1
 267                 [ "$(($vht_cap & 12))" -eq 8 -a 2 -le "$vht160" ] && \
 268                         vht160_hw=2
 269                 [ "$vht160_hw" = 1 ] && vht_capab="$vht_capab[VHT160]"
 270                 [ "$vht160_hw" = 2 ] && vht_capab="$vht_capab[VHT160-80PLUS80]"
 271
 272                 # maximum MPDU length
 273                 vht_max_mpdu_hw=3895
 274                 [ "$(($vht_cap & 3))" -ge 1 -a 7991 -le "$vht_max_mpdu" ] && \
 275                         vht_max_mpdu_hw=7991
 276                 [ "$(($vht_cap & 3))" -ge 2 -a 11454 -le "$vht_max_mpdu" ] && \
 277                         vht_max_mpdu_hw=11454
 278                 [ "$vht_max_mpdu_hw" != 3895 ] && \
 279                         vht_capab="$vht_capab[MAX-MPDU-$vht_max_mpdu_hw]"
 280
 281                 # maximum A-MPDU length exponent
 282                 vht_max_a_mpdu_len_exp_hw=0
 283                 [ "$(($vht_cap & 58720256))" -ge 8388608 -a 1 -le "$vht_max_a_mpdu_len_exp" ] && \
 284                         vht_max_a_mpdu_len_exp_hw=1
 285                 [ "$(($vht_cap & 58720256))" -ge 16777216 -a 2 -le "$vht_max_a_mpdu_len_exp" ] && \
 286                         vht_max_a_mpdu_len_exp_hw=2
 287                 [ "$(($vht_cap & 58720256))" -ge 25165824 -a 3 -le "$vht_max_a_mpdu_len_exp" ] && \
 288                         vht_max_a_mpdu_len_exp_hw=3
 289                 [ "$(($vht_cap & 58720256))" -ge 33554432 -a 4 -le "$vht_max_a_mpdu_len_exp" ] && \
 290                         vht_max_a_mpdu_len_exp_hw=4
 291                 [ "$(($vht_cap & 58720256))" -ge 41943040 -a 5 -le "$vht_max_a_mpdu_len_exp" ] && \
 292                         vht_max_a_mpdu_len_exp_hw=5
 293                 [ "$(($vht_cap & 58720256))" -ge 50331648 -a 6 -le "$vht_max_a_mpdu_len_exp" ] && \
 294                         vht_max_a_mpdu_len_exp_hw=6
 295                 [ "$(($vht_cap & 58720256))" -ge 58720256 -a 7 -le "$vht_max_a_mpdu_len_exp" ] && \
 296                         vht_max_a_mpdu_len_exp_hw=7
 297                 vht_capab="$vht_capab[MAX-A-MPDU-LEN-EXP$vht_max_a_mpdu_len_exp_hw]"
 298
 299                 # whether or not the STA supports link adaptation using VHT variant
 300                 vht_link_adapt_hw=0
 301                 [ "$(($vht_cap & 201326592))" -ge 134217728 -a 2 -le "$vht_link_adapt" ] && \
 302                         vht_link_adapt_hw=2
 303                 [ "$(($vht_cap & 201326592))" -ge 201326592 -a 3 -le "$vht_link_adapt" ] && \
 304                         vht_link_adapt_hw=3
 305                 [ "$vht_link_adapt_hw" != 0 ] && \
 306                         vht_capab="$vht_capab[VHT-LINK-ADAPT-$vht_link_adapt_hw]"
 307
 308                 [ -n "$vht_capab" ] && append base_cfg "vht_capab=$vht_capab" "$N"
 309         fi
 310
 311         hostapd_prepare_device_config "$hostapd_conf_file" nl80211
 312         cat >> "$hostapd_conf_file" <<EOF
 313 ${channel:+channel=$channel}
 314 ${channel_list:+chanlist=$channel_list}
 315 ${hostapd_noscan:+noscan=1}
 316 ${tx_burst:+tx_queue_data2_burst=$tx_burst}
 317 $base_cfg
 318
 319 EOF
 320         json_select ..
 321 }
 322
 323 mac80211_hostapd_setup_bss() {
 324         local phy="$1"
 325         local ifname="$2"
 326         local macaddr="$3"
 327         local type="$4"
 328
 329         hostapd_cfg=
 330         append hostapd_cfg "$type=$ifname" "$N"
 331
 332         hostapd_set_bss_options hostapd_cfg "$vif" || return 1
 333         json_get_vars wds dtim_period max_listen_int start_disabled
 334
 335         set_default wds 0
 336         set_default start_disabled 0
 337
 338         [ "$wds" -gt 0 ] && append hostapd_cfg "wds_sta=1" "$N"
 339         [ "$staidx" -gt 0 -o "$start_disabled" -eq 1 ] && append hostapd_cfg "start_disabled=1" "$N"
 340
 341         cat >> /var/run/hostapd-$phy.conf <<EOF
 342 $hostapd_cfg
 343 bssid=$macaddr
 344 ${dtim_period:+dtim_period=$dtim_period}
 345 ${max_listen_int:+max_listen_interval=$max_listen_int}
 346 EOF
 347 }
 348
 349 mac80211_get_addr() {
 350         local phy="$1"
 351         local idx="$(($2 + 1))"
 352
 353         head -n $(($macidx + 1)) /sys/class/ieee80211/${phy}/addresses | tail -n1
 354 }
 355
 356 mac80211_generate_mac() {
 357         local phy="$1"
 358         local id="${macidx:-0}"
 359
 360         local ref="$(cat /sys/class/ieee80211/${phy}/macaddress)"
 361         local mask="$(cat /sys/class/ieee80211/${phy}/address_mask)"
 362
 363         [ "$mask" = "00:00:00:00:00:00" ] && {
 364                 mask="ff:ff:ff:ff:ff:ff";
 365
 366                 [ "$(wc -l < /sys/class/ieee80211/${phy}/addresses)" -gt 1 ] && {
 367                         addr="$(mac80211_get_addr "$phy" "$id")"
 368                         [ -n "$addr" ] && {
 369                                 echo "$addr"
 370                                 return
 371                         }
 372                 }
 373         }
 374
 375         local oIFS="$IFS"; IFS=":"; set -- $mask; IFS="$oIFS"
 376
 377         local mask1=$1
 378         local mask6=$6
 379
 380         local oIFS="$IFS"; IFS=":"; set -- $ref; IFS="$oIFS"
 381
 382         macidx=$(($id + 1))
 383         [ "$((0x$mask1))" -gt 0 ] && {
 384                 b1="0x$1"
 385                 [ "$id" -gt 0 ] && \
 386                         b1=$(($b1 ^ ((($id - 1) << 2) | 0x2)))
 387                 printf "%02x:%s:%s:%s:%s:%s" $b1 $2 $3 $4 $5 $6
 388                 return
 389         }
 390
 391         [ "$((0x$mask6))" -lt 255 ] && {
 392                 printf "%s:%s:%s:%s:%s:%02x" $1 $2 $3 $4 $5 $(( 0x$6 ^ $id ))
 393                 return
 394         }
 395
 396         off2=$(( (0x$6 + $id) / 0x100 ))
 397         printf "%s:%s:%s:%s:%02x:%02x" \
 398                 $1 $2 $3 $4 \
 399                 $(( (0x$5 + $off2) % 0x100 )) \
 400                 $(( (0x$6 + $id) % 0x100 ))
 401 }
 402
 403 find_phy() {
 404         [ -n "$phy" -a -d /sys/class/ieee80211/$phy ] && return 0
 405         [ -n "$path" ] && {
 406                 for phy in $(ls /sys/class/ieee80211 2>/dev/null); do
 407                         case "$(readlink -f /sys/class/ieee80211/$phy/device)" in
 408                                 *$path) return 0;;
 409                         esac
 410                 done
 411         }
 412         [ -n "$macaddr" ] && {
 413                 for phy in $(ls /sys/class/ieee80211 2>/dev/null); do
 414                         grep -i -q "$macaddr" "/sys/class/ieee80211/${phy}/macaddress" && return 0
 415                 done
 416         }
 417         return 1
 418 }
 419
 420 mac80211_check_ap() {
 421         has_ap=1
 422 }
 423
 424 mac80211_iw_interface_add() {
 425         local phy="$1"
 426         local ifname="$2"
 427         local type="$3"
 428         local wdsflag="$4"
 429         local rc
 430
 431         iw phy "$phy" interface add "$ifname" type "$type" $wdsflag
 432         rc="$?"
 433
 434         [ "$rc" = 233 ] && {
 435                 # Device might have just been deleted, give the kernel some time to finish cleaning it up
 436                 sleep 1
 437
 438                 iw phy "$phy" interface add "$ifname" type "$type" $wdsflag
 439                 rc="$?"
 440         }
 441
 442         [ "$rc" = 233 ] && {
 443                 # Device might not support virtual interfaces, so the interface never got deleted in the first place.
 444                 # Check if the interface already exists, and avoid failing in this case.
 445                 ip link show dev "$ifname" >/dev/null 2>/dev/null && rc=0
 446         }
 447
 448         [ "$rc" != 0 ] && wireless_setup_failed INTERFACE_CREATION_FAILED
 449         return $rc
 450 }
 451
 452 mac80211_prepare_vif() {
 453         json_select config
 454
 455         json_get_vars ifname mode ssid wds powersave macaddr
 456
 457         [ -n "$ifname" ] || ifname="wlan${phy#phy}${if_idx:+-$if_idx}"
 458         if_idx=$((${if_idx:-0} + 1))
 459
 460         set_default wds 0
 461         set_default powersave 0
 462
 463         json_select ..
 464
 465         [ -n "$macaddr" ] || {
 466                 macaddr="$(mac80211_generate_mac $phy)"
 467                 macidx="$(($macidx + 1))"
 468         }
 469
 470         json_add_object data
 471         json_add_string ifname "$ifname"
 472         json_close_object
 473         json_select config
 474
 475         # It is far easier to delete and create the desired interface
 476         case "$mode" in
 477                 adhoc)
 478                         mac80211_iw_interface_add "$phy" "$ifname" adhoc || return
 479                 ;;
 480                 ap)
 481                         # Hostapd will handle recreating the interface and
 482                         # subsequent virtual APs belonging to the same PHY
 483                         if [ -n "$hostapd_ctrl" ]; then
 484                                 type=bss
 485                         else
 486                                 type=interface
 487                         fi
 488
 489                         mac80211_hostapd_setup_bss "$phy" "$ifname" "$macaddr" "$type" || return
 490
 491                         [ -n "$hostapd_ctrl" ] || {
 492                                 mac80211_iw_interface_add "$phy" "$ifname" __ap || return
 493                                 hostapd_ctrl="${hostapd_ctrl:-/var/run/hostapd/$ifname}"
 494                         }
 495                 ;;
 496                 mesh)
 497                         mac80211_iw_interface_add "$phy" "$ifname" mp || return
 498                 ;;
 499                 monitor)
 500                         mac80211_iw_interface_add "$phy" "$ifname" monitor || return
 501                 ;;
 502                 sta)
 503                         local wdsflag=
 504                         staidx="$(($staidx + 1))"
 505                         [ "$wds" -gt 0 ] && wdsflag="4addr on"
 506                         mac80211_iw_interface_add "$phy" "$ifname" managed "$wdsflag" || return
 507                         [ "$powersave" -gt 0 ] && powersave="on" || powersave="off"
 508                         iw "$ifname" set power_save "$powersave"
 509                 ;;
 510         esac
 511
 512         case "$mode" in
 513                 monitor|mesh)
 514                         [ "$auto_channel" -gt 0 ] || iw dev "$ifname" set channel "$channel" $htmode
 515                 ;;
 516         esac
 517
 518         if [ "$mode" != "ap" ]; then
 519                 # ALL ap functionality will be passed to hostapd
 520                 # All interfaces must have unique mac addresses
 521                 # which can either be explicitly set in the device
 522                 # section, or automatically generated
 523                 ip link set dev "$ifname" address "$macaddr"
 524         fi
 525
 526         json_select ..
 527 }
 528
 529 mac80211_setup_supplicant() {
 530         wpa_supplicant_prepare_interface "$ifname" nl80211 || return 1
 531         if [ "$mode" = "sta" ]; then
 532                 wpa_supplicant_add_network "$ifname"
 533         else
 534                 wpa_supplicant_add_network "$ifname" "$freq" "$htmode" "$noscan"
 535         fi
 536         wpa_supplicant_run "$ifname" ${hostapd_ctrl:+-H $hostapd_ctrl}
 537 }
 538
 539 mac80211_setup_supplicant_noctl() {
 540         wpa_supplicant_prepare_interface "$ifname" nl80211 || return 1
 541         wpa_supplicant_add_network "$ifname" "$freq" "$htmode" "$noscan"
 542         wpa_supplicant_run "$ifname"
 543 }
 544
 545 mac80211_setup_adhoc_htmode() {
 546         case "$htmode" in
 547                 VHT20|HT20) ibss_htmode=HT20;;
 548                 HT40*|VHT40|VHT160)
 549                         case "$hwmode" in
 550                                 a)
 551                                         case "$(( ($channel / 4) % 2 ))" in
 552                                                 1) ibss_htmode="HT40+" ;;
 553                                                 0) ibss_htmode="HT40-";;
 554                                         esac
 555                                 ;;
 556                                 *)
 557                                         case "$htmode" in
 558                                                 HT40+) ibss_htmode="HT40+";;
 559                                                 HT40-) ibss_htmode="HT40-";;
 560                                                 *)
 561                                                         if [ "$channel" -lt 7 ]; then
 562                                                                 ibss_htmode="HT40+"
 563                                                         else
 564                                                                 ibss_htmode="HT40-"
 565                                                         fi
 566                                                 ;;
 567                                         esac
 568                                 ;;
 569                         esac
 570                         [ "$auto_channel" -gt 0 ] && ibss_htmode="HT40+"
 571                 ;;
 572                 VHT80)
 573                         ibss_htmode="80MHZ"
 574                 ;;
 575                 NONE|NOHT)
 576                         ibss_htmode="NOHT"
 577                 ;;
 578                 *) ibss_htmode="" ;;
 579         esac
 580
 581 }
 582
 583 mac80211_setup_adhoc() {
 584         json_get_vars bssid ssid key mcast_rate
 585
 586         keyspec=
 587         [ "$auth_type" = "wep" ] && {
 588                 set_default key 1
 589                 case "$key" in
 590                         [1234])
 591                                 local idx
 592                                 for idx in 1 2 3 4; do
 593                                         json_get_var ikey "key$idx"
 594
 595                                         [ -n "$ikey" ] && {
 596                                                 ikey="$(($idx - 1)):$(prepare_key_wep "$ikey")"
 597                                                 [ $idx -eq $key ] && ikey="d:$ikey"
 598                                                 append keyspec "$ikey"
 599                                         }
 600                                 done
 601                         ;;
 602                         *)
 603                                 append keyspec "d:0:$(prepare_key_wep "$key")"
 604                         ;;
 605                 esac
 606         }
 607
 608         brstr=
 609         for br in $basic_rate_list; do
 610                 wpa_supplicant_add_rate brstr "$br"
 611         done
 612
 613         mcval=
 614         [ -n "$mcast_rate" ] && wpa_supplicant_add_rate mcval "$mcast_rate"
 615
 616         iw dev "$ifname" ibss join "$ssid" $freq $ibss_htmode fixed-freq $bssid \
 617                 beacon-interval $beacon_int \
 618                 ${brstr:+basic-rates $brstr} \
 619                 ${mcval:+mcast-rate $mcval} \
 620                 ${keyspec:+keys $keyspec}
 621 }
 622
 623 mac80211_setup_mesh() {
 624         json_get_vars ssid mesh_id mcast_rate
 625
 626         mcval=
 627         [ -n "$mcast_rate" ] && wpa_supplicant_add_rate mcval "$mcast_rate"
 628         [ -n "$mesh_id" ] && ssid="$mesh_id"
 629
 630         case "$htmode" in
 631                 VHT20|HT20) mesh_htmode=HT20;;
 632                 HT40*|VHT40)
 633                         case "$hwmode" in
 634                                 a)
 635                                         case "$(( ($channel / 4) % 2 ))" in
 636                                                 1) mesh_htmode="HT40+" ;;
 637                                                 0) mesh_htmode="HT40-";;
 638                                         esac
 639                                 ;;
 640                                 *)
 641                                         case "$htmode" in
 642                                                 HT40+) mesh_htmode="HT40+";;
 643                                                 HT40-) mesh_htmode="HT40-";;
 644                                                 *)
 645                                                         if [ "$channel" -lt 7 ]; then
 646                                                                 mesh_htmode="HT40+"
 647                                                         else
 648                                                                 mesh_htmode="HT40-"
 649                                                         fi
 650                                                 ;;
 651                                         esac
 652                                 ;;
 653                         esac
 654                 ;;
 655                 VHT80)
 656                         mesh_htmode="80Mhz"
 657                 ;;
 658                 VHT160)
 659                         mesh_htmode="160Mhz"
 660                 ;;
 661                 *) mesh_htmode="NOHT" ;;
 662         esac
 663         iw dev "$ifname" mesh join "$ssid" freq $freq $mesh_htmode \
 664                 ${mcval:+mcast-rate $mcval} \
 665                 beacon-interval $beacon_int
 666 }
 667
 668 mac80211_setup_vif() {
 669         local name="$1"
 670         local failed
 671
 672         json_select data
 673         json_get_vars ifname
 674         json_select ..
 675
 676         json_select config
 677         json_get_vars mode
 678         json_get_var vif_txpower txpower
 679
 680         ip link set dev "$ifname" up || {
 681                 wireless_setup_vif_failed IFUP_ERROR
 682                 json_select ..
 683                 return
 684         }
 685
 686         set_default vif_txpower "$txpower"
 687         [ -z "$vif_txpower" ] || iw dev "$ifname" set txpower fixed "${vif_txpower%%.*}00"
 688
 689         case "$mode" in
 690                 mesh)
 691                         wireless_vif_parse_encryption
 692                         freq="$(get_freq "$phy" "$channel")"
 693                         if [ "$wpa" -gt 0 -o "$auto_channel" -gt 0 ] || chan_is_dfs "$phy" "$channel"; then
 694                                 mac80211_setup_supplicant || failed=1
 695                         else
 696                                 mac80211_setup_mesh
 697                         fi
 698                         for var in $MP_CONFIG_INT $MP_CONFIG_BOOL $MP_CONFIG_STRING; do
 699                                 json_get_var mp_val "$var"
 700                                 [ -n "$mp_val" ] && iw dev "$ifname" set mesh_param "$var" "$mp_val"
 701                         done
 702                 ;;
 703                 adhoc)
 704                         wireless_vif_parse_encryption
 705                         mac80211_setup_adhoc_htmode
 706                         if [ "$wpa" -gt 0 -o "$auto_channel" -gt 0 ]; then
 707                                 freq="$(get_freq "$phy" "$channel")"
 708                                 mac80211_setup_supplicant_noctl || failed=1
 709                         else
 710                                 mac80211_setup_adhoc
 711                         fi
 712                 ;;
 713                 sta)
 714                         mac80211_setup_supplicant || failed=1
 715                 ;;
 716         esac
 717
 718         json_select ..
 719         [ -n "$failed" ] || wireless_add_vif "$name" "$ifname"
 720 }
 721
 722 get_freq() {
 723         local phy="$1"
 724         local chan="$2"
 725         iw "$phy" info | grep -E -m1 "(\* ${chan:-....} MHz${chan:+|\\[$chan\\]})" | grep MHz | awk '{print $2}'
 726 }
 727
 728 chan_is_dfs() {
 729         local phy="$1"
 730         local chan="$2"
 731         iw "$phy" info | grep -E -m1 "(\* ${chan:-....} MHz${chan:+|\\[$chan\\]})" | grep -q "MHz.*radar detection"
 732         return $!
 733 }
 734
 735 mac80211_interface_cleanup() {
 736         local phy="$1"
 737
 738         for wdev in $(list_phy_interfaces "$phy"); do
 739                 ip link set dev "$wdev" down 2>/dev/null
 740                 iw dev "$wdev" del
 741         done
 742 }
 743
 744 mac80211_set_noscan() {
 745         hostapd_noscan=1
 746 }
 747
 748 drv_mac80211_cleanup() {
 749         hostapd_common_cleanup
 750 }
 751
 752 drv_mac80211_setup() {
 753         json_select config
 754         json_get_vars \
 755                 phy macaddr path \
 756                 country chanbw distance \
 757                 txpower antenna_gain \
 758                 rxantenna txantenna \
 759                 frag rts beacon_int:100 htmode
 760         json_get_values basic_rate_list basic_rate
 761         json_select ..
 762
 763         find_phy || {
 764                 echo "Could not find PHY for device '$1'"
 765                 wireless_set_retry 0
 766                 return 1
 767         }
 768
 769         wireless_set_data phy="$phy"
 770         mac80211_interface_cleanup "$phy"
 771
 772         # convert channel to frequency
 773         [ "$auto_channel" -gt 0 ] || freq="$(get_freq "$phy" "$channel")"
 774
 775         [ -n "$country" ] && {
 776                 iw reg get | grep -q "^country $country:" || {
 777                         iw reg set "$country"
 778                         sleep 1
 779                 }
 780         }
 781
 782         hostapd_conf_file="/var/run/hostapd-$phy.conf"
 783
 784         no_ap=1
 785         macidx=0
 786         staidx=0
 787
 788         [ -n "$chanbw" ] && {
 789                 for file in /sys/kernel/debug/ieee80211/$phy/ath9k/chanbw /sys/kernel/debug/ieee80211/$phy/ath5k/bwmode; do
 790                         [ -f "$file" ] && echo "$chanbw" > "$file"
 791                 done
 792         }
 793
 794         set_default rxantenna 0xffffffff
 795         set_default txantenna 0xffffffff
 796         set_default distance 0
 797         set_default antenna_gain 0
 798
 799         [ "$txantenna" = "all" ] && txantenna=0xffffffff
 800         [ "$rxantenna" = "all" ] && rxantenna=0xffffffff
 801
 802         iw phy "$phy" set antenna $txantenna $rxantenna >/dev/null 2>&1
 803         iw phy "$phy" set antenna_gain $antenna_gain
 804         iw phy "$phy" set distance "$distance"
 805
 806         [ -n "$frag" ] && iw phy "$phy" set frag "${frag%%.*}"
 807         [ -n "$rts" ] && iw phy "$phy" set rts "${rts%%.*}"
 808
 809         has_ap=
 810         hostapd_ctrl=
 811         hostapd_noscan=
 812         for_each_interface "ap" mac80211_check_ap
 813
 814         rm -f "$hostapd_conf_file"
 815
 816         for_each_interface "sta adhoc mesh" mac80211_set_noscan
 817         [ -n "$has_ap" ] && mac80211_hostapd_setup_base "$phy"
 818
 819         for_each_interface "sta adhoc mesh monitor" mac80211_prepare_vif
 820         for_each_interface "ap" mac80211_prepare_vif
 821
 822         [ -n "$hostapd_ctrl" ] && {
 823                 /usr/sbin/hostapd -s -P /var/run/wifi-$phy.pid -B "$hostapd_conf_file"
 824                 ret="$?"
 825                 wireless_add_process "$(cat /var/run/wifi-$phy.pid)" "/usr/sbin/hostapd" 1
 826                 [ "$ret" != 0 ] && {
 827                         wireless_setup_failed HOSTAPD_START_FAILED
 828                         return
 829                 }
 830         }
 831
 832         for_each_interface "ap sta adhoc mesh monitor" mac80211_setup_vif
 833
 834         wireless_set_up
 835 }
 836
 837 list_phy_interfaces() {
 838         local phy="$1"
 839         if [ -d "/sys/class/ieee80211/${phy}/device/net" ]; then
 840                 ls "/sys/class/ieee80211/${phy}/device/net" 2>/dev/null;
 841         else
 842                 ls "/sys/class/ieee80211/${phy}/device" 2>/dev/null | grep net: | sed -e 's,net:,,g'
 843         fi
 844 }
 845
 846 drv_mac80211_teardown() {
 847         wireless_process_kill_all
 848
 849         json_select data
 850         json_get_vars phy
 851         json_select ..
 852
 853         mac80211_interface_cleanup "$phy"
 854 }
 855
 856 add_driver mac80211