mac80211: fix HT40 mode for 6G band
[openwrt/openwrt.git] / package / kernel / mac80211 / files / lib / netifd / wireless / mac80211.sh
index 501b1ad0de961aea45f4ec61d6b6c610f9309966..4574a9881a3010026340b6de56f49906f6a429d4 100644 (file)
@@ -1,7 +1,6 @@
 #!/bin/sh
 . /lib/netifd/netifd-wireless.sh
 . /lib/netifd/hostapd.sh
-. /lib/netifd/mac80211.sh
 
 init_wireless_driver "$@"
 
@@ -26,13 +25,14 @@ drv_mac80211_init_device_config() {
        hostapd_common_add_device_config
 
        config_add_string path phy 'macaddr:macaddr'
-       config_add_string hwmode
        config_add_string tx_burst
+       config_add_string distance
        config_add_int beacon_int chanbw frag rts
-       config_add_int rxantenna txantenna antenna_gain txpower distance
+       config_add_int rxantenna txantenna antenna_gain txpower
        config_add_boolean noscan ht_coex acs_exclude_dfs
        config_add_array ht_capab
        config_add_array channels
+       config_add_array scan_list
        config_add_boolean \
                rxldpc \
                short_gi_80 \
@@ -42,11 +42,24 @@ drv_mac80211_init_device_config() {
                su_beamformee \
                mu_beamformer \
                mu_beamformee \
+               he_su_beamformer \
+               he_su_beamformee \
+               he_mu_beamformer \
                vht_txop_ps \
                htc_vht \
                rx_antenna_pattern \
-               tx_antenna_pattern
-       config_add_int vht_max_a_mpdu_len_exp vht_max_mpdu vht_link_adapt vht160 rx_stbc tx_stbc
+               tx_antenna_pattern \
+               he_spr_sr_control \
+               he_twt_required
+       config_add_int \
+               vht_max_a_mpdu_len_exp \
+               vht_max_mpdu \
+               vht_link_adapt \
+               vht160 \
+               rx_stbc \
+               tx_stbc \
+               he_bss_color \
+               he_spr_non_srg_obss_pd_max_offset
        config_add_boolean \
                ldpc \
                greenfield \
@@ -94,13 +107,29 @@ mac80211_add_capabilities() {
        export -n -- "$__var=$__out"
 }
 
+mac80211_add_he_capabilities() {
+       local __out= oifs
+
+       oifs="$IFS"
+       IFS=:
+       for capab in "$@"; do
+               set -- $capab
+               [ "$(($4))" -gt 0 ] || continue
+               [ "$(((0x$2) & $3))" -gt 0 ] || {
+                       eval "$1=0"
+                       continue
+               }
+               append base_cfg "$1=1" "$N"
+       done
+       IFS="$oifs"
+}
+
 mac80211_hostapd_setup_base() {
        local phy="$1"
 
        json_select config
 
        [ "$auto_channel" -gt 0 ] && channel=acs_survey
-       [ "$auto_channel" -gt 0 ] && json_get_values channel_list channels
 
        [ "$auto_channel" -gt 0 ] && json_get_vars acs_exclude_dfs
        [ -n "$acs_exclude_dfs" ] && [ "$acs_exclude_dfs" -gt 0 ] &&
@@ -108,20 +137,27 @@ mac80211_hostapd_setup_base() {
 
        json_get_vars noscan ht_coex
        json_get_values ht_capab_list ht_capab tx_burst
+       json_get_values channel_list channels
+
+       [ "$auto_channel" = 0 ] && [ -z "$channel_list" ] && \
+               channel_list="$channel"
 
        set_default noscan 0
 
        [ "$noscan" -gt 0 ] && hostapd_noscan=1
        [ "$tx_burst" = 0 ] && tx_burst=
 
+       chan_ofs=0
+       [ "$band" = "6g" ] && chan_ofs=1
+
        ieee80211n=1
        ht_capab=
        case "$htmode" in
-               VHT20|HT20) ;;
-               HT40*|VHT40|VHT80|VHT160)
+               VHT20|HT20|HE20) ;;
+               HT40*|VHT40|VHT80|VHT160|HE40|HE80|HE160)
                        case "$hwmode" in
                                a)
