mac80211: fix HT40 mode for 6G band
[openwrt/openwrt.git] / package / kernel / mac80211 / files / lib / netifd / wireless / mac80211.sh
index 6ca12084cf5041844ffa39c547d8ee422948fe94..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,7 +25,6 @@ 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
@@ -44,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 \
@@ -96,6 +107,23 @@ 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"
 
@@ -119,6 +147,9 @@ mac80211_hostapd_setup_base() {
        [ "$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
@@ -126,7 +157,7 @@ mac80211_hostapd_setup_base() {
                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
@@ -200,7 +231,7 @@ mac80211_hostapd_setup_base() {
        case "$htmode" in
                VHT20|HE20) enable_ac=1;;
                VHT40|HE40)
-                       case "$(( ($channel / 4) % 2 ))" in
+                       case "$(( (($channel / 4) + $chan_ofs) % 2 ))" in
                                1) idx=$(($channel + 2));;
                                0) idx=$(($channel - 2));;
                        esac
@@ -208,7 +239,7 @@ mac80211_hostapd_setup_base() {
                        vht_center_seg0=$idx
                ;;
                VHT80|HE80)
-                       case "$(( ($channel / 4) % 4 ))" in
+                       case "$(( (($channel / 4) + $chan_ofs) % 4 ))" in
                                1) idx=$(($channel + 6));;
                                2) idx=$(($channel + 2));;
                                3) idx=$(($channel - 2));;
@@ -219,15 +250,35 @@ mac80211_hostapd_setup_base() {
                        vht_center_seg0=$idx
                ;;
                VHT160|HE160)
-                       case "$channel" in
-                               36|40|44|48|52|56|60|64) idx=50;;
-                               100|104|108|112|116|120|124|128) idx=114;;
-                       esac
+                       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
                        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
@@ -337,16 +388,62 @@ mac80211_hostapd_setup_base() {
        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_su_beamformer=1" "$N"
-               append base_cfg "he_su_beamformee=1" "$N"
-               append base_cfg "he_mu_beamformer=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
@@ -409,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"
@@ -429,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
        }
@@ -449,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" ] && {
@@ -689,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-";;
@@ -709,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+"
                ;;
@@ -818,7 +915,6 @@ mac80211_setup_vif() {
                mesh)
                        wireless_vif_parse_encryption
                        [ -z "$htmode" ] && htmode="NOHT";
-                       freq="$(get_freq "$phy" "$channel")"
                        if [ "$wpa" -gt 0 -o "$auto_channel" -gt 0 ] || chan_is_dfs "$phy" "$channel"; then
                                mac80211_setup_supplicant $vif_enable || failed=1
                        else
@@ -832,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
@@ -849,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"
@@ -907,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)
@@ -935,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:" || {
@@ -1003,6 +1116,7 @@ drv_mac80211_setup() {
        [ -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=$?
@@ -1019,15 +1133,14 @@ drv_mac80211_setup() {
                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": "wpad"}' | jsonfilter -l 1 -e "@['wpad'].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}"
@@ -1078,6 +1191,10 @@ drv_mac80211_teardown() {
        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}