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

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