mac80211: fix VHT80 channel allocation (thx, SeG)
[openwrt/svn-archive/archive.git] / package / kernel / mac80211 / files / lib / netifd / wireless / mac80211.sh
1 #!/bin/sh
2 . /lib/netifd/netifd-wireless.sh
3 . /lib/netifd/hostapd.sh
4
5 init_wireless_driver "$@"
6
7 MP_CONFIG_INT="mesh_retry_timeout mesh_confirm_timeout mesh_holding_timeout mesh_max_peer_links
8 mesh_max_retries mesh_ttl mesh_element_ttl mesh_hwmp_max_preq_retries
9 mesh_path_refresh_time mesh_min_discovery_timeout mesh_hwmp_active_path_timeout
10 mesh_hwmp_preq_min_interval mesh_hwmp_net_diameter_traversal_time mesh_hwmp_rootmode
11 mesh_hwmp_rann_interval mesh_gate_announcements mesh_sync_offset_max_neighor
12 mesh_rssi_threshold mesh_hwmp_active_path_to_root_timeout mesh_hwmp_root_interval
13 mesh_hwmp_confirmation_interval mesh_awake_window mesh_plink_timeout"
14 MP_CONFIG_BOOL="mesh_auto_open_plinks mesh_fwding"
15 MP_CONFIG_STRING="mesh_power_mode"
16
17 drv_mac80211_init_device_config() {
18 hostapd_common_add_device_config
19
20 config_add_string path phy 'macaddr:macaddr'
21 config_add_string hwmode
22 config_add_int beacon_int chanbw frag rts
23 config_add_int rxantenna txantenna antenna_gain txpower distance
24 config_add_boolean noscan
25 config_add_array ht_capab
26 config_add_boolean \
27 rxldpc \
28 short_gi_80 \
29 short_gi_160 \
30 tx_stbc_2by1 \
31 su_beamformer \
32 su_beamformee \
33 mu_beamformer \
34 mu_beamformee \
35 vht_txop_ps \
36 htc_vht \
37 rx_antenna_pattern \
38 tx_antenna_pattern
39 config_add_int vht_max_mpdu vht_max_rx_stbc vht_link_adapt vht160
40 }
41
42 drv_mac80211_init_iface_config() {
43 hostapd_common_add_bss_config
44
45 config_add_string 'macaddr:macaddr' ifname
46
47 config_add_boolean wds powersave
48 config_add_int maxassoc
49 config_add_int max_listen_int
50 config_add_int dtim_interval
51
52 # mesh
53 config_add_string mesh_id
54 config_add_int $MP_CONFIG_INT
55 config_add_boolean $MP_CONFIG_BOOL
56 config_add_string $MP_CONFIG_STRING
57 }
58
59 mac80211_add_capabilities() {
60 local __var="$1"; shift
61 local __mask="$1"; shift
62 local __out= oifs
63
64 oifs="$IFS"
65 IFS=:
66 for capab in "$@"; do
67 set -- $capab
68
69 [ "$(($4))" -gt 0 ] || continue
70 [ "$(($__mask & $2))" -eq "$((${3:-$2}))" ] || continue
71 __out="$__out[$1]"
72 done
73 IFS="$oifs"
74
75 export -n -- "$__var=$__out"
76 }
77
78 mac80211_hostapd_setup_base() {
79 local phy="$1"
80
81 json_select config
82
83 [ "$auto_channel" -gt 0 ] && channel=acs_survey
84
85 json_get_vars noscan htmode
86 json_get_values ht_capab_list ht_capab
87
88 ieee80211n=1
89 ht_capab=
90 case "$htmode" in
91 VHT20|HT20) ;;
92 HT40*|VHT40|VHT80|VHT160)
93 case "$hwmode" in
94 a)
95 case "$(( ($channel / 4) % 2 ))" in
96 1) ht_capab="[HT40+]";;
97 0) ht_capab="[HT40-]";;
98 esac
99 ;;
100 *)
101 case "$htmode" in
102 HT40+) ht_capab="[HT40+]";;
103 HT40-) ht_capab="[HT40-]";;
104 *)
105 if [ "$channel" -lt 7 ]; then
106 ht_capab="[HT40+]"
107 else
108 ht_capab="[HT40-]"
109 fi
110 ;;
111 esac
112 ;;
113 esac
114 [ "$auto_channel" -gt 0 ] && ht_capab="[HT40+]"
115 ;;
116 *) ieee80211n= ;;
117 esac
118
119 [ -n "$ieee80211n" ] && {
120 append base_cfg "ieee80211n=1" "$N"
121
122 json_get_vars \
123 ldpc:1 \
124 greenfield:1 \
125 short_gi_20:1 \
126 short_gi_40:1 \
127 tx_stbc:1 \
128 rx_stbc:3 \
129 dsss_cck_40:1
130
131 ht_cap_mask=0
132 for cap in $(iw phy "$phy" info | grep 'Capabilities:' | cut -d: -f2); do
133 ht_cap_mask="$(($ht_cap_mask | $cap))"
134 done
135
136 cap_rx_stbc=$((($ht_cap_mask >> 8) & 3))
137 [ "$rx_stbc" -lt "$cap_rx_stbc" ] && cap_rx_stbc="$rx_stbc"
138 ht_cap_mask="$(( ($ht_cap_mask & ~(0x300)) | ($cap_rx_stbc << 8) ))"
139
140 mac80211_add_capabilities ht_capab_flags $ht_cap_mask \
141 LDPC:0x1::$ldpc \
142 GF:0x10::$greenfield \
143 SHORT-GI-20:0x20::$short_gi_20 \
144 SHORT-GI-40:0x40::$short_gi_40 \
145 TX-STBC:0x80::$max_tx_stbc \
146 RX-STBC1:0x300:0x100:1 \
147 RX-STBC12:0x300:0x200:1 \
148 RX-STBC123:0x300:0x300:1 \
149 DSSS_CCK-40:0x1000::$dsss_cck_40
150
151 [ -n "$ht_capab" ] && append base_cfg "ht_capab=$ht_capab$ht_capab_flags" "$N"
152 }
153
154 # 802.11ac
155 enable_ac=0
156 idx="$channel"
157 case "$htmode" in
158 VHT20) enable_ac=1;;
159 VHT40)
160 case "$(( ($channel / 4) % 2 ))" in
161 1) idx=$(($channel + 2));;
162 0) idx=$(($channel - 2));;
163 esac
164 enable_ac=1
165 append base_cfg "vht_oper_chwidth=0" "$N"
166 append base_cfg "vht_oper_centr_freq_seg0_idx=$idx" "$N"
167 ;;
168 VHT80)
169 case "$(( ($channel / 4) % 4 ))" in
170 1) idx=$(($channel + 6));;
171 2) idx=$(($channel + 2));;
172 3) idx=$(($channel - 2));;
173 0) idx=$(($channel - 6));;
174 esac
175 enable_ac=1
176 append base_cfg "vht_oper_chwidth=1" "$N"
177 append base_cfg "vht_oper_centr_freq_seg0_idx=$idx" "$N"
178 ;;
179 VHT160)
180 case "$channel" in
181 36|40|44|48|52|56|60|64) idx=50;;
182 100|104|108|112|116|120|124|128) idx=114;;
183 esac
184 enable_ac=1
185 append base_cfg "vht_oper_chwidth=2" "$N"
186 append base_cfg "vht_oper_centr_freq_seg0_idx=$idx" "$N"
187 ;;
188 esac
189
190 if [ "$enable_ac" != "0" ]; then
191 json_get_vars \
192 rxldpc:1 \
193 short_gi_80:1 \
194 short_gi_160:1 \
195 tx_stbc_2by1:1 \
196 su_beamformer:1 \
197 su_beamformee:1 \
198 mu_beamformer:1 \
199 mu_beamformee:1 \
200 vht_txop_ps:1 \
201 htc_vht:1 \
202 rx_antenna_pattern:1 \
203 tx_antenna_pattern:1 \
204 vht_max_mpdu:11454 \
205 rx_stbc:4 \
206 vht_link_adapt:3 \
207 vht160:2
208
209 append base_cfg "ieee80211ac=1" "$N"
210 vht_cap=0
211 for cap in $(iw phy "$phy" info | awk -F "[()]" '/VHT Capabilities/ { print $2 }'); do
212 vht_cap="$(($vht_cap | $cap))"
213 done
214
215 cap_rx_stbc=$((($vht_cap >> 8) & 7))
216 [ "$rx_stbc" -lt "$cap_rx_stbc" ] && cap_rx_stbc="$rx_stbc"
217 ht_cap_mask="$(( ($vht_cap & ~(0x700)) | ($cap_rx_stbc << 8) ))"
218
219 mac80211_add_capabilities vht_capab $vht_cap \
220 RXLDPC:0x10::$rxldpc \
221 SHORT-GI-80:0x20::$short_gi_80 \
222 SHORT-GI-160:0x40::$short_gi_160 \
223 TX-STBC-2BY1:0x80::$tx_stbc \
224 SU-BEAMFORMER:0x800::$su_beamformer \
225 SU-BEAMFORMEE:0x1000::$su_beamformee \
226 MU-BEAMFORMER:0x80000::$mu_beamformer \
227 MU-BEAMFORMEE:0x100000::$mu_beamformee \
228 VHT-TXOP-PS:0x200000::$vht_txop_ps \
229 HTC-VHT:0x400000::$htc_vht \
230 RX-ANTENNA-PATTERN:0x10000000::$rx_antenna_pattern \
231 TX-ANTENNA-PATTERN:0x20000000::$tx_antenna_pattern \
232 RX-STBC1:0x700:0x100:1 \
233 RX-STBC12:0x700:0x200:1 \
234 RX-STBC123:0x700:0x300:1 \
235 RX-STBC1234:0x700:0x400:1 \
236
237 # supported Channel widths
238 vht160_hw=0
239 [ "$(($vht_cap & 12))" -eq 4 -a 1 -le "$vht160" ] && \
240 vht160_hw=1
241 [ "$(($vht_cap & 12))" -eq 8 -a 2 -le "$vht160" ] && \
242 vht160_hw=2
243 [ "$vht160_hw" = 1 ] && vht_capab="$vht_capab[VHT160]"
244 [ "$vht160_hw" = 2 ] && vht_capab="$vht_capab[VHT160-80PLUS80]"
245
246 # maximum MPDU length
247 vht_max_mpdu_hw=3895
248 [ "$(($vht_cap & 3))" -ge 1 -a 7991 -le "$vht_max_mpdu" ] && \
249 vht_max_mpdu_hw=7991
250 [ "$(($vht_cap & 3))" -ge 2 -a 11454 -le "$vht_max_mpdu" ] && \
251 vht_max_mpdu_hw=11454
252 [ "$vht_max_mpdu_hw" != 3895 ] && \
253 vht_capab="$vht_capab[MAX-MPDU-$vht_max_mpdu_hw]"
254
255 # whether or not the STA supports link adaptation using VHT variant
256 vht_link_adapt_hw=0
257 [ "$(($vht_cap & 201326592))" -ge 134217728 -a 2 -le "$vht_link_adapt" ] && \
258 vht_link_adapt_hw=2
259 [ "$(($vht_cap & 201326592))" -ge 201326592 -a 3 -le "$vht_link_adapt" ] && \
260 vht_link_adapt_hw=3
261 [ "$vht_link_adapt_hw" != 0 ] && \
262 vht_capab="$vht_capab[VHT-LINK-ADAPT-$vht_link_adapt_hw]"
263
264 [ -n "$vht_capab" ] && append base_cfg "vht_capab=$vht_capab" "$N"
265 fi
266
267 hostapd_prepare_device_config "$hostapd_conf_file" nl80211
268 cat >> "$hostapd_conf_file" <<EOF
269 ${channel:+channel=$channel}
270 ${noscan:+noscan=$noscan}
271 $base_cfg
272
273 EOF
274 json_select ..
275 }
276
277 mac80211_hostapd_setup_bss() {
278 local phy="$1"
279 local ifname="$2"
280 local macaddr="$3"
281 local type="$4"
282
283 hostapd_cfg=
284 append hostapd_cfg "$type=$ifname" "$N"
285
286 hostapd_set_bss_options hostapd_cfg "$vif" || return 1
287 json_get_vars wds dtim_period max_listen_int
288
289 set_default wds 0
290
291 [ "$wds" -gt 0 ] && append hostapd_cfg "wds_sta=1" "$N"
292 [ "$staidx" -gt 0 ] && append hostapd_cfg "start_disabled=1" "$N"
293
294 cat >> /var/run/hostapd-$phy.conf <<EOF
295 $hostapd_cfg
296 bssid=$macaddr
297 ${dtim_period:+dtim_period=$dtim_period}
298 ${max_listen_int:+max_listen_interval=$max_listen_int}
299 EOF
300 }
301
302 mac80211_generate_mac() {
303 local phy="$1"
304 local id="${macidx:-0}"
305
306 local ref="$(cat /sys/class/ieee80211/${phy}/macaddress)"
307 local mask="$(cat /sys/class/ieee80211/${phy}/address_mask)"
308
309 [ "$mask" = "00:00:00:00:00:00" ] && mask="ff:ff:ff:ff:ff:ff";
310 local oIFS="$IFS"; IFS=":"; set -- $mask; IFS="$oIFS"
311
312 local mask1=$1
313 local mask6=$6
314
315 local oIFS="$IFS"; IFS=":"; set -- $ref; IFS="$oIFS"
316
317 macidx=$(($id + 1))
318 [ "$((0x$mask1))" -gt 0 ] && {
319 b1="0x$1"
320 [ "$id" -gt 0 ] && \
321 b1=$(($b1 ^ ((($id - 1) << 2) | 0x2)))
322 printf "%02x:%s:%s:%s:%s:%s" $b1 $2 $3 $4 $5 $6
323 return
324 }
325
326 [ "$((0x$mask6))" -lt 255 ] && {
327 printf "%s:%s:%s:%s:%s:%02x" $1 $2 $3 $4 $5 $(( 0x$6 ^ $id ))
328 return
329 }
330
331 off2=$(( (0x$6 + $id) / 0x100 ))
332 printf "%s:%s:%s:%s:%02x:%02x" \
333 $1 $2 $3 $4 \
334 $(( (0x$5 + $off2) % 0x100 )) \
335 $(( (0x$6 + $id) % 0x100 ))
336 }
337
338 find_phy() {
339 [ -n "$phy" -a -d /sys/class/ieee80211/$phy ] && return 0
340 [ -n "$path" -a -d "/sys/devices/$path/ieee80211" ] && {
341 phy="$(ls /sys/devices/$path/ieee80211 | grep -m 1 phy)"
342 [ -n "$phy" ] && return 0
343 }
344 [ -n "$macaddr" ] && {
345 for phy in $(ls /sys/class/ieee80211 2>/dev/null); do
346 grep -i -q "$macaddr" "/sys/class/ieee80211/${phy}/macaddress" && return 0
347 done
348 }
349 return 1
350 }
351
352 mac80211_check_ap() {
353 has_ap=1
354 }
355
356 mac80211_prepare_vif() {
357 json_select config
358
359 json_get_vars ifname mode ssid wds powersave macaddr
360
361 [ -n "$ifname" ] || ifname="wlan${phy#phy}${if_idx:+-$if_idx}"
362 if_idx=$((${if_idx:-0} + 1))
363
364 set_default wds 0
365 set_default powersave 0
366
367 json_select ..
368
369 [ -n "$macaddr" ] || {
370 macaddr="$(mac80211_generate_mac $phy)"
371 macidx="$(($macidx + 1))"
372 }
373
374 json_add_object data
375 json_add_string ifname "$ifname"
376 json_close_object
377 json_select config
378
379 # It is far easier to delete and create the desired interface
380 case "$mode" in
381 adhoc)
382 iw phy "$phy" interface add "$ifname" type adhoc
383 ;;
384 ap)
385 # Hostapd will handle recreating the interface and
386 # subsequent virtual APs belonging to the same PHY
387 if [ -n "$hostapd_ctrl" ]; then
388 type=bss
389 else
390 type=interface
391 fi
392
393 mac80211_hostapd_setup_bss "$phy" "$ifname" "$macaddr" "$type" || return
394
395 [ -n "$hostapd_ctrl" ] || {
396 iw phy "$phy" interface add "$ifname" type managed
397 hostapd_ctrl="${hostapd_ctrl:-/var/run/hostapd/$ifname}"
398 }
399 ;;
400 mesh)
401 json_get_vars key mesh_id
402 if [ -n "$key" ]; then
403 iw phy "$phy" interface add "$ifname" type mp
404 else
405 iw phy "$phy" interface add "$ifname" type mp mesh_id "$mesh_id"
406 fi
407 ;;
408 monitor)
409 iw phy "$phy" interface add "$ifname" type monitor
410 ;;
411 sta)
412 local wdsflag=
413 staidx="$(($staidx + 1))"
414 [ "$wds" -gt 0 ] && wdsflag="4addr on"
415 iw phy "$phy" interface add "$ifname" type managed $wdsflag
416 [ "$powersave" -gt 0 ] && powersave="on" || powersave="off"
417 iw "$ifname" set power_save "$powersave"
418 ;;
419 esac
420
421 case "$mode" in
422 monitor|mesh)
423 [ "$auto_channel" -gt 0 ] || iw dev "$ifname" set channel "$channel" $htmode
424 ;;
425 esac
426
427 if [ "$mode" != "ap" ]; then
428 # ALL ap functionality will be passed to hostapd
429 # All interfaces must have unique mac addresses
430 # which can either be explicitly set in the device
431 # section, or automatically generated
432 ifconfig "$ifname" hw ether "$macaddr"
433 fi
434
435 json_select ..
436 }
437
438 mac80211_setup_supplicant() {
439 wpa_supplicant_prepare_interface "$ifname" nl80211 || return 1
440 wpa_supplicant_add_network "$ifname"
441 wpa_supplicant_run "$ifname" ${hostapd_ctrl:+-H $hostapd_ctrl}
442 }
443
444 mac80211_setup_adhoc() {
445 json_get_vars bssid ssid key mcast_rate
446
447 keyspec=
448 [ "$auth_type" == "wep" ] && {
449 set_default key 1
450 case "$key" in
451 [1234])
452 local idx
453 for idx in 1 2 3 4; do
454 json_get_var ikey "key$idx"
455
456 [ -n "$ikey" ] && {
457 ikey="$(($idx - 1)):$(prepare_key_wep "$ikey")"
458 [ $idx -eq $key ] && ikey="d:$ikey"
459 append keyspec "$ikey"
460 }
461 done
462 ;;
463 *)
464 append keyspec "d:0:$(prepare_key_wep "$key")"
465 ;;
466 esac
467 }
468
469 brstr=
470 for br in $basic_rate_list; do
471 hostapd_add_rate brstr "$br"
472 done
473
474 mcval=
475 [ -n "$mcast_rate" ] && hostapd_add_rate mcval "$mcast_rate"
476
477 iw dev "$ifname" ibss join "$ssid" $freq $htmode fixed-freq $bssid \
478 ${beacon_int:+beacon-interval $beacon_int} \
479 ${brstr:+basic-rates $brstr} \
480 ${mcval:+mcast-rate $mcval} \
481 ${keyspec:+keys $keyspec}
482 }
483
484 mac80211_setup_vif() {
485 local name="$1"
486 local failed
487
488 json_select data
489 json_get_vars ifname
490 json_select ..
491
492 json_select config
493 json_get_vars mode
494 json_get_var vif_txpower txpower
495
496 ifconfig "$ifname" up || {
497 wireless_setup_vif_failed IFUP_ERROR
498 json_select ..
499 return
500 }
501
502 set_default vif_txpower "$txpower"
503 [ -z "$vif_txpower" ] || iw dev "$ifname" set txpower fixed "${vif_txpower%%.*}00"
504
505 case "$mode" in
506 mesh)
507 for var in $MP_CONFIG_INT $MP_CONFIG_BOOL $MP_CONFIG_STRING; do
508 json_get_var mp_val "$var"
509 [ -n "$mp_val" ] && iw dev "$ifname" set mesh_param "$var" "$mp_val"
510 done
511
512 # authsae
513 json_get_vars key
514 if [ -n "$key" ]; then
515 if [ -e "/lib/wifi/authsae.sh" ]; then
516 . /lib/wifi/authsae.sh
517 authsae_start_interface || failed=1
518 else
519 wireless_setup_vif_failed AUTHSAE_NOT_INSTALLED
520 json_select ..
521 return
522 fi
523 fi
524 ;;
525 adhoc)
526 wireless_vif_parse_encryption
527 if [ "$wpa" -gt 0 -o "$auto_channel" -gt 0 ]; then
528 mac80211_setup_supplicant || failed=1
529 else
530 mac80211_setup_adhoc
531 fi
532 ;;
533 sta)
534 mac80211_setup_supplicant || failed=1
535 ;;
536 esac
537
538 json_select ..
539 [ -n "$failed" ] || wireless_add_vif "$name" "$ifname"
540 }
541
542 get_freq() {
543 local phy="$1"
544 local chan="$2"
545 iw "$phy" info | grep -E -m1 "(\* ${chan:-....} MHz${chan:+|\\[$chan\\]})" | grep MHz | awk '{print $2}'
546 }
547
548 mac80211_interface_cleanup() {
549 local phy="$1"
550
551 for wdev in $(list_phy_interfaces "$phy"); do
552 ifconfig "$wdev" down 2>/dev/null
553 iw dev "$wdev" del
554 done
555 }
556
557 drv_mac80211_cleanup() {
558 hostapd_common_cleanup
559 }
560
561 drv_mac80211_setup() {
562 json_select config
563 json_get_vars \
564 phy macaddr path \
565 country chanbw distance \
566 txpower antenna_gain \
567 rxantenna txantenna \
568 frag rts beacon_int
569 json_get_values basic_rate_list basic_rate
570 json_select ..
571
572 find_phy || {
573 echo "Could not find PHY for device '$1'"
574 wireless_set_retry 0
575 return 1
576 }
577
578 wireless_set_data phy="$phy"
579 mac80211_interface_cleanup "$phy"
580
581 # convert channel to frequency
582 [ "$auto_channel" -gt 0 ] || freq="$(get_freq "$phy" "$channel")"
583
584 [ -n "$country" ] && {
585 iw reg get | grep -q "^country $country:" || {
586 iw reg set "$country"
587 sleep 1
588 }
589 }
590
591 hostapd_conf_file="/var/run/hostapd-$phy.conf"
592
593 no_ap=1
594 macidx=0
595 staidx=0
596
597 [ -n "$chanbw" ] && {
598 for file in /sys/kernel/debug/ieee80211/$phy/ath9k/chanbw /sys/kernel/debug/ieee80211/$phy/ath5k/bwmode; do
599 [ -f "$file" ] && echo "$chanbw" > "$file"
600 done
601 }
602
603 set_default rxantenna all
604 set_default txantenna all
605 set_default distance 0
606 set_default antenna_gain 0
607
608 iw phy "$phy" set antenna $txantenna $rxantenna >/dev/null 2>&1
609 iw phy "$phy" set antenna_gain $antenna_gain
610 iw phy "$phy" set distance "$distance"
611
612 [ -n "$frag" ] && iw phy "$phy" set frag "${frag%%.*}"
613 [ -n "$rts" ] && iw phy "$phy" set rts "${rts%%.*}"
614
615 has_ap=
616 hostapd_ctrl=
617 for_each_interface "ap" mac80211_check_ap
618
619 rm -f "$hostapd_conf_file"
620 [ -n "$has_ap" ] && mac80211_hostapd_setup_base "$phy"
621
622 for_each_interface "sta adhoc mesh monitor" mac80211_prepare_vif
623 for_each_interface "ap" mac80211_prepare_vif
624
625 [ -n "$hostapd_ctrl" ] && {
626 /usr/sbin/hostapd -P /var/run/wifi-$phy.pid -B "$hostapd_conf_file"
627 ret="$?"
628 wireless_add_process "$(cat /var/run/wifi-$phy.pid)" "/usr/sbin/hostapd" 1
629 [ "$ret" != 0 ] && {
630 wireless_setup_failed HOSTAPD_START_FAILED
631 return
632 }
633 }
634
635 for_each_interface "ap sta adhoc mesh monitor" mac80211_setup_vif
636
637 wireless_set_up
638 }
639
640 list_phy_interfaces() {
641 local phy="$1"
642 if [ -d "/sys/class/ieee80211/${phy}/device/net" ]; then
643 ls "/sys/class/ieee80211/${phy}/device/net" 2>/dev/null;
644 else
645 ls "/sys/class/ieee80211/${phy}/device" 2>/dev/null | grep net: | sed -e 's,net:,,g'
646 fi
647 }
648
649 drv_mac80211_teardown() {
650 wireless_process_kill_all
651
652 json_select data
653 json_get_vars phy
654 json_select ..
655
656 mac80211_interface_cleanup "$phy"
657 }
658
659 add_driver mac80211