-                                       case "$(( ($channel / 4) % 2 ))" in
+                                       case "$(( (($channel / 4) + $chan_ofs) % 2 ))" in
                                                1) ht_capab="[HT40+]";;
                                                0) ht_capab="[HT40-]";;
                                        esac
@@ -188,39 +224,62 @@ mac80211_hostapd_setup_base() {
 
        # 802.11ac
        enable_ac=0
+       vht_oper_chwidth=0
+       vht_center_seg0=
+
        idx="$channel"
        case "$htmode" in
-               VHT20) enable_ac=1;;
-               VHT40)
-                       case "$(( ($channel / 4) % 2 ))" in
+               VHT20|HE20) enable_ac=1;;
+               VHT40|HE40)
+                       case "$(( (($channel / 4) + $chan_ofs) % 2 ))" in
                                1) idx=$(($channel + 2));;
                                0) idx=$(($channel - 2));;
                        esac
                        enable_ac=1
-                       append base_cfg "vht_oper_chwidth=0" "$N"
-                       append base_cfg "vht_oper_centr_freq_seg0_idx=$idx" "$N"
+                       vht_center_seg0=$idx
                ;;
-               VHT80)
-                       case "$(( ($channel / 4) % 4 ))" in
+               VHT80|HE80)
+                       case "$(( (($channel / 4) + $chan_ofs) % 4 ))" in
                                1) idx=$(($channel + 6));;
                                2) idx=$(($channel + 2));;
                                3) idx=$(($channel - 2));;
                                0) idx=$(($channel - 6));;
                        esac
                        enable_ac=1
-                       append base_cfg "vht_oper_chwidth=1" "$N"
-                       append base_cfg "vht_oper_centr_freq_seg0_idx=$idx" "$N"
+                       vht_oper_chwidth=1
+                       vht_center_seg0=$idx
                ;;
-               VHT160)
-                       case "$channel" in
-                               36|40|44|48|52|56|60|64) idx=50;;
-                               100|104|108|112|116|120|124|128) idx=114;;
-                       esac
+               VHT160|HE160)
+                       if [ "$band" = "6g" ]; then
+                               case "$channel" in
+                                       1|5|9|13|17|21|25|29) idx=15;;
+                                       33|37|41|45|49|53|57|61) idx=47;;
+                                       65|69|73|77|81|85|89|93) idx=79;;
+                                       97|101|105|109|113|117|121|125) idx=111;;
+                                       129|133|137|141|145|149|153|157) idx=143;;
+                                       161|165|169|173|177|181|185|189) idx=175;;
+                                       193|197|201|205|209|213|217|221) idx=207;;
+                               esac
+                       else
+                               case "$channel" in
+                                       36|40|44|48|52|56|60|64) idx=50;;
+                                       100|104|108|112|116|120|124|128) idx=114;;
+                               esac
+                       fi
                        enable_ac=1
-                       append base_cfg "vht_oper_chwidth=2" "$N"
-                       append base_cfg "vht_oper_centr_freq_seg0_idx=$idx" "$N"
+                       vht_oper_chwidth=2
+                       vht_center_seg0=$idx
                ;;
        esac
+       [ "$band" = "6g" ] && {
+               op_class=
+               case "$htmode" in
+                       HE20) op_class=131;;
+                       HE*) op_class=$((132 + $vht_oper_chwidth))
+               esac
+               [ -n "$op_class" ] && append base_cfg "op_class=$op_class" "$N"
+       }
+       [ "$hwmode" = "a" ] || enable_ac=0
 
        if [ "$enable_ac" != "0" ]; then
                json_get_vars \
