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