@@ -249,6 +308,9 @@ mac80211_hostapd_setup_base() {
                        vht_cap="$(($vht_cap | $cap))"
                done
 
+               append base_cfg "vht_oper_chwidth=$vht_oper_chwidth" "$N"
+               append base_cfg "vht_oper_centr_freq_seg0_idx=$vht_center_seg0" "$N"
+
                cap_rx_stbc=$((($vht_cap >> 8) & 7))
                [ "$rx_stbc" -lt "$cap_rx_stbc" ] && cap_rx_stbc="$rx_stbc"
                vht_cap="$(( ($vht_cap & ~(0x700)) | ($cap_rx_stbc << 8) ))"
@@ -319,6 +381,71 @@ mac80211_hostapd_setup_base() {
                [ -n "$vht_capab" ] && append base_cfg "vht_capab=$vht_capab" "$N"
        fi
 
+       # 802.11ax
+       enable_ax=0
+       case "$htmode" in
+               HE*) enable_ax=1 ;;
+       esac
+
+       if [ "$enable_ax" != "0" ]; then
+               json_get_vars \
+                       he_su_beamformer:1 \
+                       he_su_beamformee:0 \
+                       he_mu_beamformer:1 \
+                       he_twt_required:0 \
+                       he_spr_sr_control:0 \
+                       he_spr_non_srg_obss_pd_max_offset:1 \
+                       he_bss_color
+
+               he_phy_cap=$(iw phy "$phy" info | awk -F "[()]" '/HE PHY Capabilities/ { print $2 }' | head -1)
+               he_phy_cap=${he_phy_cap:2}
+               he_mac_cap=$(iw phy "$phy" info | awk -F "[()]" '/HE MAC Capabilities/ { print $2 }' | head -1)
+               he_mac_cap=${he_mac_cap:2}
+
+               append base_cfg "ieee80211ax=1" "$N"
+               [ -n "$he_bss_color" ] && append base_cfg "he_bss_color=$he_bss_color" "$N"
+               [ "$hwmode" = "a" ] && {
+                       append base_cfg "he_oper_chwidth=$vht_oper_chwidth" "$N"
+                       append base_cfg "he_oper_centr_freq_seg0_idx=$vht_center_seg0" "$N"
+               }
+
+               mac80211_add_he_capabilities \
+                       he_su_beamformer:${he_phy_cap:6:2}:0x80:$he_su_beamformer \
+                       he_su_beamformee:${he_phy_cap:8:2}:0x1:$he_su_beamformee \
+                       he_mu_beamformer:${he_phy_cap:8:2}:0x2:$he_mu_beamformer \
+                       he_spr_sr_control:${he_phy_cap:14:2}:0x1:$he_spr_sr_control \
+                       he_twt_required:${he_mac_cap:0:2}:0x6:$he_twt_required
+
+               [ "$he_spr_sr_control" -gt 0 ] && append base_cfg "he_spr_non_srg_obss_pd_max_offset=$he_spr_non_srg_obss_pd_max_offset" "$N"
+
+               append base_cfg "he_default_pe_duration=4" "$N"
+               append base_cfg "he_rts_threshold=1023" "$N"
+               append base_cfg "he_mu_edca_qos_info_param_count=0" "$N"
+               append base_cfg "he_mu_edca_qos_info_q_ack=0" "$N"
+               append base_cfg "he_mu_edca_qos_info_queue_request=0" "$N"
+               append base_cfg "he_mu_edca_qos_info_txop_request=0" "$N"
+               append base_cfg "he_mu_edca_ac_be_aifsn=8" "$N"
+               append base_cfg "he_mu_edca_ac_be_aci=0" "$N"
+               append base_cfg "he_mu_edca_ac_be_ecwmin=9" "$N"
+               append base_cfg "he_mu_edca_ac_be_ecwmax=10" "$N"
+               append base_cfg "he_mu_edca_ac_be_timer=255" "$N"
+               append base_cfg "he_mu_edca_ac_bk_aifsn=15" "$N"
+               append base_cfg "he_mu_edca_ac_bk_aci=1" "$N"
+               append base_cfg "he_mu_edca_ac_bk_ecwmin=9" "$N"
+               append base_cfg "he_mu_edca_ac_bk_ecwmax=10" "$N"
+               append base_cfg "he_mu_edca_ac_bk_timer=255" "$N"
+               append base_cfg "he_mu_edca_ac_vi_ecwmin=5" "$N"
+               append base_cfg "he_mu_edca_ac_vi_ecwmax=7" "$N"
+               append base_cfg "he_mu_edca_ac_vi_aifsn=5" "$N"
+               append base_cfg "he_mu_edca_ac_vi_aci=2" "$N"
+               append base_cfg "he_mu_edca_ac_vi_timer=255" "$N"
+               append base_cfg "he_mu_edca_ac_vo_aifsn=5" "$N"
+               append base_cfg "he_mu_edca_ac_vo_aci=3" "$N"
+               append base_cfg "he_mu_edca_ac_vo_ecwmin=5" "$N"
+               append base_cfg "he_mu_edca_ac_vo_ecwmax=7" "$N"
+               append base_cfg "he_mu_edca_ac_vo_timer=255" "$N"
+       fi
+
        hostapd_prepare_device_config "$hostapd_conf_file" nl80211
        cat >> "$hostapd_conf_file" <<EOF
 ${channel:+channel=$channel}
@@ -342,7 +469,7 @@ mac80211_hostapd_setup_bss() {
        hostapd_cfg=
        append hostapd_cfg "$type=$ifname" "$N"
 
-       hostapd_set_bss_options hostapd_cfg "$vif" || return 1
+       hostapd_set_bss_options hostapd_cfg "$phy" "$vif" || return 1
        json_get_vars wds wds_bridge dtim_period max_listen_int start_disabled
 
        set_default wds 0
@@ -366,7 +493,7 @@ mac80211_get_addr() {
        local phy="$1"
        local idx="$(($2 + 1))"
 
-       head -n $(($macidx + 1)) /sys/class/ieee80211/${phy}/addresses | tail -n1
+       head -n $idx /sys/class/ieee80211/${phy}/addresses | tail -n1
 }
 
 mac80211_generate_mac() {
@@ -379,7 +506,7 @@ mac80211_generate_mac() {
        [ "$mask" = "00:00:00:00:00:00" ] && {
                mask="ff:ff:ff:ff:ff:ff";
 
-               [ "$(wc -l < /sys/class/ieee80211/${phy}/addresses)" -gt 1 ] && {
+               [ "$(wc -l < /sys/class/ieee80211/${phy}/addresses)" -gt $id ] && {
                        addr="$(mac80211_get_addr "$phy" "$id")"
                        [ -n "$addr" ] && {
                                echo "$addr"
@@ -399,7 +526,7 @@ mac80211_generate_mac() {
        [ "$((0x$mask1))" -gt 0 ] && {
                b1="0x$1"
                [ "$id" -gt 0 ] && \
-                       b1=$(($b1 ^ ((($id - !($b1 & 2)) << 2) | 0x2)))
+                       b1=$(($b1 ^ ((($id - !($b1 & 2)) << 2)) | 0x2))
                printf "%02x:%s:%s:%s:%s:%s" $b1 $2 $3 $4 $5 $6
                return
        }
@@ -419,7 +546,7 @@ mac80211_generate_mac() {
 find_phy() {
        [ -n "$phy" -a -d /sys/class/ieee80211/$phy ] && return 0
        [ -n "$path" ] && {
-               phy="$(mac80211_path_to_phy "$path")"
+               phy="$(iwinfo nl80211 phyname "path=$path")"
                [ -n "$phy" ] && return 0
        }
        [ -n "$macaddr" ] && {
@@ -440,15 +567,16 @@ mac80211_iw_interface_add() {
        local type="$3"
        local wdsflag="$4"
        local rc
+       local oldifname
 
-       iw phy "$phy" interface add "$ifname" type "$type" $wdsflag
+       iw phy "$phy" interface add "$ifname" type "$type" $wdsflag >/dev/null 2>&1
        rc="$?"
 
        [ "$rc" = 233 ] && {
                # Device might have just been deleted, give the kernel some time to finish cleaning it up
                sleep 1
 
-               iw phy "$phy" interface add "$ifname" type "$type" $wdsflag
+               iw phy "$phy" interface add "$ifname" type "$type" $wdsflag >/dev/null 2>&1
                rc="$?"
        }
 
@@ -475,17 +603,26 @@ mac80211_iw_interface_add() {
        }
 
        [ "$rc" = 233 ] && {
-               iw dev "$ifname" del
-               sleep 1
+               iw dev "$ifname" del >/dev/null 2>&1
+               [ "$?" = 0 ] && {
+                       sleep 1
 
-               iw phy "$phy" interface add "$ifname" type "$type" $wdsflag
-               rc="$?"
+                       iw phy "$phy" interface add "$ifname" type "$type" $wdsflag >/dev/null 2>&1
+                       rc="$?"
+               }
        }
 
-       [ "$rc" = 233 ] && {
+       [ "$rc" != 0 ] && {
                # Device might not support virtual interfaces, so the interface never got deleted in the first place.
                # Check if the interface already exists, and avoid failing in this case.
-               ip link show dev "$ifname" >/dev/null 2>/dev/null && rc=0
+               [ -d "/sys/class/ieee80211/${phy}/device/net/${ifname}" ] && rc=0
+       }
+
+       [ "$rc" != 0 ] && {
+               # Device doesn't support virtual interfaces and may have existing interface other than ifname.
+               oldifname="$(basename "/sys/class/ieee80211/${phy}/device/net"/* 2>/dev/null)"
+               [ "$oldifname" ] && ip link set "$oldifname" name "$ifname" 1>/dev/null 2>&1
+               rc="$?"
        }
 
        [ "$rc" != 0 ] && wireless_setup_failed INTERFACE_CREATION_FAILED
@@ -495,7 +632,7 @@ mac80211_iw_interface_add() {
 mac80211_prepare_vif() {
        json_select config
 
-       json_get_vars ifname mode ssid wds powersave macaddr enable
+       json_get_vars ifname mode ssid wds powersave macaddr enable wpa_psk_file vlan_file
 
        [ -n "$ifname" ] || ifname="wlan${phy#phy}${if_idx:+-$if_idx}"
        if_idx=$((${if_idx:-0} + 1))
@@ -513,6 +650,12 @@ mac80211_prepare_vif() {
        json_add_object data
        json_add_string ifname "$ifname"
        json_close_object
+
+       [ "$mode" == "ap" ] && {
+               [ -z "$wpa_psk_file" ] && hostapd_set_psk "$ifname"
+               [ -z "$vlan_file" ] && hostapd_set_vlan "$ifname"
+       }
+
        json_select config
 
        # It is far easier to delete and create the desired interface
@@ -580,7 +723,13 @@ mac80211_setup_supplicant() {
        local add_sp=0
        local spobj="$(ubus -S list | grep wpa_supplicant.${ifname})"
 
-       wpa_supplicant_prepare_interface "$ifname" nl80211 || return 1
+       [ "$enable" = 0 ] && {
+               ubus call wpa_supplicant.${phy} config_remove "{\"iface\":\"$ifname\"}"
+               ip link set dev "$ifname" down
+               iw dev "$ifname" del
+               return 0
+       }
+
        wpa_supplicant_prepare_interface "$ifname" nl80211 || {
                iw dev "$ifname" del
                return 1
@@ -597,18 +746,17 @@ mac80211_setup_supplicant() {
                [ "$spobj" ] && ubus call wpa_supplicant config_remove "{\"iface\":\"$ifname\"}"
                add_sp=1
        fi
-       [ "$enable" = 0 ] && {
-               ubus call wpa_supplicant config_remove "{\"iface\":\"$ifname\"}"
-               ip link set dev "$ifname" down
-               return 0
-       }
        [ -z "$spobj" ] && add_sp=1
 
+       NEW_MD5_SP=$(test -e "${_config}" && md5sum ${_config})
+       OLD_MD5_SP=$(uci -q -P /var/state get wireless._${phy}.md5_${ifname})
        if [ "$add_sp" = "1" ]; then
                wpa_supplicant_run "$ifname" "$hostapd_ctrl"
        else
-               ubus call $spobj reload
+               [ "${NEW_MD5_SP}" == "${OLD_MD5_SP}" ] || ubus call $spobj reload
        fi
+       uci -q -P /var/state set wireless._${phy}.md5_${ifname}="${NEW_MD5_SP}"
+       return 0
 }
 
 mac80211_setup_supplicant_noctl() {
@@ -638,14 +786,8 @@ mac80211_prepare_iw_htmode() {
        case "$htmode" in
                VHT20|HT20) iw_htmode=HT20;;
                HT40*|VHT40|VHT160)
-                       case "$hwmode" in
-                               a)
-                                       case "$(( ($channel / 4) % 2 ))" in
-                                               1) iw_htmode="HT40+" ;;
-                                               0) iw_htmode="HT40-";;
-                                       esac
-                               ;;
-                               *)
+                       case "$band" in
+                               2g)
                                        case "$htmode" in
                                                HT40+) iw_htmode="HT40+";;
                                                HT40-) iw_htmode="HT40-";;
@@ -658,6 +800,12 @@ mac80211_prepare_iw_htmode() {
                                                ;;
                                        esac
                                ;;
+                               *)
+                                       case "$(( ($channel / 4) % 2 ))" in
+                                               1) iw_htmode="HT40+" ;;
+                                               0) iw_htmode="HT40-";;
+                                       esac
+                               ;;
                        esac
                        [ "$auto_channel" -gt 0 ] && iw_htmode="HT40+"
                ;;
@@ -755,7 +903,6 @@ mac80211_setup_vif() {
 
        [ "$vif_enable" = 1 ] || action=down
        if [ "$mode" != "ap" ] || [ "$ifname" = "$ap_ifname" ]; then
-               logger ip link set dev "$ifname" $action
                ip link set dev "$ifname" "$action" || {
                        wireless_setup_vif_failed IFUP_ERROR
                        json_select ..
@@ -767,7 +914,7 @@ mac80211_setup_vif() {
        case "$mode" in
                mesh)
                        wireless_vif_parse_encryption
-                       freq="$(get_freq "$phy" "$channel")"
+                       [ -z "$htmode" ] && htmode="NOHT";
                        if [ "$wpa" -gt 0 -o "$auto_channel" -gt 0 ] || chan_is_dfs "$phy" "$channel"; then
                                mac80211_setup_supplicant $vif_enable || failed=1
                        else
@@ -781,7 +928,6 @@ mac80211_setup_vif() {
                adhoc)
                        wireless_vif_parse_encryption
                        if [ "$wpa" -gt 0 -o "$auto_channel" -gt 0 ]; then
-                               freq="$(get_freq "$phy" "$channel")"
                                mac80211_setup_supplicant_noctl $vif_enable || failed=1
                        else
                                mac80211_setup_adhoc $vif_enable
@@ -798,10 +944,30 @@ mac80211_setup_vif() {
 
 get_freq() {
        local phy="$1"
-       local chan="$2"
-       iw "$phy" info | grep -E -m1 "(\* ${chan:-....} MHz${chan:+|\\[$chan\\]})" | grep MHz | awk '{print $2}'
+       local channel="$2"
+       local band="$3"
+
+       case "$band" in
+               2g) band="1:";;
+               5g) band="2:";;
+               60g) band="3:";;
+               6g) band="4:";;
+       esac
+
+       iw "$phy" info | awk -v band="$band" -v channel="[$channel]" '
+
+$1 ~ /Band/ {
+       band_match = band == $2
 }
 
+band_match && $3 == "MHz" && $4 == channel {
+       print $2
+       exit
+}
+'
+}
+
+
 chan_is_dfs() {
        local phy="$1"
        local chan="$2"
@@ -847,6 +1013,7 @@ drv_mac80211_setup() {
                rxantenna txantenna \
                frag rts beacon_int:100 htmode
        json_get_values basic_rate_list basic_rate
+       json_get_values scan_list scan_list
        json_select ..
 
        find_phy || {
@@ -855,10 +1022,8 @@ drv_mac80211_setup() {
                return 1
        }
 
-       [ -z "$(uci -q -P /var/state show wireless._${phy})" ] && {
-               uci -q -P /var/state set wireless._${phy}=phy
-               wireless_set_data phy="$phy"
-       }
+       wireless_set_data phy="$phy"
+       [ -z "$(uci -q -P /var/state show wireless._${phy})" ] && uci -q -P /var/state set wireless._${phy}=phy
 
        OLDAPLIST=$(uci -q -P /var/state get wireless._${phy}.aplist)
        OLDSPLIST=$(uci -q -P /var/state get wireless._${phy}.splist)
@@ -883,7 +1048,7 @@ drv_mac80211_setup() {
        done
 
        # convert channel to frequency
-       [ "$auto_channel" -gt 0 ] || freq="$(get_freq "$phy" "$channel")"
+       [ "$auto_channel" -gt 0 ] || freq="$(get_freq "$phy" "$channel" "$band")"
 
        [ -n "$country" ] && {
                iw reg get | grep -q "^country $country:" || {
@@ -913,8 +1078,8 @@ drv_mac80211_setup() {
        [ "$rxantenna" = "all" ] && rxantenna=0xffffffff
 
        iw phy "$phy" set antenna $txantenna $rxantenna >/dev/null 2>&1
-       iw phy "$phy" set antenna_gain $antenna_gain
-       iw phy "$phy" set distance "$distance"
+       iw phy "$phy" set antenna_gain $antenna_gain >/dev/null 2>&1
+       iw phy "$phy" set distance "$distance" >/dev/null 2>&1
 
        if [ -n "$txpower" ]; then
                iw phy "$phy" set txpower fixed "${txpower%%.*}00"
@@ -944,34 +1109,38 @@ drv_mac80211_setup() {
        OLD_MD5=$(uci -q -P /var/state get wireless._${phy}.md5)
        if [ "${NEWAPLIST}" != "${OLDAPLIST}" ]; then
                mac80211_vap_cleanup hostapd "${OLDAPLIST}"
-               [ -n "${NEWAPLIST}" ] && mac80211_iw_interface_add "$phy" "${NEWAPLIST%% *}" __ap || return
        fi
+       [ -n "${NEWAPLIST}" ] && mac80211_iw_interface_add "$phy" "${NEWAPLIST%% *}" __ap
        local add_ap=0
        local primary_ap=${NEWAPLIST%% *}
        [ -n "$hostapd_ctrl" ] && {
                local no_reload=1
                if [ -n "$(ubus list | grep hostapd.$primary_ap)" ]; then
+                       no_reload=0
                        [ "${NEW_MD5}" = "${OLD_MD5}" ] || {
                                ubus call hostapd.$primary_ap reload
                                no_reload=$?
                                if [ "$no_reload" != "0" ]; then
                                        mac80211_vap_cleanup hostapd "${OLDAPLIST}"
-                                       [ -n "${NEWAPLIST}" ] && mac80211_iw_interface_add "$phy" "${NEWAPLIST%% *}" __ap || return
+                                       mac80211_vap_cleanup wpa_supplicant "$(uci -q -P /var/state get wireless._${phy}.splist)"
+                                       mac80211_vap_cleanup none "$(uci -q -P /var/state get wireless._${phy}.umlist)"
+                                       sleep 2
+                                       mac80211_iw_interface_add "$phy" "${NEWAPLIST%% *}" __ap
+                                       for_each_interface "sta adhoc mesh monitor" mac80211_prepare_vif
                                fi
                        }
                fi
                if [ "$no_reload" != "0" ]; then
                        add_ap=1
                        ubus wait_for hostapd
-                       ubus call hostapd config_add "{\"iface\":\"$primary_ap\", \"config\":\"${hostapd_conf_file}\"}"
-                       local hostapd_pid=$(ubus call service list '{"name": "hostapd"}' | jsonfilter -l 1 -e "@['hostapd'].instances['hostapd'].pid")
-                       wireless_add_process "$hostapd_pid" "/usr/sbin/hostapd" 1
+                       local hostapd_res="$(ubus call hostapd config_add "{\"iface\":\"$primary_ap\", \"config\":\"${hostapd_conf_file}\"}")"
+                       ret="$?"
+                       [ "$ret" != 0 -o -z "$hostapd_res" ] && {
+                               wireless_setup_failed HOSTAPD_START_FAILED
+                               return
+                       }
+                       wireless_add_process "$(jsonfilter -s "$hostapd_res" -l 1 -e @.pid)" "/usr/sbin/hostapd" 1 1
                fi
-               ret="$?"
-               [ "$ret" != 0 ] && {
-                       wireless_setup_failed HOSTAPD_START_FAILED
-                       return
-               }
        }
        uci -q -P /var/state set wireless._${phy}.aplist="${NEWAPLIST}"
        uci -q -P /var/state set wireless._${phy}.md5="${NEW_MD5}"
@@ -1019,11 +1188,13 @@ list_phy_interfaces() {
 }
 
 drv_mac80211_teardown() {
-       wireless_process_kill_all
-
        json_select data
        json_get_vars phy
        json_select ..
+       [ -n "$phy" ] || {
+               echo "Bug: PHY is undefined for device '$1'"
+               return 1
+       }
 
        mac80211_interface_cleanup "$phy"
        uci -q -P /var/state revert wireless._${phy}